mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-18 12:13:35 +08:00
Remove euler angles from attitude setpoint (#23482)
* Remove euler angles from attitude setpoint message * Remove usage of euler angles in attitude setpoint messages This commit removes the usage of euler angles in the vehicle_attitude_setpoint messages * Fix standard vtol
This commit is contained in:
@@ -97,9 +97,8 @@ void UUVPOSControl::publish_attitude_setpoint(const float thrust_x, const float
|
||||
vehicle_attitude_setpoint_s vehicle_attitude_setpoint = {};
|
||||
vehicle_attitude_setpoint.timestamp = hrt_absolute_time();
|
||||
|
||||
vehicle_attitude_setpoint.roll_body = roll_des;
|
||||
vehicle_attitude_setpoint.pitch_body = pitch_des;
|
||||
vehicle_attitude_setpoint.yaw_body = yaw_des;
|
||||
const Quatf attitude_setpoint(Eulerf(roll_des, pitch_des, yaw_des));
|
||||
attitude_setpoint.copyTo(vehicle_attitude_setpoint.q_d);
|
||||
|
||||
vehicle_attitude_setpoint.thrust_body[0] = thrust_x;
|
||||
vehicle_attitude_setpoint.thrust_body[1] = thrust_y;
|
||||
|
||||
Reference in New Issue
Block a user