3-D environment mapping systems and methods of dynamically mapping a 3-D environment

A 3-D environment mapping systems and methods of dynamically mapping a 3-D environment includes identifying at least five point correspondences associated with image frames of a scene recorded by a camera from a plurality of viewpoints. A down direction is determined from IMU motion data. The down direction is an absolute global downward direction. Components of the scene that are vertical are identified using the down direction, an iteration of 3-D position of each of the five point correspondences, and a current iteration of refined relative locations and poses of the camera. A 2-D map is generated of the scene by mapping the identified components of the scene in an eagle view of the scene.