A system implementing a method for generating a navigation output is provided. The method includes determining a gravitational anomaly estimate based at least in part on inertial sensor data and navigation output; generating navigation and sensor corrections that are due at least in part on inherent sensor errors that include vertical accelerometer/gravimeter corrections from at least a navigation output estimate, the gravitational anomaly estimate, and the gravity map data; and generating the navigation output based on the inertial sensor data, gravity map data and the navigation and sensor corrections.