An altimeter using speed, forward acceleration and yaw angle rate to measure altitude. The accuracy of the measurement may be improved by compensating for a position offset of an accelerometer; Kalman filtering with an external altitude measurement; and/or compensating for an accelerometer bias. The accelerometer bias may be calculated based on a last incline angle before a dormant time period and/or by Kalman filtering.