|
|
|
@ -1430,7 +1430,7 @@ protected:
@@ -1430,7 +1430,7 @@ protected:
|
|
|
|
|
struct position_setpoint_triplet_s pos_sp_triplet; |
|
|
|
|
|
|
|
|
|
if (_pos_sp_triplet_sub->update(&pos_sp_triplet)) { |
|
|
|
|
mavlink_position_target_global_int_t msg; |
|
|
|
|
mavlink_position_target_global_int_t msg{}; |
|
|
|
|
|
|
|
|
|
msg.coordinate_frame = MAV_FRAME_GLOBAL; |
|
|
|
|
msg.lat_int = pos_sp_triplet.current.lat * 1e7; |
|
|
|
@ -1490,8 +1490,9 @@ protected:
@@ -1490,8 +1490,9 @@ protected:
|
|
|
|
|
struct vehicle_local_position_setpoint_s pos_sp; |
|
|
|
|
|
|
|
|
|
if (_pos_sp_sub->update(&_pos_sp_time, &pos_sp)) { |
|
|
|
|
mavlink_position_target_local_ned_t msg; |
|
|
|
|
mavlink_position_target_local_ned_t msg{}; |
|
|
|
|
|
|
|
|
|
msg.time_boot_ms = pos_sp.timestamp / 1000; |
|
|
|
|
msg.coordinate_frame = MAV_FRAME_LOCAL_NED; |
|
|
|
|
msg.x = pos_sp.x; |
|
|
|
|
msg.y = pos_sp.y; |
|
|
|
@ -1558,7 +1559,7 @@ protected:
@@ -1558,7 +1559,7 @@ protected:
|
|
|
|
|
struct vehicle_rates_setpoint_s att_rates_sp; |
|
|
|
|
(void)_att_rates_sp_sub->update(&_att_rates_sp_time, &att_rates_sp); |
|
|
|
|
|
|
|
|
|
mavlink_attitude_target_t msg; |
|
|
|
|
mavlink_attitude_target_t msg{}; |
|
|
|
|
|
|
|
|
|
msg.time_boot_ms = att_sp.timestamp / 1000; |
|
|
|
|
mavlink_euler_to_quaternion(att_sp.roll_body, att_sp.pitch_body, att_sp.yaw_body, msg.q); |
|
|
|
|