|
|
|
@ -856,7 +856,7 @@ void Mavlink::mavlink_wpm_send_waypoint_ack(uint8_t sysid, uint8_t compid, uint8
@@ -856,7 +856,7 @@ void Mavlink::mavlink_wpm_send_waypoint_ack(uint8_t sysid, uint8_t compid, uint8
|
|
|
|
|
wpa.target_component = compid; |
|
|
|
|
wpa.type = type; |
|
|
|
|
|
|
|
|
|
mavlink_msg_mission_ack_encode(mavlink_system.sysid, _mavlink_wpm_comp_id, &msg, &wpa); |
|
|
|
|
mavlink_msg_mission_ack_encode_chan(mavlink_system.sysid, _mavlink_wpm_comp_id, _channel, &msg, &wpa); |
|
|
|
|
mavlink_missionlib_send_message(&msg); |
|
|
|
|
|
|
|
|
|
if (_verbose) { warnx("Sent waypoint ack (%u) to ID %u", wpa.type, wpa.target_system); } |
|
|
|
@ -879,7 +879,7 @@ void Mavlink::mavlink_wpm_send_waypoint_current(uint16_t seq)
@@ -879,7 +879,7 @@ void Mavlink::mavlink_wpm_send_waypoint_current(uint16_t seq)
|
|
|
|
|
|
|
|
|
|
wpc.seq = seq; |
|
|
|
|
|
|
|
|
|
mavlink_msg_mission_current_encode(mavlink_system.sysid, _mavlink_wpm_comp_id, &msg, &wpc); |
|
|
|
|
mavlink_msg_mission_current_encode_chan(mavlink_system.sysid, _mavlink_wpm_comp_id, _channel, &msg, &wpc); |
|
|
|
|
mavlink_missionlib_send_message(&msg); |
|
|
|
|
|
|
|
|
|
} else if (seq == 0 && _wpm->size == 0) { |
|
|
|
@ -902,7 +902,7 @@ void Mavlink::mavlink_wpm_send_waypoint_count(uint8_t sysid, uint8_t compid, uin
@@ -902,7 +902,7 @@ void Mavlink::mavlink_wpm_send_waypoint_count(uint8_t sysid, uint8_t compid, uin
|
|
|
|
|
wpc.target_component = compid; |
|
|
|
|
wpc.count = mission.count; |
|
|
|
|
|
|
|
|
|
mavlink_msg_mission_count_encode(mavlink_system.sysid, _mavlink_wpm_comp_id, &msg, &wpc); |
|
|
|
|
mavlink_msg_mission_count_encode_chan(mavlink_system.sysid, _mavlink_wpm_comp_id, _channel, &msg, &wpc); |
|
|
|
|
mavlink_missionlib_send_message(&msg); |
|
|
|
|
|
|
|
|
|
if (_verbose) { warnx("Sent waypoint count (%u) to ID %u", wpc.count, wpc.target_system); } |
|
|
|
@ -933,7 +933,7 @@ void Mavlink::mavlink_wpm_send_waypoint(uint8_t sysid, uint8_t compid, uint16_t
@@ -933,7 +933,7 @@ void Mavlink::mavlink_wpm_send_waypoint(uint8_t sysid, uint8_t compid, uint16_t
|
|
|
|
|
wp.target_system = sysid; |
|
|
|
|
wp.target_component = compid; |
|
|
|
|
wp.seq = seq; |
|
|
|
|
mavlink_msg_mission_item_encode(mavlink_system.sysid, _mavlink_wpm_comp_id, &msg, &wp); |
|
|
|
|
mavlink_msg_mission_item_encode_chan(mavlink_system.sysid, _mavlink_wpm_comp_id, _channel, &msg, &wp); |
|
|
|
|
mavlink_missionlib_send_message(&msg); |
|
|
|
|
|
|
|
|
|
if (_verbose) { warnx("Sent waypoint %u to ID %u", wp.seq, wp.target_system); } |
|
|
|
@ -953,7 +953,7 @@ void Mavlink::mavlink_wpm_send_waypoint_request(uint8_t sysid, uint8_t compid, u
@@ -953,7 +953,7 @@ void Mavlink::mavlink_wpm_send_waypoint_request(uint8_t sysid, uint8_t compid, u
|
|
|
|
|
wpr.target_system = sysid; |
|
|
|
|
wpr.target_component = compid; |
|
|
|
|
wpr.seq = seq; |
|
|
|
|
mavlink_msg_mission_request_encode(mavlink_system.sysid, _mavlink_wpm_comp_id, &msg, &wpr); |
|
|
|
|
mavlink_msg_mission_request_encode_chan(mavlink_system.sysid, _mavlink_wpm_comp_id, _channel, &msg, &wpr); |
|
|
|
|
mavlink_missionlib_send_message(&msg); |
|
|
|
|
|
|
|
|
|
if (_verbose) { warnx("Sent waypoint request %u to ID %u", wpr.seq, wpr.target_system); } |
|
|
|
@ -979,7 +979,7 @@ void Mavlink::mavlink_wpm_send_waypoint_reached(uint16_t seq)
@@ -979,7 +979,7 @@ void Mavlink::mavlink_wpm_send_waypoint_reached(uint16_t seq)
|
|
|
|
|
|
|
|
|
|
wp_reached.seq = seq; |
|
|
|
|
|
|
|
|
|
mavlink_msg_mission_item_reached_encode(mavlink_system.sysid, _mavlink_wpm_comp_id, &msg, &wp_reached); |
|
|
|
|
mavlink_msg_mission_item_reached_encode_chan(mavlink_system.sysid, _mavlink_wpm_comp_id, _channel, &msg, &wp_reached); |
|
|
|
|
mavlink_missionlib_send_message(&msg); |
|
|
|
|
|
|
|
|
|
if (_verbose) { warnx("Sent waypoint %u reached message", wp_reached.seq); } |
|
|
|
@ -1448,7 +1448,7 @@ Mavlink::mavlink_missionlib_send_gcs_string(const char *string)
@@ -1448,7 +1448,7 @@ Mavlink::mavlink_missionlib_send_gcs_string(const char *string)
|
|
|
|
|
statustext.text[i] = '\0'; |
|
|
|
|
mavlink_message_t msg; |
|
|
|
|
|
|
|
|
|
mavlink_msg_statustext_encode(mavlink_system.sysid, mavlink_system.compid, &msg, &statustext); |
|
|
|
|
mavlink_msg_statustext_encode_chan(mavlink_system.sysid, mavlink_system.compid, _channel, &msg, &statustext); |
|
|
|
|
mavlink_missionlib_send_message(&msg); |
|
|
|
|
return OK; |
|
|
|
|
|
|
|
|
|