FESD-J: Finite Elements with Switch Detection for Numerical Optimal Control of Rigid Bodies with Impacts and Coulomb Friction

TL;DR

FESD-J is an advanced numerical method that accurately simulates and solves optimal control problems involving multiple rigid bodies with impacts and friction, ensuring precise switch detection and impulse calculation.

Contribution

The paper extends the FESD method to handle multiple rigid bodies with impacts and Coulomb friction, incorporating exact switch detection and impact equations within a finite element framework.

Findings

Accurate simulation of impacts and friction in rigid bodies.

Effective optimal control solutions for systems with discontinuities.

Open-source implementation in NOSNOC available.

Abstract

The Finite Elements with Switch Detection (FESD) is a high-accuracy method for the numerical simulation and solution of optimal control problems subject to discontinuous ODEs. In this article, we extend the FESD method [Nurkanovi\'c et al., 2022] to the dynamic equations of multiple rigid bodies that exhibit state jumps due to impacts and Coulomb friction. This new method is referred to as FESD with Jumps (FESD-J). Starting from the standard Runge-Kutta equations, we let the integration step sizes be degrees of freedom. Additional constraints are introduced to ensure exact switch detection and to remove spurious degrees of freedom if no switches occur. Moreover, at the boundaries of each finite element, we impose the impact equations in their complementarity form, at both the position and velocity level. They compute the normal and tangential impulses in case of contact making. Otherwise, they are reduced to the continuity conditions for the velocities. FESD-J treats multiple contacts, where each contact can have a different coefficient of restitution and friction. All methods introduced in this paper are implemented in the open-source software package NOSNOC. We illustrate the use of FESD-J in both simulation and optimal control examples.