一种柔性机械臂振动抑制方法

本发明涉及柔性机械臂控制领域，具体的说，涉及了一种柔性机械臂振动抑制方法。

背景技术：

1、传统制造业的机械臂手臂一般为刚性材料，由于刚性材料不会发生弹性变形，可以避免运动期间因机械变形导致的控制不精确问题，但是刚性机械臂的质量很高，不适合直接驱动，由于其具备比较大的惯性，不适合高速移动，无法满足某些需要精细操作领域中的机械臂控制要求。

2、柔性机械臂与刚性机械臂相比，具有质量轻巧、活动灵活、能耗较少以及高精度运行等优点，但其由诸多柔性元件构成(包括柔性关节、柔性臂杆)，柔性元件的柔韧性可在机械臂发生碰撞时起到缓冲和保护作用，但关节的柔性会造成在运动停止后，臂杆仍然在不断振动，加上臂杆本身的柔性，这会严重影响末端执行机构的位置精度，故在实际应用中必须对其进行振动抑制。

3、专利202010753420.2公开了一种柔性机械臂的组合滑模运动控制方法，其将柔性机械臂建模为带有奇异摄动参数的奇异摄动系统，并分解为描述刚体运动和柔性振动的快、慢子系统；慢时间尺度下，考虑外界扰动及参数不确定性对系统的影响，设计带有扰动观测器的自适应滑模控制器，实现对柔性机械臂的轨迹跟踪；快时间尺度下，为消除未建模动态及慢时间尺度下振动状态对控制器设计的影响，设计鲁棒滑模控制器实现对柔性振动的抑制；最后利用奇异摄动理论将慢控制器与快控制器结合。缺点：采用奇异摄动理论的闭环反馈控制方法在面对高阶模态时容易产生谐振，需要对关节的柔性做低柔性假设，与实际情况存在一定差距。

4、专利201811252001.x公开了一种柔性空间机械臂振动控制方法及系统，其是由关节力矩计算得到返回波，返回波中包含系统振动信息，叠加在输入中，对输入进行实时整形，整形后的输入经过关节pd控制机械臂的运动，对返回波进行吸收，达到振动抑制的目的。缺点：上述两种控制方法在进行振动抑制算法时主要控制驱动电机的作动力，需要在电流环路进行控制，对控制系统要求很高，对原系统的改动成本比较大。

5、专利202210592114.4公开了一种用于关节机器人振动抑制的输入整形的方法，其在算法中引入负脉冲，与只有正脉冲的算法相比，显著提升了系统的响应速度，不需要求出脉冲序列参数的解析解，用计算机即可快速获得数值最优解。该方法在进行振动抑制时仅能够减小由输入作动器本身所导致的振动，无法处理柔性臂杆本身已有的、残余的振动。

技术实现思路

1、本发明的目的是针对现有技术的不足，从而提供一种面对多自由度、多模态的柔性机械臂时不易引起高频振荡，无需对关节的柔性做低柔性假设；在电流环路的外层，即位置环路与速度环路进行控制，对控制系统要求低，对系统改动小、改进成本低；可以使作动器对柔性关节产生的振动与柔性臂杆产生的振动相抵消，对已有振动进行实时消除，应用更加全面；的柔性机械臂振动抑制方法。

2、为了实现上述目的，本发明所采用的技术方案是：一种柔性机械臂振动抑制方法，所述柔性机械臂包括多根臂杆和连接在臂杆之间的关节，每个关节均由一电机驱动，包括以下步骤：

3、s1、动力学建模：

4、采集每个关节电机的转角θ1，2,..,n、角速度角加速度其中下标n代表第n个关节；

5、利用集中质量法，将每根所述臂杆离散为m个由弹簧阻尼相连接的刚性臂，通过弹簧阻尼等效关节柔性和臂杆柔性，测出各个测量点的角速度并利用积分获得角位移q11,...,nm，利用微分获得角加速度其中下标nm代表第n节臂杆上的第m个陀螺仪；

6、利用拉格朗日法获取离散后的刚性臂的惯性矩阵m，获得离散为多节刚性臂的柔性机械臂系统模型如下：

7、

