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

WP counting update

This commit is contained in:
Jason Short 2011-11-12 21:46:03 -08:00
parent bc6f523d83
commit b8c8d22fed
1 changed files with 8 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
ArduCopter/setup.pde
View File

@ -815,7 +815,7 @@ static void report_batt_monitor()
static void report_wp(byte index = 255) static void report_wp(byte index = 255)
{ {
if(index == 255){ if(index == 255){
for(byte i = 0; i <= g.command_total; i++){ for(byte i = 0; i < g.command_total; i++){
struct Location temp = get_cmd_with_index(i); struct Location temp = get_cmd_with_index(i);
print_wp(&temp, i); print_wp(&temp, i);
} }
@ -1145,14 +1145,17 @@ init_esc()
static void print_wp(struct Location *cmd, byte index) static void print_wp(struct Location *cmd, byte index)
{ {
Serial.printf_P(PSTR("command #: %d id:%d op:%d p1:%d p2:%ld p3:%ld p4:%ld \n"), float t1 = (float)cmd->lat / t7;
float t2 = (float)cmd->lng / t7;
Serial.printf_P(PSTR("scommand #: %d id:%d op:%d p1:%d p2:%ld p3:%4.7f p4:%4.7f \n"),
(int)index, (int)index,
(int)cmd->id, (int)cmd->id,
(int)cmd->options, (int)cmd->options,
(int)cmd->p1, (int)cmd->p1,
cmd->alt, (long)cmd->alt,
cmd->lat, t1,
cmd->lng); t2);
} }
static void report_gps() static void report_gps()