Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-02 05:58:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

Rover: if receiving last mission item then log new mission to dataflash

Browse Source
This commit is contained in:
Tom Pittenger 2015-05-05 17:17:08 -07:00 committed by Andrew Tridgell
parent ba29967454
commit 06796cd994
2 changed files with 12 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
APMrover2/GCS_Mavlink.pde
View File

@ -1068,7 +1068,9 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
// XXX receive a WP from GCS and store in EEPROM // XXX receive a WP from GCS and store in EEPROM
case MAVLINK_MSG_ID_MISSION_ITEM: case MAVLINK_MSG_ID_MISSION_ITEM:
{ {
handle_mission_item(msg, mission); if (handle_mission_item(msg, mission)) {
Log_Write_EntireMission();
}
break; break;
} }

8
APMrover2/Log.pde
View File

@ -244,6 +244,13 @@ static void Log_Write_Startup(uint8_t type)
DataFlash.WriteBlock(&pkt, sizeof(pkt)); DataFlash.WriteBlock(&pkt, sizeof(pkt));
// write all commands to the dataflash as well // write all commands to the dataflash as well
Log_Write_EntireMission();
}
static void Log_Write_EntireMission()
{
gcs_send_text_P(SEVERITY_LOW, PSTR("New mission"));
AP_Mission::Mission_Command cmd; AP_Mission::Mission_Command cmd;
for (uint16_t i = 0; i < mission.num_commands(); i++) { for (uint16_t i = 0; i < mission.num_commands(); i++) {
if (mission.read_cmd_from_storage(i,cmd)) { if (mission.read_cmd_from_storage(i,cmd)) {
@ -430,6 +437,7 @@ static void start_logging()
// dummy functions // dummy functions
static void Log_Write_Startup(uint8_t type) {} static void Log_Write_Startup(uint8_t type) {}
static void Log_Write_EntireMission() {}
static void Log_Write_Current() {} static void Log_Write_Current() {}
static void Log_Write_Nav_Tuning() {} static void Log_Write_Nav_Tuning() {}
static void Log_Write_Performance() {} static void Log_Write_Performance() {}