void doState0() { if (initTimer.timeout(false)) { setupSequence(); activateImagingScanner(true); state = 3; } }
void updateSensors() { if (updateTimer.timeout(true)) { getImagingInfo(imagingInfo); getLocationInfo(navInfo); sonarDistance.update(navInfo.sonar); } }