A strategy for efficient observation pruning in multi-objective 3D SLAM

An efficient automatic solution to the feature-based simultaneous localisation and mapping (SLAM) of mobile robots operating in conditions where a number of competing objectives operate simultaneously is proposed. The formulation quantitatively measures the merit of incoming data with respect to multiple priorities, automatically adjusting the amount of observations to be used in the estimation process for the best possible combined outcome. The methodology enables a selection mechanism which can efficiently exploit the observations available to the robot to best fulfil the objectives of differing tasks throughout the course of a mission, e.g. localisation, mapping, exploration, feature distribution, searching for specific objects or victims, etc. The work is particularly motivated by navigation in three-dimensional terrains, and an example considering the objectives of robot localisation and map expansion in a search and rescue environment using an RGB-D camera is utilised for discussion and results.