int8_t Rover::test_wp(uint8_t argc, const Menu::arg *argv) { delay(1000); cliSerial->printf("%u waypoints\n", (unsigned)mission.num_commands()); cliSerial->printf("Hit radius: %f\n", (double)g.waypoint_radius.get()); for(uint8_t i = 0; i < mission.num_commands(); i++){ AP_Mission::Mission_Command temp_cmd; if (mission.read_cmd_from_storage(i,temp_cmd)) { test_wp_print(temp_cmd); } } return (0); }
int8_t Plane::test_wp(uint8_t argc, const Menu::arg *argv) { hal.scheduler->delay(1000); // save the alitude above home option if (g.RTL_altitude_cm < 0) { cliSerial->printf_P(PSTR("Hold current altitude\n")); }else{ cliSerial->printf_P(PSTR("Hold altitude of %dm\n"), (int)g.RTL_altitude_cm/100); } cliSerial->printf_P(PSTR("%d waypoints\n"), (int)mission.num_commands()); cliSerial->printf_P(PSTR("Hit radius: %d\n"), (int)g.waypoint_radius); cliSerial->printf_P(PSTR("Loiter radius: %d\n\n"), (int)g.loiter_radius); for(uint8_t i = 0; i <= mission.num_commands(); i++) { AP_Mission::Mission_Command temp_cmd; if (mission.read_cmd_from_storage(i,temp_cmd)) { test_wp_print(temp_cmd); } } return (0); }