Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-10 09:58:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

added sonar test

Browse Source 
useful to check calibration of the sonar

git-svn-id: https://arducopter.googlecode.com/svn/trunk@1783 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
tridge60@gmail.com 2011-03-18 01:50:27 +00:00
parent 31e93f8198
commit c931bde863
1 changed files with 22 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
ArduCopterMega/test.pde
View File

@ -18,6 +18,7 @@ static int8_t test_relay(uint8_t argc, const Menu::arg *argv);
static int8_t test_wp(uint8_t argc, const Menu::arg *argv);
static int8_t test_pressure(uint8_t argc, const Menu::arg *argv);
static int8_t test_mag(uint8_t argc, const Menu::arg *argv);
static int8_t test_sonar(uint8_t argc, const Menu::arg *argv);
static int8_t test_xbee(uint8_t argc, const Menu::arg *argv);
static int8_t test_eedump(uint8_t argc, const Menu::arg *argv);
static int8_t test_rawgps(uint8_t argc, const Menu::arg *argv);
@ -61,6 +62,7 @@ const struct Menu::command test_menu_commands[] PROGMEM = {
#if HIL_MODE != HIL_MODE_ATTITUDE
{"airpressure", test_pressure},
#endif
{"sonar", test_sonar},
{"compass", test_mag},
{"xbee", test_xbee},
{"eedump", test_eedump},
@ -903,6 +905,26 @@ test_mag(uint8_t argc, const Menu::arg *argv)
}
}
/*
test the sonar
*/
static int8_t
test_sonar(uint8_t argc, const Menu::arg *argv)
{
print_hit_enter();
delay(1000);
while(1) {
Serial.printf_P(PSTR("%d cm\n"), sonar.read());
delay(100);
if(Serial.available() > 0){
return (0);
}
}
return (0);
}
void print_hit_enter()
{
Serial.printf_P(PSTR("Hit Enter to exit.\n\n"));