机器人的运动控制.doc

《机器人的运动控制.doc》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、2.4手臂的控制2.4.1运动控制对于机器人手臂的运动来说，人们通常关注末端的运动，而末端运动乃是由各个关节的运动合成实现的。因而必须考虑手臂末端的位置、姿态与各个关节位移之间的关系。此外，手臂运动，不仅仅涉及末端从某个位置向另外一个位置的移动，有时也希望它能沿着特定的空间路径进行移动。为此，不仅要考虑手臂末端的位置，而且还必须顾及它的速度和加速度。若再进一步从控制的观点来看，机器人手臂是一个复杂的多变量非线性系统，各关节之间存在耦合，为了完成高精度运动，必须对相互的影响进行补偿。1.关节伺服和作业坐标伺服现在来研究n个自由度的手臂，设关节位移以n维向量表示，是

2、第i个关节的位移，刚性臂的关节位移和末端位置、姿态之间的关系以下式给出：（1）是某作业坐标系表示的m维末端向量，当它表示三维空间的位置姿态时，m=6。如式（1）所示，对刚性臂来说，由于各关节的位移完全决定了手臂末端的位置姿态，故如欲控制手臂运动，只要控制各关节的运动即可。设刚性臂的运动方程式如下所示：（2）式中，为手臂的惯性矩阵；为表示离心力和哥氏力的向量，为粘性摩擦系数矩阵；为表示重力项的向量；为关节驱动力向量。机器人手臂的驱动装置是一个为了跟踪目标值对手臂当前运动状态进行反馈构成的伺服系统。无论何种伺服系统结构，控制装置的功能都是检测各关节的当前位置及速度，

3、将它们作为反馈信号，最后直接或间接地决定各关节的驱动力。图1给出了控制系统的构成示意图。来自示教、数值数据或外传感器的信号等构成了作业指令，控制系统根据这些指令，在目标轨迹生成部分产生伺服系统需要的目标值。伺服系统的构成方法因目标值的选取方法的不同而异，大体上可以分为关节伺服和作业坐标伺服两种。当目标值为速度、加速度量纲时，分别称之为速度控制或加速度控制，关于这些将在本节2.和3.中加以叙述。图1刚性臂控制系统的构成1）关节伺服控制讨论以各关节位移的形式给定手臂运动目标值的情况。令关节的目标值为。图2给出了关节伺服的构成。若目标值是以关节位移的形式给出的，那么如

4、图2所示，各个关节可以独立构成伺服系统，因此问题就变得十分简单。目标值可以根据末端目标值由式（1）的反函数，即逆运动学（inversekinematics）的计算得出（3）图2关节伺服构成举例如果是工业机器人经常采用的示教方法，那么示教者实际上都是一面看着手臂末端，一面进行示教的，所以不必进行式（3）的计算，是直接给出的。如果想让手臂静止于某个点，只要对取定值即可，当欲使手臂从某个点向另一个点逐渐移动，或者使之沿某一轨迹运动时，则必须按时间的变化使发生变化。为了简单起见，假设驱动器的动态特性忽略不计，各个关节的驱动力可以直接给出。这时，最简单的一种伺服系统如下所

5、示：（4）是比例增益，是速度反馈增益。对于全部关节，可以将式（4）归纳表示为（5）式中，；。这种关节伺服系统把每一个关节作为简单的单输入、单输出系统来处理，所以其结构简单，现在的工业机器人大部分都由这种关节伺服系统来控制。但是，从式（2）中可知，从手臂的动态特性来看，严格地说，每个关节都不是单输入、单输出系统，惯性项和速度项在关节彼此之间存在动态耦合。在式（5）所表示的关节伺服中，这些耦合均被视为外部干扰来进行处理，为了减少外部干扰的影响，在保持稳定性围应该尽量将增益、设置得大一些。但无论怎样加大增益，由于重力项的影响，手臂在静止状态下，各个关节仍会产生稳态误差

6、，即将式（5）代入式（6）中，若，将产生下式所示的稳态误差e：（6）有时为了使稳态误差为零，可在式（5）中再加上积分项，构成（7）式中，为积分环节的增益矩阵，和、一样，它是一个对角矩阵。传统上，上述伺服系统是用模拟电路构成的。近年来，由于微处理器和信号处理器等高性能、低价格的计算器件的普及，将伺服系统的一部分或全部改成数字电路的所谓软件伺服已经很普遍了。与模拟电路的情况相比，软件伺服能进行更精细的控制。例如，不再让各个关节的增益、固定不变，而是让其按照手臂不同姿态时所期望的响应特性而变化，用下式代替式（7），通过对重力项的计算，直接实现重力项的补偿（8）后续的容

7、中，都是在软件伺服假设的前提下展开讨论的。如后面所述，软件伺服系统方式还能有比式（7）和式（8）更高级的控制方法，但是即使用式（7）和式（8）的简单的控制方法，闭环系统的平衡点也能达到渐进稳定，即经过无限长的时间，能收敛于。即在多数场合，式（7）和式（8）的控制方法已经足够了。2）作业坐标伺服控制关节伺服控制的结构简单，对软件伺服来说，计算量少，采样时间较短，所以是工业机器人经常采用的方法，这一点已经在前面有所论述。但在自由空间对手臂进行控制时，在很多场合都希望直接给出手臂末端位置、姿态运动的显式表达。例如，让手臂从某个点沿直线运动至另一个点就是这种情况。在这种

8、情况下，很自然会取末端姿