一种线驱动连续体机械臂末端位置误差补偿方法技术

本公开揭示了一种线驱动连续体机械臂末端位置误差补偿方法，包括：选取连续体机械臂的第一关节弯曲角β1和第二关节弯曲角β2；根据β1和β2计算连续体机械臂中各驱动线缆的长度l

【技术实现步骤摘要】
一种线驱动连续体机械臂末端位置误差补偿方法


[0001]本公开属于机器人
，具体涉及一种线驱动连续体机械臂末端位置误差补偿方法。

技术介绍

[0002]连续体机械臂由于其独特的柔顺性，能够柔顺地改变自身的形状以适应受限、非结构化空间，在医学、工程领域引起了广泛关注。然而，由于其自身的柔顺变形难以精确地通过理论模型来进行评估，导致连续体机械臂的运动精度较低。然而在享受其柔顺性带来的优越性能的同时，也对其自身精确的运动建模提出了挑战。
[0003]不同于传统刚性连杆机器人可以直接基于D
‑
H方法进行运动建模，连续体机械臂由于自身的柔顺性，没有明确的转动关节，因此其运动建模通常基于一些假设，广泛使用的如分段恒定曲率假设等。然而，基于分段恒定曲率假设的运动学建模常常忽略了其力学特性，如重力、摩擦等，往往导致建模精度较低，难以精准地评估连续体机械臂的实际位置与姿态。虽然一些考虑力学因素的动静态运动学模型或静力学、动力学模型能够在一定程度上提升运动建模的精确程度，但是，这些方法复杂的迭代过程与繁重的计算量为连续体机械臂的实时反馈补偿带来了巨大的挑战。事实上，不论多么精确的运动模型，依旧存在一些由于传动、关节柔性等因素引起的误差。

技术实现思路

