Add new command to show SONAR altitude

Signed-off-by: cGIesen <info@klick-punkte.info>