extended INS with vertical filter using sonar.