Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

error checking command saving

This commit is contained in:
Jason Short 2011-11-13 13:40:09 -08:00
parent d4aa61e97e
commit daaf681417
1 changed files with 6 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
ArduCopter/commands.pde
View File

@ -78,7 +78,8 @@ static struct Location get_cmd_with_index(int i)
static void set_command_with_index(struct Location temp, int i)
{
Serial.printf("set_command: %d with id: %d\n", i, temp.id);
i = constrain(i, 0, (g.command_total.get() -1));
i = constrain(i, 0, g.command_total.get());
Serial.printf("set_command: %d with id: %d\n", i, temp.id);
// store home as 0 altitude!!!
if (i == 0)
@ -102,6 +103,10 @@ static void set_command_with_index(struct Location temp, int i)
mem += 4;
eeprom_write_dword((uint32_t *) mem, temp.lng); // Long is stored in decimal degrees * 10^7
// Make sure our WP_total
if(g.command_total <= i)
g.command_total.set_and_save(i+1);
}
static void increment_WP_index()