基于数值变分计算的Acrobot 机器臂能量最优控制

李江成，詹清华，区国洪，何 俊

（1.广东省立胜技术有限公司，广东 佛山 528200；2.佛山科学技术学院机电工程与自动化学院，广东佛山 528225）

欠驱动机器臂包括肘部驱动（Acrobot）和肩部驱动（Pendubot）两种［1-2］，实际系统中Acrobot 模型由于有重力的存在，表现为2 阶微分约束系统，这类系统是可控的，因而从初始位置驱动系统至期望位置的控制问题理论上是可以实现的。近期出现了一类分区域控制欠驱动机器臂的方法，即将控制区域分为摇起区和吸引区，在吸引区线性化系统再采用线性系统理论稳定系统，需要指出的是Acrobot 是不可完全线性化的［3-4］，在控制器中加入扰动或者起始力矩来改变系统的初始状态达到控制目的，二者在摇起区的线性化策略从理论上是不可行的［5-10］。基于这方面的原因，智能控制的思想在本领域得到应用，本文将采用变分原理来研究Acrobot 的控制问题。

1 欠驱动机器臂Acrobot 动力模型

Acrobot 的模型结构如图1 所示。图1 中，mi（i=1，2）表示第i杆的质量，li表示第i 杆的长度，lci表示从i 关节到i 杆质心的距离，Ii表示第i 杆相对于质心的惯性，q1表示第一杆相对于垂直向上y 轴的角度，q2表示第二杆相对第一杆的角度，τ2为作用在第二连杆上的控制力，g 为重力加速度。

图1 Acrobot 的模型结构

令q=［q1，q2］·，Acrobot 的动力学方程满足

其中，

于是有

优化控制的前提是假定存在一种控制律，能够引导系统从初始状态运动至终端状态，文献［11-12］证明了存在一种控制器完成Acrobot 从平衡点到平衡点的切换。下面讨论系统从垂直向下平衡点到垂直顶点的最优控制器设计，这种情形性能指标中的被积函数的横截条件总是满足的。……