A method for performing localization and mapping of a mapping device. The method includes: capturing images of environment by a visual sensor of the mapping device, and processing the captured images to obtain a set of high-resolution images and a set of low-resolution images; determining motion-scale measurement of the mapping device using an inertial sensor and an odometer; generating, by a controller of the mapping device, a first mask corresponding to dynamic features in the low-resolution images; extracting features from the high-resolution images; recovering, by the controller, poses of the mapping device based on the high-resolution images and the motion-scale measurements; filtering out, by the controller, the features from the high-resolution images that correspond to the first mask, to obtain filtered features; and performing, by the controller, localization and mapping using the poses and the filtered features.