|
|
|
@ -63,7 +63,7 @@ void Rover::send_heartbeat(mavlink_channel_t chan)
@@ -63,7 +63,7 @@ void Rover::send_heartbeat(mavlink_channel_t chan)
|
|
|
|
|
// indicate we have set a custom mode
|
|
|
|
|
base_mode |= MAV_MODE_FLAG_CUSTOM_MODE_ENABLED; |
|
|
|
|
|
|
|
|
|
gcs[chan-MAVLINK_COMM_0].send_heartbeat(MAV_TYPE_GROUND_ROVER, |
|
|
|
|
gcs_chan[chan-MAVLINK_COMM_0].send_heartbeat(MAV_TYPE_GROUND_ROVER, |
|
|
|
|
base_mode, |
|
|
|
|
custom_mode, |
|
|
|
|
system_status); |
|
|
|
@ -1485,7 +1485,7 @@ void GCS_MAVLINK_Rover::handleMessage(mavlink_message_t* msg)
@@ -1485,7 +1485,7 @@ void GCS_MAVLINK_Rover::handleMessage(mavlink_message_t* msg)
|
|
|
|
|
void Rover::mavlink_delay_cb() |
|
|
|
|
{ |
|
|
|
|
static uint32_t last_1hz, last_50hz, last_5s; |
|
|
|
|
if (!gcs[0].initialised || in_mavlink_delay) { |
|
|
|
|
if (!gcs_chan[0].initialised || in_mavlink_delay) { |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -1518,8 +1518,8 @@ void Rover::mavlink_delay_cb()
@@ -1518,8 +1518,8 @@ void Rover::mavlink_delay_cb()
|
|
|
|
|
void Rover::gcs_send_message(enum ap_message id) |
|
|
|
|
{ |
|
|
|
|
for (uint8_t i=0; i < num_gcs; i++) { |
|
|
|
|
if (gcs[i].initialised) { |
|
|
|
|
gcs[i].send_message(id); |
|
|
|
|
if (gcs_chan[i].initialised) { |
|
|
|
|
gcs_chan[i].send_message(id); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
@ -1530,9 +1530,9 @@ void Rover::gcs_send_message(enum ap_message id)
@@ -1530,9 +1530,9 @@ void Rover::gcs_send_message(enum ap_message id)
|
|
|
|
|
void Rover::gcs_send_mission_item_reached_message(uint16_t mission_index) |
|
|
|
|
{ |
|
|
|
|
for (uint8_t i=0; i < num_gcs; i++) { |
|
|
|
|
if (gcs[i].initialised) { |
|
|
|
|
gcs[i].mission_item_reached_index = mission_index; |
|
|
|
|
gcs[i].send_message(MSG_MISSION_ITEM_REACHED); |
|
|
|
|
if (gcs_chan[i].initialised) { |
|
|
|
|
gcs_chan[i].mission_item_reached_index = mission_index; |
|
|
|
|
gcs_chan[i].send_message(MSG_MISSION_ITEM_REACHED); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
@ -1543,8 +1543,8 @@ void Rover::gcs_send_mission_item_reached_message(uint16_t mission_index)
@@ -1543,8 +1543,8 @@ void Rover::gcs_send_mission_item_reached_message(uint16_t mission_index)
|
|
|
|
|
void Rover::gcs_data_stream_send(void) |
|
|
|
|
{ |
|
|
|
|
for (uint8_t i=0; i < num_gcs; i++) { |
|
|
|
|
if (gcs[i].initialised) { |
|
|
|
|
gcs[i].data_stream_send(); |
|
|
|
|
if (gcs_chan[i].initialised) { |
|
|
|
|
gcs_chan[i].data_stream_send(); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
@ -1555,11 +1555,11 @@ void Rover::gcs_data_stream_send(void)
@@ -1555,11 +1555,11 @@ void Rover::gcs_data_stream_send(void)
|
|
|
|
|
void Rover::gcs_update(void) |
|
|
|
|
{ |
|
|
|
|
for (uint8_t i=0; i < num_gcs; i++) { |
|
|
|
|
if (gcs[i].initialised) { |
|
|
|
|
if (gcs_chan[i].initialised) { |
|
|
|
|
#if CLI_ENABLED == ENABLED |
|
|
|
|
gcs[i].update(g.cli_enabled == 1 ? FUNCTOR_BIND_MEMBER(&Rover::run_cli, void, AP_HAL::UARTDriver *) : nullptr); |
|
|
|
|
gcs_chan[i].update(g.cli_enabled == 1 ? FUNCTOR_BIND_MEMBER(&Rover::run_cli, void, AP_HAL::UARTDriver *) : nullptr); |
|
|
|
|
#else |
|
|
|
|
gcs[i].update(nullptr); |
|
|
|
|
gcs_chan[i].update(nullptr); |
|
|
|
|
#endif |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|