Safe Optimal Control Under Parametric Uncertainties

We address the issue of safe optimal path planning under parametric uncertainties using a novel regularizer that allows trading off optimality with safety. The proposed regularizer leverages the notion that collisions may be modeled as constraint violations in an optimal control setting in order to produce open-loop trajectories with reduced risk of collisions. The risk of constraint violation is evaluated using a state-dependent relevance function and first-order variations in the constraint function with respect to parametric variations. The approach is generic and can be adapted to any optimal control formulation that deals with constraints under parametric uncertainty. Simulations using a holonomic robot avoiding multiple dynamic obstacles with uncertain velocities are used to demonstrate the effectiveness of the proposed approach. Finally, we introduce the car vs. train problem to emphasize the dependence of the resultant risk aversion behavior on the form of the constraint function used to derive the regularizer.

[1]  Jonathan P. How,et al.  Robust Sampling-based Motion Planning with Asymptotic Optimality Guarantees , 2013 .

[2]  Anil V. Rao,et al.  GPOPS-II , 2014, ACM Trans. Math. Softw..

[3]  Qiuming Zhu,et al.  Hidden Markov model for dynamic obstacle avoidance of mobile robot navigation , 1991, IEEE Trans. Robotics Autom..

[4]  Jonathan P. How,et al.  Threat-aware path planning in uncertain urban environments , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Panganamala Ramana Kumar,et al.  Non-Gaussian SLAP: Simultaneous Localization and Planning Under Non-Gaussian Uncertainty in Static and Dynamic Environments , 2016, ArXiv.

[6]  Philippe Fraisse,et al.  Guaranteed computation of constraints for safe path planning , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[7]  Panagiotis Tsiotras,et al.  C-DOC: Co-State Desensitized Optimal Control , 2019, 2020 American Control Conference (ACC).

[8]  Dinesh Manocha,et al.  PORCA: Modeling and Planning for Autonomous Driving Among Many Pedestrians , 2018, IEEE Robotics and Automation Letters.

[9]  Jur P. van den Berg,et al.  Anytime path planning and replanning in dynamic environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[10]  Cheng Zhang,et al.  Improving lifting motion planning and re-planning of cranes with consideration for safety and efficiency , 2012, Adv. Eng. Informatics.

[11]  Pieter Abbeel,et al.  LQG-MP: Optimized path planning for robots with motion uncertainty and imperfect state information , 2010, Int. J. Robotics Res..

[12]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[13]  P. Olver.  Nonlinear Systems , 2013 .

[14]  Jaime F. Fisac,et al.  Safely Probabilistically Complete Real-Time Planning and Exploration in Unknown Environments , 2018, 2019 International Conference on Robotics and Automation (ICRA).

[15]  Joel W. Burdick,et al.  Robotic motion planning in dynamic, cluttered, uncertain environments , 2010, 2010 IEEE International Conference on Robotics and Automation.

[16]  Richard W. Powell,et al.  Desensitizing the Minimum-Fuel Powered Descent For Mars Pinpoint Landing , 2010 .

[17]  James J. Kuffner,et al.  Multipartite RRTs for Rapid Replanning in Dynamic Environments , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[18]  Jaime F. Fisac,et al.  Reachability-based safe learning with Gaussian processes , 2014, 53rd IEEE Conference on Decision and Control.

[19]  Kris K. Hauser.  On responsiveness, safety, and completeness in real-time motion planning , 2012, Auton. Robots.

[20]  Joseph S. B. Mitchell,et al.  Geometric Shortest Paths and Network Optimization , 2000, Handbook of Computational Geometry.

[21]  Jonathan P. How,et al.  Probabilistically safe motion planning to avoid dynamic obstacles with uncertain motion patterns , 2013, Auton. Robots.

[22]  Claire J. Tomlin,et al.  A practical reachability-based collision avoidance algorithm for sampled-data systems: Application to ground robots , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Christian Laugier,et al.  Dynamic Obstacle Avoidance in uncertain environment combining PVOs and Occupancy Grid , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[24]  Josep Tornero,et al.  Path planning and trajectory generation using multi-rate predictive Artificial Potential Fields , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  John M. Dolan,et al.  Motion planning under uncertainty for on-road autonomous driving , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[26]  Steffen Beirle,et al.  Parameterizing the instrumental spectral response function and its changes by a super-Gaussian and its derivatives , 2016 .

[27]  Panagiotis Tsiotras,et al.  Trajectory Desensitization in Optimal Control Problems , 2018, 2018 IEEE Conference on Decision and Control (CDC).