The invention belongs to the technical field of
mobile robot navigation, and particularly relates to a
robot joint SLAM and multi-target tracking method based on a random finite set. A
mobile robot, a plurality of static landmarks and dynamic targets exist in the scene, and the positions of the static landmarks and the dynamic targets are unknown, so that the positioning method comprises joint positioning of the
robot, the static landmarks and the dynamic targets. Distance, angle and category measurement values acquired by a sensor can be combined, and a
Gaussian mixture probability
hypothesis density filtering and multi-model
interaction method is used for solving, so that
robot self-positioning, environment mapping and target tracking are realized. The positions of the maneuvering target and the static environment can be accurately estimated, the method is simple, and the effect is good.