一种多段连续体机械臂形态预测方法技术

本发明专利技术提出了一种多段连续体机械臂形态预测方法，首先基于Cosserat杆理论，建立单段连续体机械臂的几何描述及静力学模型，通过组合单段连续体机械臂，建立多段连续体机械臂的几何描述和静力学模型，建立每段机械臂的驱动丝有效位移量的概念，并给出了每段机械臂的驱动丝有效位移量的求解公式，根据力的平衡方程和几何方程，给出了各段机械臂形态求解时初值条件的迭代公式，最后建立多段机械臂形态预测模型，建立驱动线位移量与形态映射关系。本发明专利技术仅通过多段机械臂的驱动器输入量即可求解多段机械臂形态，通过引入Cosserat杆理论突破了常曲率假设的限制，实现了准确且高效的形态预测。预测。预测。

【技术实现步骤摘要】
一种多段连续体机械臂形态预测方法


[0001]本专利技术属于机械臂形态预测领域，具体涉及一种多段连续体机械臂形态预测方法。

技术介绍

[0002]连续体机械臂是一类由弹性材料构成的可实现连续变形的机械臂，其理论上具有无限自由度。相比于刚性机械臂，连续体机械臂具有更强的灵活性以及人机交互安全性，且在空间航天器、微创手术和救援维修等领域都得到了应用。
[0003]连续体机械臂的自由度和驱动数目较多，如何对其形态进行精确控制是连续体机械臂实际应用中不可避免的问题，而形态预测更是最为关键的一步。目前在形态检测领域大都使用外部传感器对机械臂形态直接重构，一些学者将基于分段常曲率假设的模型引入用以得到更加精确的结果，但大部分研究对象都是单段连续体机械臂，而在连续体机械臂的实际应用中，往往采用多段串联的方式用以实现复杂的形态。
[0004]为了达到预期的控制精度，需要辅以精确的模型描述，分段常曲率虽然使用较为广泛，如公布号为CN112828893A和CN114012728A的专利技术专利便采用了分段常曲率假设对多段机械臂进行了静力学和运动学分析，但其局限在于一旦机械臂有外部载荷的参与，这一假设便不再成立。力学中常用的有限元方法虽然可以对任意载荷下的机械臂变形进行求解，但计算复杂，且机械臂几何结构的任一微小改动都需要重新划分网格，时间成本过高。Cosserat杆模型可以精确描述连续体的拉压、剪切、扭转和弯曲变形，能够弥补常曲率假设的不足，对多段连续体机械臂精确描述来说是较为理想的选择。
[0005]结合上述情况，对于多段连续体机械臂，需要一种结合Cosserat杆模型的高精度形态预测方法，兼顾计算效率和精度，能够根据驱动丝位移输入直接求解机械臂形态。

技术实现思路

