[发明专利]绳驱柔性机械臂的末端力感知方法及装置

说明书

本发明涉及一种绳驱柔性机械臂的末端力感知方法及装置。其中的方法包括建立机械臂的杆件坐标系；建立末段臂杆与中心块的动力学平衡方程与力矩平衡方程，计算初始末端作用力；建立倒数两段臂杆的动力学平衡方程与力矩平衡方程，计算此时的末端作用力；建立倒数多段臂杆的动力学平衡方程与力矩平衡方程，迭代计算末端作用力；判断前后两个计算的末端作用力误差是否低于阈值，或者下一迭代次数是否大于臂杆数，如果是，则停止迭代。其中的装置包括存储器和处理器，该处理器在执行储存在存储器的指令时实施所述方法。通过程序迭代算出机械臂受到的末端力，使绳驱柔性机械臂在末端不能安装力传感器的情况下仍然能够实现对末端力信息的准确感知。

技术领域

本发明属于机械臂技术领域，涉及一种绳驱柔性机械臂的末端力感知方法及装置。

背景技术

当前，绳驱柔性机械臂凭借更为灵活、弯曲能力更强的特性，在诸如军事侦查、管道工作、辅助医疗检查、核电设备维护等等环境中有着广阔的发展前景，但是在一些特定工作场景下，当前常用的多维力传感器、光纤布拉格光栅传感器、电磁传感器等难以安装，或是易受干扰难以工作，这极大限制了绳驱柔性机械臂在复杂环境下的感知能力与力位混合控制方面的应用。

发明内容

本发明提供一种绳驱柔性机械臂的末端力感知方法及装置，旨在至少解决现有技术中存在的技术问题之一，例如使绳驱柔性机械臂在末端不能安装力传感器的情况下仍然能够实现对末端力信息的准确感知。

本发明的技术方案为一种绳驱柔性机械臂的末端力感知方法。该方案所基于的硬件平台的机械臂包括驱动箱和串联的多段的臂杆组件，所述的机械臂的末端设置在末段臂杆组件的臂杆上，每个臂杆组件包括中心块和臂杆，每个臂杆组件中的臂杆与中心块通过轴承连接，并且每个臂杆组件中的臂杆通过各自的驱动绳索连接至所述的驱动箱，在所述的驱动箱内对驱动绳索设有拉力传感器以实时采集每根驱动绳索的拉力值。方法包括以下步骤：

A、建立机械臂的杆件坐标系，通过拉力传感器采集每根驱动绳索的拉力值以计算绳索张力施加给臂杆的相对于其连接的中心块的坐标系的绳索力的力矩，

B、基于末段的臂杆与中心块的动力学平衡方程与力矩平衡方程，计算初始末端作用力F_ex1；

C、基于倒数两段臂杆的动力学平衡方程与力矩平衡方程，计算倒数两段臂杆所关联的末端作用力F_ex2；

D、以迭代的方式，基于倒数n段臂杆的动力学平衡方程与力矩平衡方程，计算倒数n段臂杆所关联的末端作用力F_exn，其中n＞2；

E、如果前后两次计算的末端作用力的误差低于阈值或者下一个迭代数大于臂杆组件的段数，则停止迭代并输出当前计算的末端作用力作为末端感知力，否则返回步骤C。

进一步，所述步骤A包括：根据绳驱柔性机械臂的运动学模型，利用DH参数实时建立绳驱柔性机械臂的杆件坐标系，计算所述绳驱柔性机械臂在运动过程中各个臂杆组件中的运动臂杆与中心块相对于自身固连坐标系的角速度、角加速度以及惯性张量阵；

建立绳索通过臂杆组件中一个绳孔后的相邻两段的张力关系方程：

T₂＝μ(θ_c,sgn(v_c))T₁+F_v(θ_c)v_c

其中，T₁是过绳孔前的绳索张力，T₂是过绳孔后的绳索张力，v_c是过绳孔时绳索的速度，θ_c是绳索过绳孔时相邻两段的夹角，μ和F_v分别为库伦摩擦系数与粘滞摩擦系数；

根据驱动绳索通过臂杆组件中的绳孔的张力关系，采集驱动箱内每根驱动绳索的实际拉力值，以计算每个臂杆受到的绳索张力。