Navigator improved to correct for accelerometer drift using encoders