Merge branch 'navigator_rewrite' into navigator_rewrite_estimator

This commit is contained in:
Julian Oes
2014-06-11 13:29:47 +02:00
2 changed files with 10 additions and 8 deletions
+2
View File
@@ -17,6 +17,8 @@ mavlink stream -d /dev/ttyACM0 -s ATTITUDE_CONTROLS -r 30
usleep 100000 usleep 100000
mavlink stream -d /dev/ttyACM0 -s SERVO_OUTPUT_RAW_0 -r 20 mavlink stream -d /dev/ttyACM0 -s SERVO_OUTPUT_RAW_0 -r 20
usleep 100000 usleep 100000
mavlink stream -d /dev/ttyACM0 -s GLOBAL_POSITION_SETPOINT_INT -r 20
usleep 100000
# Exit shell to make it available to MAVLink # Exit shell to make it available to MAVLink
exit exit
+8 -8
View File
@@ -959,14 +959,14 @@ protected:
void send(const hrt_abstime t) void send(const hrt_abstime t)
{ {
if (pos_sp_triplet_sub->update(t)) { /* always send this message, even if it has not been updated */
mavlink_msg_global_position_setpoint_int_send(_channel, pos_sp_triplet_sub->update(t);
MAV_FRAME_GLOBAL, mavlink_msg_global_position_setpoint_int_send(_channel,
(int32_t)(pos_sp_triplet->current.lat * 1e7), MAV_FRAME_GLOBAL,
(int32_t)(pos_sp_triplet->current.lon * 1e7), (int32_t)(pos_sp_triplet->current.lat * 1e7),
(int32_t)(pos_sp_triplet->current.alt * 1000), (int32_t)(pos_sp_triplet->current.lon * 1e7),
(int16_t)(pos_sp_triplet->current.yaw * M_RAD_TO_DEG_F * 100.0f)); (int32_t)(pos_sp_triplet->current.alt * 1000),
} (int16_t)(pos_sp_triplet->current.yaw * M_RAD_TO_DEG_F * 100.0f));
} }
}; };