|
|
|
@ -188,11 +188,11 @@ void AP_Terrain::get_statistics(uint16_t &pending, uint16_t &loaded)
@@ -188,11 +188,11 @@ void AP_Terrain::get_statistics(uint16_t &pending, uint16_t &loaded)
|
|
|
|
|
/*
|
|
|
|
|
handle terrain messages from GCS |
|
|
|
|
*/ |
|
|
|
|
void AP_Terrain::handle_data(mavlink_channel_t chan, mavlink_message_t *msg) |
|
|
|
|
void AP_Terrain::handle_data(mavlink_channel_t chan, const mavlink_message_t &msg) |
|
|
|
|
{ |
|
|
|
|
if (msg->msgid == MAVLINK_MSG_ID_TERRAIN_DATA) { |
|
|
|
|
if (msg.msgid == MAVLINK_MSG_ID_TERRAIN_DATA) { |
|
|
|
|
handle_terrain_data(msg); |
|
|
|
|
} else if (msg->msgid == MAVLINK_MSG_ID_TERRAIN_CHECK) { |
|
|
|
|
} else if (msg.msgid == MAVLINK_MSG_ID_TERRAIN_CHECK) { |
|
|
|
|
handle_terrain_check(chan, msg); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
@ -243,10 +243,10 @@ void AP_Terrain::send_terrain_report(mavlink_channel_t chan, const Location &loc
@@ -243,10 +243,10 @@ void AP_Terrain::send_terrain_report(mavlink_channel_t chan, const Location &loc
|
|
|
|
|
/*
|
|
|
|
|
handle TERRAIN_CHECK messages from GCS |
|
|
|
|
*/ |
|
|
|
|
void AP_Terrain::handle_terrain_check(mavlink_channel_t chan, mavlink_message_t *msg) |
|
|
|
|
void AP_Terrain::handle_terrain_check(mavlink_channel_t chan, const mavlink_message_t &msg) |
|
|
|
|
{ |
|
|
|
|
mavlink_terrain_check_t packet; |
|
|
|
|
mavlink_msg_terrain_check_decode(msg, &packet); |
|
|
|
|
mavlink_msg_terrain_check_decode(&msg, &packet); |
|
|
|
|
Location loc; |
|
|
|
|
loc.lat = packet.lat; |
|
|
|
|
loc.lng = packet.lon; |
|
|
|
@ -256,10 +256,10 @@ void AP_Terrain::handle_terrain_check(mavlink_channel_t chan, mavlink_message_t
@@ -256,10 +256,10 @@ void AP_Terrain::handle_terrain_check(mavlink_channel_t chan, mavlink_message_t
|
|
|
|
|
/*
|
|
|
|
|
handle TERRAIN_DATA messages from GCS |
|
|
|
|
*/ |
|
|
|
|
void AP_Terrain::handle_terrain_data(mavlink_message_t *msg) |
|
|
|
|
void AP_Terrain::handle_terrain_data(const mavlink_message_t &msg) |
|
|
|
|
{ |
|
|
|
|
mavlink_terrain_data_t packet; |
|
|
|
|
mavlink_msg_terrain_data_decode(msg, &packet); |
|
|
|
|
mavlink_msg_terrain_data_decode(&msg, &packet); |
|
|
|
|
|
|
|
|
|
uint16_t i; |
|
|
|
|
for (i=0; i<cache_size; i++) { |
|
|
|
|