mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-09 22:08:56 +08:00
print debug to confirm the issue
This commit is contained in:
@@ -94,6 +94,7 @@ bool FlightTaskTransition::update()
|
||||
|
||||
if (!_sub_vehicle_status.get().in_transition_to_fw) {
|
||||
tilt_setpoint = computeBackTransitionTiltSetpoint();
|
||||
PX4_INFO("tilt setpoint: %.4f", (double) tilt_setpoint);
|
||||
const Vector2f velocity_xy{_velocity};
|
||||
horizontal_acceleration_direction = -velocity_xy.unit_or_zero();
|
||||
|
||||
|
||||
@@ -196,6 +196,7 @@ void Standard::update_transition_state()
|
||||
const Eulerf attitude_setpoint_euler(Quatf(_v_att_sp->q_d));
|
||||
float roll_body = attitude_setpoint_euler.phi();
|
||||
float pitch_body = attitude_setpoint_euler.theta();
|
||||
const float pitch_body_original = pitch_body;
|
||||
float yaw_body = attitude_setpoint_euler.psi();
|
||||
|
||||
if (_vtol_mode == vtol_mode::TRANSITION_TO_FW) {
|
||||
@@ -264,6 +265,12 @@ void Standard::update_transition_state()
|
||||
|
||||
q_sp.copyTo(_v_att_sp->q_d);
|
||||
|
||||
if (_time_since_trans_start < 0.05f) {
|
||||
PX4_INFO("\n\njust started backtransition (t=%.4f)", (double) _time_since_trans_start);
|
||||
PX4_INFO("pitch_body: %.4f", (double) pitch_body);
|
||||
PX4_INFO("pitch_body orig: %.4f", (double) pitch_body_original);
|
||||
}
|
||||
|
||||
_pusher_throttle = 0.0f;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user