Added landing gear detection, updated sonar altimiter and heading code