Control Design along Trajectories with Sums of Squares Programming
基于平方和规划的轨迹控制设计
Anirudha Majumdar, Amir Ali Ahmadi, Russ Tedrake
AI总结 提出一种通过平方和规划最大化不变漏斗尺寸的控制设计方法,以形式化保证机器人控制任务的稳定性和安全性。
详情
受对具有挑战性的机器人控制任务的控制器稳定性和安全性形式化保证需求的驱动,我们提出了一种控制设计程序,该程序明确寻求最大化通向预定义目标集的不变“漏斗”的尺寸。我们的不变性证明以适当定义的Lyapunov不等式组的平方和证明形式给出。这些证明以及我们提出的多项式控制器可以通过半定优化高效获得。我们的方法可以处理跟踪给定轨迹导致的时变动力学、输入饱和(例如力矩限制),并可扩展到处理动力学和状态的不确定性。所得控制器可用于空间填充反馈运动规划算法,以显著减少轨迹数量填充空间。我们在一个严重力矩受限的欠驱动双摆(Acrobot)上演示了我们的方法,并提供了广泛的仿真和硬件验证。
Motivated by the need for formal guarantees on the stability and safety of controllers for challenging robot control tasks, we present a control design procedure that explicitly seeks to maximize the size of an invariant "funnel" that leads to a predefined goal set. Our certificates of invariance are given in terms of sums of squares proofs of a set of appropriately defined Lyapunov inequalities. These certificates, together with our proposed polynomial controllers, can be efficiently obtained via semidefinite optimization. Our approach can handle time-varying dynamics resulting from tracking a given trajectory, input saturations (e.g. torque limits), and can be extended to deal with uncertainty in the dynamics and state. The resulting controllers can be used by space-filling feedback motion planning algorithms to fill up the space with significantly fewer trajectories. We demonstrate our approach on a severely torque limited underactuated double pendulum (Acrobot) and provide extensive simulation and hardware validation.