[0004]针对现有技术中的不足，本公开的目的在于提供一种线驱动连续体机械臂末端位置误差补偿方法，该方法通过视觉反馈方法补偿连续体机械臂的运动误差，通过自适应的视觉检测方法重构连续体机械臂的臂型，并通过运动学迭代修正方法不断补偿末端位置误差，以此循环，直至达到误差范围内。
[0005]为实现上述目的，本公开提供以下技术方案：
[0006]一种线驱动连续体机械臂末端位置误差补偿方法，包括如下步骤：
[0007]S100：选取连续体机械臂的第一关节弯曲角β1和第二关节弯曲角β2；
[0008]S200：根据β1和β2计算连续体机械臂中各驱动线缆的长度l
i
；
[0009]S300：获取所述连续体机械臂的实际末端位置；
[0010]S400：计算连续体机械臂的实际末端位置和理论末端位置的误差；
[0011]S500：判断所述误差是否在可接受范围内，若在可接受范围内，无需进行误差补偿；否则，进入步骤S600；
[0012]S600：判断所述误差的偏差方向，根据偏差方向选择不同的修正方式对偏差进行修正，以获得修正后的第一关节弯曲角β
′1和第二关节弯曲角β
′2；
[0013]S700：根据修正后的关节弯曲角计算连续体机械臂中各驱动线缆的长度l
y
；
[0014]S800：将各驱动线缆的长度l
y
与步骤S200中各驱动线缆的长度l
i
作差，获得各驱动线缆的长度变化量，若长度变化量在可接受范围内，补偿结束，否则返回步骤S100重新选取
理论关节弯曲角。
[0015]优选的，步骤S200中，所述各驱动线缆的长度l
i
通过下式计算：
[0016][0017]其中，l1表示线缆1的长度变化量，l2表示线缆2的长度变化量，l3表示线缆3的长度变化量，l4表示线缆4的长度变化量，l0表示柔性杆的长度，r示线缆孔所在分度圆的半径，δ1表示线缆孔与圆环坐标系的夹角。
[0018]优选的，步骤S600中，所述修正方式包括修正方式一、修正方式二、修正方式三和修正方式四；
[0019]其中，
[0020]修正方式一表示为：
[0021]β
′1＝β1+Δβ，β
′2＝β2+Δβ
[0022]修正方式二表示为：
[0023]β
′1＝β1+Δβ，β
′2＝β2‑
Δβ
[0024]修正方式三表示为：
[0025]β
′1＝β1‑
Δβ，β
′2＝β2+Δβ
[0026]修正方式四表示为：
[0027]β
′1＝β1‑
Δβ，β
′2＝β2‑
Δβ
[0028]其中，β1表示第一理论关节弯曲角，和β2表示第二理论关节弯曲角，Δβ表示修正值，用于调整β1和β2，β
′1表示修正后的第一理论关节弯曲角，β
′2表示修正后的第二理论关节弯曲角。
[0029]优选的，所述连续体机械臂包括机械臂本体。
[0030]优选的，所述机械臂本体包括金属环构件和柔性杆。
[0031]优选的，步骤S300中，通过视觉检测系统获取所述连续体机械臂的实际末端位置。
[0032]与现有技术相比，本公开带来的有益效果为：
[0033]本公开所述方法能够有效地提高连续体机器人的运动精度。此外，本公开提出的线驱动连续体机器人的视觉检测的末端位置误差补偿方法及其系统能够实时地修正线驱动连续体机器人的末端位置误差，不需要建立复杂的动静态运动学模型，也不需要进行复杂的迭代过程，并对连续体机器人的末端位置误差修正具有普适性。
附图说明
[0034]图1是本公开一个实施例提供的一种线驱动连续体机械臂末端位置误差补偿方法
的流程图；
[0035]图2是本公开另一个实施例提供的连续体机械臂的结构示意图；
[0036]图3是本公开另一个实施例提供的视觉检测系统的结构示意图；
[0037]图4是本公开另一个实施例提供的线缆长度求解示意图；
[0038]图5是本公开另一个实施例提供的本方法的验证结果曲线示意图；
[0039]图6是本公开另一个实施例提供的补偿方向示意图。
具体实施方式
[0040]下面将参照附图1至图6详细地描述本公开的具体实施例。虽然附图中显示了本公开的具体实施例，然而应当理解，可以以各种形式实现本公开而不应被这里阐述的实施例所限制。相反，提供这些实施例是为了能够更透彻地理解本公开，并且能够将本公开的范围完整的传达给本领域的技术人员。
[0041]需要说明的是，在说明书及权利要求当中使用了某些词汇来指称特定组件。本领域技术人员应可以理解，技术人员可能会用不同名词来称呼同一个组件。本说明书及权利要求并不以名词的差异作为区分组件的方式，而是以组件在功能上的差异作为区分的准则。如在通篇说明书及权利要求当中所提及的“包含”或“包括”为一开放式用语，故应解释成“包含但不限定于”。说明书后续描述为实施本公开的较佳实施方式，然所述描述乃以说明书的一般原则为目的，并非用以限定本公开的范围。本公开的保护范围当视所附权利要求所界定者为准。
[0042]为便于对本公开实施例的理解，下面将结合附图以具体实施例为例做进一步的解释说明，且各个附图并不构成对本公开实施例的限定。
[0043]一个实施例中，如图1所示，本公开提供一种线驱动连续体机械臂末端位置误差补偿方法，包括如下步骤：
[0044]S100：选取连续体机械臂本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种线驱动连续体机械臂末端位置误差补偿方法，包括如下步骤：S100：选取连续体机械臂的第一关节弯曲角β1和第二关节弯曲角β2；S200：根据β1和β2计算连续体机械臂中各驱动线缆的长度l
i
；S300：获取所述连续体机械臂的实际末端位置；S400：计算连续体机械臂的实际末端位置和理论末端位置的误差；S500：判断所述误差是否在可接受范围内，若在可接受范围内，无需进行误差补偿；否则，进入步骤S600；S600：判断所述误差的偏差方向，根据偏差方向选择不同的修正方式对偏差进行修正，以获得修正后的第一关节弯曲角β
′1和第二关节弯曲角β
′2；S700：根据修正后的关节弯曲角计算连续体机械臂中各驱动线缆的长度l
y
；S800：将各驱动线缆的长度l
y
与步骤S200中各驱动线缆的长度l
i
作差，获得各驱动线缆的长度变化量，若长度变化量在可接受范围内，补偿结束，否则返回步骤S100重新选取理论关节弯曲角。2.根据权利要求1所述的方法，其中，优选的，步骤S200中，所述各驱动线缆的长度l
i
通过下式计算：其中，l1表示线缆1的长度变化量，l2表示线缆2的长度变化量，l...

【专利技术属性】
技术研发人员：杨来浩，杨浙帅，孙瑜，杨冬，兰雨，刘乙雪，郑毅，陈雪峰，
申请(专利权)人：西安交通大学，
类型：发明
国别省市：