|
|
|
@ -61,9 +61,9 @@ void loop()
@@ -61,9 +61,9 @@ void loop()
|
|
|
|
|
hal.scheduler->delay(100); |
|
|
|
|
sonar.update(); |
|
|
|
|
|
|
|
|
|
hal.console->printf_P(PSTR("Primary: health %d distance_cm %d \n"), (int)sonar.healthy(), sonar.distance_cm()); |
|
|
|
|
hal.console->printf_P(PSTR("All: device_0 type %d health %d distance_cm %d, device_1 type %d health %d distance_cm %d\n"), |
|
|
|
|
(int)sonar._type[0], (int)sonar.healthy(0), sonar.distance_cm(0), (int)sonar._type[1], (int)sonar.healthy(1), sonar.distance_cm(1)); |
|
|
|
|
hal.console->printf_P(PSTR("Primary: status %d distance_cm %d \n"), (int)sonar.status(), sonar.distance_cm()); |
|
|
|
|
hal.console->printf_P(PSTR("All: device_0 type %d status %d distance_cm %d, device_1 type %d status %d distance_cm %d\n"), |
|
|
|
|
(int)sonar._type[0], (int)sonar.status(0), sonar.distance_cm(0), (int)sonar._type[1], (int)sonar.status(1), sonar.distance_cm(1)); |
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
AP_HAL_MAIN(); |
|
|
|
|