sensors.c: check if sonar queue is registered and initialise SonarAltitude