FIImap: Fast Incremental Inflate Mapping for Autonomous MAV Navigation

Abstract

Three-dimensional mapping is an essential component of autonomous Micro Aerial Vehicle (MAV) navigation. The paper focuses on the 3D spatial representation method of MAV to overcome the collision problem caused by soft constraints, control error, and planning with the center of mass by inflating the occupancy grid map. A fast incremental inflated map construction method is proposed, which reduces the time-consumption caused by the increase of map range and inflated size. The method focuses on areas of the map that occupied state changes and introduces two arrays that record newly appearing and disappearing obstacles. Then, a series of breadth-first search algorithms are used to traverse the parts of the inflated map that need local modification to update the inflated map. Moreover, a sliding map model is designed based on the MAV position, which is suitable for large-range autonomous flight. The effectiveness of the proposed approach is verified with simulated and actual flight data. The proposed method takes about 3 ms to construct the inflated map with a local update range of 16 m × 16 m × 6 m.