Collocation methods for second and higher order systems

by   Siro Moreno-Martín, et al.

It is often unnoticed that the predominant way to use collocation methods is fundamentally flawed when applied to optimal control in robotics. Such methods assume that the system dynamics is given by a first order ODE, whereas robots are often governed by a second or higher order ODE involving configuration variables and their time derivatives. To apply a collocation method, therefore, the usual practice is to resort to the well known procedure of casting an M th order ODE into M first order ones. This manipulation, which in the continuous domain is perfectly valid, leads to inconsistencies when the problem is discretized. Since the configuration variables and their time derivatives are approximated with polynomials of the same degree, their differential dependencies cannot be fulfilled, and the actual dynamics is not satisfied, not even at the collocation points. This paper draws attention to this problem, and develops improved versions of the trapezoidal and Hermite-Simpson collocation methods that do not present these inconsistencies. In many cases, the new methods reduce the dynamic transcription error in one order of magnitude, or even more, without noticeably increasing the cost of computing the solutions.


A Legendre-Gauss Pseudospectral Collocation Method for Trajectory Optimization in Second Order Systems

Pseudospectral collocation methods have proven to be powerful tools to s...

Higher-order retraction maps and construction of numerical methods for optimal control of mechanical systems

Retractions maps are used to define a discretization of the tangent bund...

Higher Order c-Differentials

EFRST20, the notion of c-differentials was introduced as a potential exp...

Higher-order Stein kernels for Gaussian approximation

We introduce higher-order Stein kernels relative to the standard Gaussia...

An Overview of Formulae for the Higher-Order Kinematics of Lower-Pair Chains with Applications in Robotics and Mechanism Theory

The motions of mechanisms can be described in terms of screw coordinates...

Boundary control of time-harmonic eddy current equations

Motivated by various applications, this article develops the notion of b...

Stability of Optimal Filter Higher-Order Derivatives

In many scenarios, a state-space model depends on a parameter which need...

Please sign up or login with your details

Forgot password? Click here to reset