8、式中，m(q,θ)为n×m行n×m列的对称正定矩阵；向量q为n×m行的列向量，元素分别为[q11,q12,...,q1m,q21,...,qnm]t，表示各等效刚性臂的转动角度；向量θ为n×m行的列向量，元素为[θ1,0,...,0,θ2,...,0,θn,...,0]，其中第k×m+1个元素为θk+1，k为整数，0＜＝k＜＝n-1，其它元素均为0，用来表示各个关节电机的输入角度；c表示等效离散模型的阻尼矩阵，为n×m行n×m列对角正定矩阵，元素分别为各等效关节的阻尼(c11,c12,...,cnm)，下标nm则表示第n节臂杆上的第m个等效刚性臂对应的柔性关节阻尼；k为n×m行n×m列对角正定矩阵，表示等效离散模型的刚度矩阵，元素分别为各等效关节的刚度(k11,k12,...,knm)，下标nm则表示第n节臂杆上的第m个等效刚性臂对应的柔性关节刚度；

9、s2、计算模态及主坐标转换：

10、忽略柔性机械臂系统模型中的阻尼矩阵，将式(1)改写为：

11、

12、对式(2)的左侧进行求解，求出柔性机械臂系统的振动模态：

13、(k-ω2m(q,θ))a＝0   (3)

14、求出系统的固有频率ω(1,...,n×m)以及对应的振动模态φ(1,...,n×m)，进而在主坐标模式下的振动方程表示如下：

15、

16、式(4)中，主惯量mp＝φtm(q,θ)φ，主刚度kp＝φtkφ，φ＝[φ(1),...,φ(n×m)]，主坐标下的模态位移xp＝φ-1x，向量x为q；

17、通过以上步骤，实现各阶模态的解耦与坐标转换；

18、s3、计算振动模态的振动相位:

19、根据xp＝φ-1x，可求出主坐标振动速度为故可计算出在输入下的各阶模态的振动相位：

20、

21、式中，上标(i)表示第i阶模态，表示第i阶模态的振动相位，aphase(i)为第i阶模态的振幅，ω(i)表示第i阶模态的固有频率；

22、s4、计算减振加速度：

23、对式(4)求解零输入下系统的振动能量，有

24、

25、式中aphase为n×m行的列向量，其各元素即为各阶模态的振幅；

26、结合式(4)与(5)，即可获得弹性系统振动能量与输入之间的关系，令可得下式：

27、

28、式中，γ＝k112+...+knm2＞0，∏可表示为相位与刚度的函数由此式即可得各输入端的位移加速度的变化量

29、考虑采用该难以使加速度值最终收敛到0，故采取实际的加速度如下：

30、

31、式中，tk为第k次控制周期的值，ka为选取的较小正值，用于保证最终收敛到0，kv则是保证收敛到0；

32、s5、计算定位速度：

33、令减振部分速度如下式：

34、

35、类似的，令最终的目标速度计算如下，即可令θ对期望角度θdesire进行跟踪与定位，从而实现令最终的位置误差收敛到0：

36、

37、s6、位置控制输出：

38、最终用下式表示对位置控制器的实际输出：

39、

40、式中，θoutput输出即为对位置控制器的实际输出。

41、基于上述，对惯性矩阵m而言，其受小角度变化时的影响小，当变形量q较小时，可认为其仅受关节转角θ影响；当系统在某一位置进行自由振动时，可令θ为零，即可表示其振动状态；通过式(1)进行辨识获取等效的阻尼矩阵c、刚度矩阵k。

42、基于上述，步骤s1中通过编码器采集每个关节电机的转角θ、角速度角加速度

43、基于上述，步骤s1中，根据臂杆柔性程度，在每根臂杆上间隔设置有m个测量点，测量点的个数可根据臂架软硬程度分别进行改变，每个测量点上安装陀螺仪测量角速度。

44、本发明相对现有技术具有突出的实质性特点和显著的进步，具体的说，本发明具有以下优点：

45、(1)方法最终的实际输出对象为位置控制器θoutput，减振原理是针对振动模态进行位移补偿，不会引起更高阶模态的振动位移。

46、(2)本方法在电流环路的外层，即位置环路与速度环路进行控制，相比于采用力控的控制方法，本方法对原有系统更改更少，要求更低，适用于包括电机驱动、液压驱动在内的多种驱动方式。

47、(3)本方法的振动抑制本质上是反馈控制的一种，可以使作动器对柔性关节产生的振动与柔性臂杆产生的振动相抵消，对已有振动进行实时消除，适用于有外力下的强迫振动、系统本身的残余振动等不同类型振动的抑制，应用更加全面。

48、(4)采用的传感器除电机(或其他作动器)自带的编码器外，仅需额外添加陀螺仪，成本低。