A Time-Freezing Approach for Numerical Optimal Control of Nonsmooth Differential Equations With State Jumps

We present a novel reformulation of nonsmooth differential equations with state jumps enabling their easier simulation and use in optimal control problems without the need for integer variables. The main idea is to introduce an auxiliary differential equation to mimic the state jump map. Thereby, a clock state is introduced which does not evolve during the runtime of the auxiliary system. The pieces of the trajectory that correspond to the parts when the clock state was evolving recover the solution of the original system with jumps. Our reformulation results in nonsmooth ordinary differential equations where the discontinuity is in the first time derivative of the trajectory, rather than in the trajectory itself. This class of systems is easier to handle both theoretically and numerically. The reformulation is suitable for partially elastic mechanical impact problems. We provide numerical examples demonstrating the ease of use of this reformulation in both simulation and optimal control. In the optimal control example, we solve a sequence of nonlinear programming problems (NLPs) in a homotopy penalization approach and recover a time-optimal trajectory with state jumps.

[1]  Aleksej F. Filippov,et al.  Differential Equations with Discontinuous Righthand Sides , 1988, Mathematics and Its Applications.

[2]  Hyungbo Shim,et al.  State estimation strategy without jump detection for hybrid systems using gluing function , 2014, 53rd IEEE Conference on Decision and Control.

[3]  Marco Hutter,et al.  Gait and Trajectory Optimization for Legged Systems Through Phase-Based End-Effector Parameterization , 2018, IEEE Robotics and Automation Letters.

[4]  Yuval Tassa,et al.  Synthesis and stabilization of complex behaviors through online trajectory optimization , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Bernard Brogliato,et al.  Dynamical Systems Coupled with Monotone Set-Valued Operators: Formalisms, Applications, Well-Posedness, and Stability , 2020, SIAM Rev..

[6]  Stephen J. Wright,et al.  Some properties of regularization and penalization schemes for MPECs , 2004, Optim. Methods Softw..

[7]  R. Sanfelice,et al.  Hybrid dynamical systems , 2009, IEEE Control Systems.

[8]  Moritz Diehl,et al.  Limits of MPCC Formulations in Direct Optimal Control with Nonsmooth Differential Equations , 2020, 2020 European Control Conference (ECC).

[9]  Mihai Anitescu,et al.  Optimal control of systems with discontinuous differential equations , 2010, Numerische Mathematik.

[10]  Christian Kirches,et al.  Numerical solution of optimal control problems with explicit and implicit switches , 2018, Optim. Methods Softw..

[11]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[12]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.

[13]  Jorge Nocedal,et al.  Interior Methods for Mathematical Programs with Complementarity Constraints , 2006, SIAM J. Optim..

[14]  Lei Guo,et al.  Necessary Optimality Conditions for Optimal Control Problems with Equilibrium Constraints , 2016, SIAM J. Control. Optim..

[15]  D. Stewart Dynamics with Inequalities: Impacts and Hard Constraints , 2011 .

[16]  Bernard Brogliato,et al.  Quadratic Optimal Control of Linear Complementarity Systems: First-Order Necessary Conditions and Numerical Analysis , 2020, IEEE Transactions on Automatic Control.

[17]  Luca Dieci,et al.  Sliding motion on discontinuity surfaces of high co-dimension. A construction for selecting a Filippov vector field , 2011, Numerische Mathematik.

[18]  B. Brogliato,et al.  Numerical Methods for Nonsmooth Dynamical Systems: Applications in Mechanics and Electronics , 2008 .

[19]  Jong-Shi Pang,et al.  Differential variational inequalities , 2008, Math. Program..

[20]  B. Brogliato Nonsmooth Mechanics: Models, Dynamics and Control , 1999 .

[21]  J. Moreau Evolution problem associated with a moving convex set in a Hilbert space , 1977 .

[22]  B. T. Baumrucker,et al.  MPEC strategies for optimization of a class of hybrid dynamic systems , 2009 .

[23]  Ricardo G. Sanfelice,et al.  A Model Predictive Control Framework for Hybrid Dynamical Systems , 2018 .

[24]  Russ Tedrake,et al.  A direct method for trajectory optimization of rigid bodies through contact , 2014, Int. J. Robotics Res..