2022 International Conference on Robotics and Automation (ICRA) · 2022 · 18 citations · 27 references
ComputingAutonomous SystemsRobotics EngineeringAutonomous VehiclesMotion PlanningRoboticsNavigation PlanningProbabilistic RoadmapsRobot Motion PlanningRobot NavigationTrajectory OptimizationUncertainty EstimationBelief-space PlanningMotion Planning Under UncertaintyMulti-query Motion PlanningTerminal ConstraintsUncertainty-aware Planning
A new belief space planning algorithm, called covariance steering Belief RoadMap (CS-BRM), is introduced, which is a multi-query algorithm for motion planning of dynamical systems under simultaneous motion and observation uncertainties. CS-BRM extends the probabilistic roadmap (PRM) approach to belief spaces and is based on the recently developed theory of covariance steering (CS) that enables guaranteed satisfaction of terminal belief constraints in finitetime. The CS-BRM algorithm allows the sampling of non-stationary belief nodes, and thus is able to explore the velocity space and find efficient motion plans. We evaluate CS-BRM in different planning problems and demonstrate the benefits of the proposed approach.
27