[0006]本专利技术目的在于提供一种多段连续体机械臂形态预测方法。
[0007]实现上述目的的技术解决方案为：
[0008]一种多段连续体机械臂形态预测方法，包括以下步骤：
[0009]步骤1、基于Cosserat杆理论，建立单段连续体机械臂的几何描述及静力学模型；
[0010]步骤2、通过组合单段连续体机械臂，建立多段连续体机械臂的几何描述和静力学模型；
[0011]步骤3、考虑多段连续体机械臂中前一段机械臂形态变化对后一段机械臂所属驱动丝的位移量的影响，建立每段机械臂的驱动丝有效位移量的概念，并给出每段机械臂的驱动丝有效位移量的求解公式；
[0012]步骤4、根据力的平衡方程和几何方程，给出各段机械臂形态求解时初值条件的迭代公式；
[0013]步骤5、基于多段连续体机械臂的静力学模型，结合步骤4的初值条件迭代公式和
驱动丝有效位移量的求解公式，依次求解各段机械臂形态，建立驱动器输入量与形态映射关系。
[0014]本专利技术与现有技术相比，其显著优点为：
[0015](1)能够直接通过驱动器输入量预测多段机械臂形态，无需其它传感器辅助；
[0016](2)使用了Cosserat杆模型进行静力学建模，相比于常曲率假设精度更高并且可考虑外部载荷对机械臂的影响，方法适用于任意段数和驱动丝数的机械臂；
[0017](3)同有限元法相比，本专利技术的计算速度更快，且与有限元法的误差仅为机械臂长度的3.05％。
[0018]下面结合附图和具体实施方式对本专利技术作进一步的详细描述。
附图说明
[0019]图1为本专利技术多段连续体机械臂形态预测方法的几何描述图；
[0020]图2为本专利技术的实施实例的两段式连续体机械臂的结构组成图；
[0021]图3是本专利技术的实施实例的驱动器输入量示意图；
[0022]图4是本专利技术的实施实例的驱动丝沿机械臂截面分布图；
[0023]图5是本专利技术的实施实例结果与有限元方法的对比图。图6为本专利技术预测的两段机械臂形态与有限元法求解结果的对比图。
具体实施方式
[0024]现针对两段式连续体机械臂的实施实例，对本专利技术作进一步描述。
[0025]步骤1、基于Cosserat杆理论，建立单段连续体机械臂的几何描述及静力学模型：
[0026]步骤1
‑
1：如图1所示，定义P(s)为随机械臂中心杆弧长s变化的三维笛卡尔曲线,R(s)为随机械臂中心杆弧长s变化的三维旋转矩阵。图2所示为驱动丝在中心杆截面出局部坐标系下的位置，据此定义第i根驱动丝的空间位置为
[0027]p
i
(s)＝R(s)r
i
(s)+P(s)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)
[0028]其中r
i
(s)为驱动丝在中心杆截面上的分布。
[0029]步骤1
‑
2：根据图3的力和力矩平衡关系，得到力平衡方程，可求得
[0030][0031]其中符号表示对s的一阶导数；符号
*
代表各项变量的初始值；为u的反对称矩阵；v(s)和u(s)为线性应变和角性应变；l(s)和f(s)为分布力矩和分布力；K
SE
和K
BT
为相应刚度矩阵；
[0032]步骤1
‑
3：结合步骤1
‑
2中公式(1)和(2)，引入驱动丝与中心杆之间的耦合关系，得到驱动丝对中心杆的力和力矩为
[0033][0034]其中τ
i
为第i根驱动丝的拉力。
[0035]同时定义中间变量如下：
[0036][0037][0038][0039][0040][0041]其中符号(
·
)
b
表示该变量在局部坐标系下的表达形式，n为驱动丝数量。
[0042]步骤1
‑
4：结合以上步骤及其中公式，建立单段连续体机械臂静力学模型为：
[0043][0044]其中
[0045][0046][0047]步骤2、通过组合单段连续体机械臂，建立如图2所示的多段连续体机械臂的几何描述和静力学模型：
[0048]多段连续体机械臂中心杆的空间位置和对应旋转矩阵可写为
[0049][0050]其中，代表第k段机械臂的空间位置分布，代表第k段机械臂的旋转矩阵分布，s的取值范围为[∫L
k
,∫L
k+1
]，L
k
为第k段机械臂的长度，∫L
k
为前k段机械臂的长度之和；为前k段机械臂的空间分布；为前k段机械臂的姿态矩阵分布；
[0051]为了便于每一段的姿态计算，额外定义
[0052][0053]此时δ的取值范围为[0,L
k
]。
[0054]定义驱动丝的空间位置
[0055][0056]p
k,i
(s)为第k段的第i根驱动丝的空间分布；代表第k段的空间位置分布；r
k,i
(s)为本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种多段连续体机械臂形态预测方法，其特征在于，包括以下步骤：步骤1、基于Cosserat杆理论，建立单段连续体机械臂的几何描述及静力学模型；步骤2、通过组合单段连续体机械臂，建立多段连续体机械臂的几何描述和静力学模型；步骤3、考虑多段连续体机械臂中前一段机械臂形态变化对后一段机械臂所属驱动丝的位移量的影响，建立每段机械臂的驱动丝有效位移量的概念，并给出每段机械臂的驱动丝有效位移量的求解公式；步骤4、根据力的平衡方程和几何方程，给出各段机械臂形态求解时初值条件的迭代公式；步骤5、基于多段连续体机械臂的静力学模型，结合步骤4的初值条件迭代公式和驱动丝有效位移量的求解公式，依次求解各段机械臂形态，建立驱动器输入量与形态映射关系。2.根据权利要求1所述的多段连续体机械臂形态预测方法，其特征在于，所述步骤1包括以下步骤：步骤1
‑
1：定义P(s)为随机械臂中心杆弧长s变化的三维笛卡尔曲线,R(s)为随机械臂中心杆弧长s变化的三维旋转矩阵，定义第i根驱动丝的空间位置为p
i
(s)＝R(s)r
i
(s)+P(s)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)其中r
i
(s)为驱动丝在中心杆截面上的分布，步骤1
‑
2：根据力平衡方程，求得其中符号表示对s的一阶导数；符号
*
代表各项变量的初始值；为u的反对称矩阵；v(s)和u(s)为线性应变和角性应变；l(s)和f(s)为分布力矩和分布力；K
SE
和K
BT
为相应刚度矩阵；步骤1
‑
3：结合公式(1)和(2)，引入驱动丝与中心杆之间的耦合关系，得到驱动丝对中心杆的力和力矩为：其中τ
i
为第i根驱动丝的拉力；同时定义中间变量如下：
其中符号(
·
)
b
表示该变量在局部坐标系下的表达形式，n为驱动丝数量；步骤1
‑
4：结合以上步骤，建立单段连续体机械臂静力学模型为：其中3.根据权利要求2所述的多段连续体机械臂形态预测方法，其特征在于，步骤2具体包括：将单段连续体机械臂组合为多段，则多段连续体...

【专利技术属性】
技术研发人员：郭健，许立松，马国梁，徐胜元，苗力，王天野，李志广，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：