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);
	}
}