Guaranteed Reachability on Riemannian Manifolds for Unknown Nonlinear Systems (2404.09850v1)
Abstract: Determining the reachable set for a given nonlinear system is critically important for autonomous trajectory planning for reach-avoid applications and safety critical scenarios. Providing the reachable set is generally impossible when the dynamics are unknown, so we calculate underapproximations of such sets using local dynamics at a single point and bounds on the rate of change of the dynamics determined from known physical laws. Motivated by scenarios where an adverse event causes an abrupt change in the dynamics, we attempt to determine a provably reachable set of states without knowledge of the dynamics. This paper considers systems which are known to operate on a manifold. Underapproximations are calculated by utilizing the aforementioned knowledge to derive a guaranteed set of velocities on the tangent bundle of a complete Riemannian manifold that can be reached within a finite time horizon. We then interpret said set as a control system; the trajectories of this control system provide us with a guaranteed set of reachable states the unknown system can reach within a given time. The results are general enough to apply on systems that operate on any complete Riemannian manifold. To illustrate the practical implementation of our results, we apply our algorithm to a model of a pendulum operating on a sphere and a three-dimensional rotational system which lives on the abstract set of special orthogonal matrices.
- T. Shafa and M. Ornik, “Reachability of nonlinear systems with unknown dynamics,” IEEE Transactions on Automatic Control, vol. 68, no. 4, pp. 2407–2414, 2022.
- ——, “Maximal ellipsoid method for guaranteed reachability of unknown fully actuated systems,” in 2022 IEEE 61st Conference on Decision and Control (CDC). IEEE, 2022, pp. 5002–5007.
- V. Jurdjevic and H. J. Sussmann, “Control systems on Lie groups,” Journal of Differential Equations, vol. 12, no. 2, pp. 313–329, 1972.
- C. Altafini, “Feedback stabilization of isospectral control systems on complex flag manifolds: application to quantum ensembles,” IEEE Transactions on Automatic Control, vol. 52, no. 11, pp. 2019–2028, 2007.
- J. Zhu, E. Trélat, and M. Cerf, “Geometric optimal control and applications to aerospace,” Pacific Journal of Mathematics for Industry, vol. 9, no. 1, pp. 1–41, 2017.
- S. Liu, Y. Fan, and M.-A. Belabbas, “Affine geometric heat flow and motion planning for dynamic systems,” IFAC-PapersOnLine, vol. 52, no. 16, pp. 168–173, 2019.
- H. Benninghoff, T. Boge, and F. Rems, “Autonomous navigation for on-orbit servicing,” KI-Künstliche Intelligenz, vol. 28, pp. 77–83, 2014.
- Y. Fan, S. Liu, and M.-A. Belabbas, “Geometric heat flow method for legged locomotion planning,” IEEE Control Systems Letters, vol. 5, no. 3, pp. 941–946, 2020.
- M. Spong, K. Khorasani, and P. Kokotovic, “An integral manifold approach to the feedback control of flexible joint robots,” IEEE Journal on Robotics and Automation, vol. 3, no. 4, pp. 291–300, 1987.
- A. A. Kilin, E. N. Pivovarova, and T. B. Ivanova, “Spherical robot of combined type: Dynamics and control,” Regular and chaotic dynamics, vol. 20, pp. 716–728, 2015.
- R. W. Brockett, “Nonlinear systems and differential geometry,” Proceedings of the IEEE, vol. 64, no. 1, pp. 61–72, 1976.
- I. M. Mitchell and C. J. Tomlin, “Overapproximating reachable sets by Hamilton-Jacobi projections,” Journal of Scientific Computing, vol. 19, no. 1, pp. 323–346, 2003.
- H. Kong, E. Bartocci, and T. A. Henzinger, “Reachable set over-approximation for nonlinear systems using piecewise barrier tubes,” in International Conference on Computer Aided Verification, 2018, pp. 449–467.
- M. Ornik, S. Carr, A. Israel, and U. Topcu, “Control-oriented learning on the fly,” IEEE Transactions on Automatic Control, vol. 65, no. 11, pp. 4800–4807, 2019.
- J. Ding, E. Li, H. Huang, and C. J. Tomlin, “Reachability-based synthesis of feedback policies for motion planning under bounded disturbances,” in 2011 IEEE International Conference on Robotics and Automation, 2011, pp. 2160–2165.
- S. V. Rakovic, E. C. Kerrigan, D. Q. Mayne, and J. Lygeros, “Reachability analysis of discrete-time systems with disturbances,” IEEE Transactions on Automatic Control, vol. 51, no. 4, pp. 546–561, 2006.
- S. Mohan and R. Vasudevan, “Convex computation of the reachable set for hybrid systems with parametric uncertainty,” in 2016 American control conference, 2016, pp. 5141–5147.
- M. Althoff, O. Stursberg, and M. Buss, “Reachability analysis of nonlinear systems with uncertain parameters using conservative linearization,” in 2008 47th IEEE Conference on Decision and Control, 2008, pp. 4042–4048.
- B. Wingo, M. Murtaza, V. Azimi, and S. Hutchinson, “Adaptively robust control policy synthesis through Riemannian motion policies,” IEEE Control Systems Letters, vol. 6, pp. 31–36, 2020.
- S. Calinon, “Gaussians on Riemannian manifolds: Applications for robot learning and adaptive control,” IEEE Robotics & Automation Magazine, vol. 27, no. 2, pp. 33–45, 2020.
- H. Sussmann, “Reachability by means of nice controls,” in 26th IEEE Conference on Decision and Control, vol. 26. IEEE, 1987, pp. 1368–1373.
- V. Ayala, H. Román-Flores, and A. Da Silva, “About the continuity of reachable sets of restricted affine control systems,” Chaos, Solitons & Fractals, vol. 94, pp. 37–43, 2017.
- O. Thapliyal and I. Hwang, “Approximating reachable sets for neural network-based models in real time via optimal control,” IEEE Transactions on Control Systems Technology, 2023.
- A. Devonport and M. Arcak, “Data-driven reachable set computation using adaptive gaussian process classification and monte carlo methods,” in 2020 American Control Conference (ACC), 2020, pp. 2629–2634.
- M. Ornik, “Guaranteed reachability for systems with unknown dynamics,” in 2020 59th IEEE Conference on Decision and Control (CDC). IEEE, 2020, pp. 2756–2761.
- G. W. Stewart, “Perturbation theory for the singular value decomposition,” Tech. Rep., 1998.
- P. E. Crouch and R. Grossman, “Numerical integration of ordinary differential equations on manifolds,” Journal of Nonlinear Science, vol. 3, pp. 1–33, 1993.
- C. J. Budd and A. Iserles, “Geometric integration: numerical solution of differential equations on manifolds,” Philosophical Transactions of the Royal Society of London. Series A: Mathematical, Physical and Engineering Sciences, vol. 357, no. 1754, pp. 945–956, 1999.
- E. Hairer, “Solving differential equations on manifolds,” 2011.
- E. A. Cross and I. M. Mitchell, “Level set methods for computing reachable sets of systems with differential algebraic equation dynamics,” in 2008 American Control Conference, 2008, pp. 2260–2265.
- M. Kamruzzaman and M. C. Nath, “A comparative study on numerical solution of initial value problem by using Euler’s method, modified Euler’s method and Runge–Kutta method,” Journal of computer and mathematical sciences, vol. 9, no. 5, pp. 493–500, 2018.
- R. Tedrake, “Underactuated robotics: Learning, planning, and control for efficient and agile machines course notes for mit 6.832,” Working draft edition, vol. 3, no. 4, p. 2, 2009.
- C.-S. Man, “Crystallographic texture and group representations,” Journal of Elasticity, vol. 149, no. 1, pp. 3–445, 2022.