[发明专利]一种用于单自由度柔性末端的机械臂控制算法

说明书

技术领域

本发明涉及一种用于单自由度柔性末端的机械臂控制算法，属于机械臂结构和控制技术领域。

背景技术

机械臂被广泛使用在机械制造、航空航天、医药、原子能等领域，对自动化生产起到了重大作用。机械臂在运动中可以分为自由运动和受力运动，自由运动一般应用在喷漆、焊接、码垛等工作中，在这样的环境中机械臂不直接和外界环境接触，所以在控制上只需要考虑路径规划问题，目前该方面的研究应用较为成熟。对于受力运动即机械臂在运动的过程中和环境发生交互作用，需要和外界进行接触来完成指定的功能，像打磨、钻孔、抛光等，最简单的莫过于抓取，在受力运动中，机械臂不但要进行精确的位置控制，而且需恰当地控制接触力大小，否则难以完成任务甚至损坏器物。这种能对外界力做出运动调整的控制方式称为柔顺控制，极大地拓展了机械臂的安全性与应用领域。

机械臂与外界环境接触力的控制体现出机械臂具有一定的柔顺性。为了使机器人对外界具有柔顺性，现有的控制方法可以分为两种：被动柔顺控制和主动柔顺控制。被动柔顺即利用能够储存或吸收能量的机械器件把机械臂与作用环境分隔开，如弹簧、阻尼等具有弹性的机构，使机器人与环境相接触时对外部的作用力产生一定的自然顺从能力。最具有代表性的被动柔顺装置是美国一个实验室设计的一种称为远程中心柔顺的无源机械装置，它是一个由六根弹簧构成的能顺从空间六个自由度的柔顺手腕，但它不能使机器人本身产生对力的反应。另外被动柔顺控制由于弹性构件的变形导致难以精确控制位置，因而其一般应用在要求比较低的场合。

主动柔顺控制是把力完整的体现在控制系统中，应用控制算法来抵消位置和力双向误差，如阻抗控制、刚度控制、力/位混合控制等，但往往需要机械臂开放力矩控制，这是目前市场上的机械臂难以做到的，而且力矩控制需要从底层控制器上进行算法编程，大大地增加了控制算法的复杂程度。

发明内容

有鉴于此，本发明提供了一种用于单自由度柔性末端的机械臂控制算法，通过速度控制的方式来实现机械臂和环境之间的力交互控制，简化了算法的复杂性；通过在机械臂末端安装力传感器的方式对接触力进行测量，从而完成主动柔顺控制；通过在工具和力传感器之间增加单自由度的柔性连接来提高位置控制精度，即结合了传统的被动柔顺控制和主动柔顺控制的优点，从而使机械臂完成与环境之间的良好交互控制。

一种用于单自由度柔性末端的机械臂控制算法，该算法基于单自由度柔性末端的机械臂，机械臂末端固定连接力传感器，力传感器与轴承套固定连接，工具通过直线轴承安装在轴承套中，工具只能沿直线轴承的轴向滑动，弹簧安装在轴承套内部的空腔内，弹簧的两端分别与工具和力传感器抵触；

该算法首先建立世界坐标系、接触力测量坐标系和运动坐标系，通过柔顺度来建立起机械臂末端运动速度和接触力的关系，整体的柔顺度为机械臂的柔顺度、工具末端的柔顺度以及环境的柔顺度之和；由所需控制的接触力得到机械臂末端运动速度，通过逆运动学求解完成机械臂各个关节角的转动速度并控制机械臂运动，再通过PD控制器使接触力达到稳定值。

进一步地，所述控制算法的计算步骤如下：

第一步：建立坐标系

机械臂的基座上建立世界坐标系{W}，在力传感器测量端面上建立接触力测量坐标系{S}，此外，再建立一个运动坐标系{C}，运动坐标系{C}以工具末端和环境的接触点为原点，工具的轴线方向为Z轴；

第二步：求解机械臂末端与环境接触点在世界坐标系{W}下的速度

机械臂末端与环境的接触点在世界坐标系{W}中的输出位置为y，通过运动学关系可以表示为：

y＝f(q,x_u)(1)

其中q为机械臂的关节角，x_u为整个系统的未能控制的自由度所产生的位移，包括环境接触的变形量以及弹簧的变形量；交互环境限定为刚性环境，环境的变形量可以忽略不计，因此整个系统未能控制的自由度所产生的位移即为弹簧的变形量δx：

δx＝f_s/k_s(2)

其中k_s为弹簧的刚度，f_s为施加在弹簧上的力由传感器测量得到，由于工具仅沿着{S}坐标系的Z轴方向运动，因此坐标系{C}相对于{S}的齐次变换矩阵为：

其中L为弹簧不受力时工具末端到坐标系{S}原点的距离，因此从末端接触点到世界坐标的正运动学变换可以表示为：

其中为坐标系{S}相对于世界坐标系{W}的变换矩阵；在基于速度的控制方法中，计算目标速度的大小：