Pseudospectral collocation methods have proven to be powerful tools to solve optimal control problems. While these methods generally assume the dynamics is given in the first order form $\dot{x} = f (x, u, t)$, where x is the state and u is the control vector, robotic systems are typically governed by second order ODEs of the form $\ddot{q} = g(q, \dot{q}, u, t)$, where q is the configuration. To convert the second order ODE into a first order one, the usual approach is to introduce a velocity variable v and impose its coincidence with the time derivative of q. Lobatto methods grant this constraint by construction, as their polynomials describing the trajectory for v are the time derivatives of those for q, but the same cannot be said for the Gauss and Radau methods. This is problematic for such methods, as then they cannot guarantee that $\ddot{q} = g(q, \dot{q}, u, t)$ at the collocation points. On their negative side, Lobatto methods cannot be used to solve initial value problems, as given the values of u at the collocation points they generate an overconstrained system of equations for the states. In this paper, we propose a Legendre-Gauss collocation method that retains the advantages of the usual Lobatto, Gauss, and Radau methods, while avoiding their shortcomings. The collocation scheme we propose is applicable to solve initial value problems, preserves the consistency between the polynomials for v and q, and ensures that $\ddot{q} = g(q, \dot{q}, u, t)$ at the collocation points.
翻译:psedo 光谱共定位方法已被证明是解决最佳控制问题的强大工具 。 虽然这些方法一般假定动态以第一个顺序 $\ dot{x} = f (x, u, t) 表示, x 是状态, u 是控制矢量, 机器人系统通常由第二个顺序 以 $\ddot{q} = g(q,\ dot{q} = g, u, t) 表示, q 配置为 。 要将第二顺序 ODE 转换为第一个顺序, 通常的做法是引入一个速度变量 v = f (x, u, t) = f( f) = f(x, u, q) = 控制源量, 机器人系统通常为 q(qddddot}, u, u, et) 调控为 colot 。 这对方法来说很不妥, 因为它无法保证 $ddddo, dot = dalt (q} = g, lives liver- levelys, legs to the dalmotions as the sals lavelys, as the salds lavel the salds, the saldaldaldalds saldaldaldaldalds, yss salds) at sixs at salds.