This paper describes a robust algorithm for an integrated underwater navigation system based on VKF (velocity Kalman filter). The proposed approach relies on a VKF, augmented by the altitude from an echo-sounder-based switching architecture to yield robust performance, even when DVL (Doppler velocity log) exceeds the measurement range and the measured value cannot be valid. The proposed approach relies on three parts: 1) PINS (pure inertial navigation system), 2) VKF design, and 3) VKF-aided integrated navigation filter design. To evaluate the proposed method, we compare the results of the VKF-aided navigation system with the simulation result from a PINS and conventional INS-DVL method.