diff --git a/src/modules/flight_mode_manager/tasks/Transition/FlightTaskTransition.cpp b/src/modules/flight_mode_manager/tasks/Transition/FlightTaskTransition.cpp index 8192bfdd3d..694cfe09bc 100644 --- a/src/modules/flight_mode_manager/tasks/Transition/FlightTaskTransition.cpp +++ b/src/modules/flight_mode_manager/tasks/Transition/FlightTaskTransition.cpp @@ -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(); diff --git a/src/modules/vtol_att_control/standard.cpp b/src/modules/vtol_att_control/standard.cpp index 6c5bba004e..d79b30105e 100644 --- a/src/modules/vtol_att_control/standard.cpp +++ b/src/modules/vtol_att_control/standard.cpp @@ -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; }