Browse Source

MulticopterRateControl: use constructor to copy thrust setpoint array

main
Matthias Grob 3 years ago committed by Daniel Agar
parent
commit
5df266cedc
  1. 4
      src/modules/mc_rate_control/MulticopterRateControl.cpp

4
src/modules/mc_rate_control/MulticopterRateControl.cpp

@ -202,9 +202,7 @@ MulticopterRateControl::Run() @@ -202,9 +202,7 @@ MulticopterRateControl::Run()
_rates_setpoint(0) = PX4_ISFINITE(vehicle_rates_setpoint.roll) ? vehicle_rates_setpoint.roll : rates(0);
_rates_setpoint(1) = PX4_ISFINITE(vehicle_rates_setpoint.pitch) ? vehicle_rates_setpoint.pitch : rates(1);
_rates_setpoint(2) = PX4_ISFINITE(vehicle_rates_setpoint.yaw) ? vehicle_rates_setpoint.yaw : rates(2);
_thrust_setpoint(0) = vehicle_rates_setpoint.thrust_body[0];
_thrust_setpoint(1) = vehicle_rates_setpoint.thrust_body[1];
_thrust_setpoint(2) = vehicle_rates_setpoint.thrust_body[2];
_thrust_setpoint = Vector3f(vehicle_rates_setpoint.thrust_body);
}
}

Loading…
Cancel
Save