CN115383793A - 一种多段连续体机械臂形态预测方法 - Google Patents

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

Info

Publication number
CN115383793A
CN115383793A CN202211099656.4A CN202211099656A CN115383793A CN 115383793 A CN115383793 A CN 115383793A CN 202211099656 A CN202211099656 A CN 202211099656A CN 115383793 A CN115383793 A CN 115383793A
Authority
CN
China
Prior art keywords
mechanical arm
section
segment
driving wire
formula
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202211099656.4A
Other languages
English (en)
Inventor
郭健
许立松
马国梁
徐胜元
苗力
王天野
李志广
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Science and Technology
Original Assignee
Nanjing University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing University of Science and Technology filed Critical Nanjing University of Science and Technology
Priority to CN202211099656.4A priority Critical patent/CN115383793A/zh
Publication of CN115383793A publication Critical patent/CN115383793A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0095Means or methods for testing manipulators

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

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

Description

一种多段连续体机械臂形态预测方法
技术领域
本发明属于机械臂形态预测领域,具体涉及一种多段连续体机械臂形态预测方法。
背景技术
连续体机械臂是一类由弹性材料构成的可实现连续变形的机械臂,其理论上具有无限自由度。相比于刚性机械臂,连续体机械臂具有更强的灵活性以及人机交互安全性,且在空间航天器、微创手术和救援维修等领域都得到了应用。
连续体机械臂的自由度和驱动数目较多,如何对其形态进行精确控制是连续体机械臂实际应用中不可避免的问题,而形态预测更是最为关键的一步。目前在形态检测领域大都使用外部传感器对机械臂形态直接重构,一些学者将基于分段常曲率假设的模型引入用以得到更加精确的结果,但大部分研究对象都是单段连续体机械臂,而在连续体机械臂的实际应用中,往往采用多段串联的方式用以实现复杂的形态。
为了达到预期的控制精度,需要辅以精确的模型描述,分段常曲率虽然使用较为广泛,如公布号为CN112828893A和CN114012728A的发明专利便采用了分段常曲率假设对多段机械臂进行了静力学和运动学分析,但其局限在于一旦机械臂有外部载荷的参与,这一假设便不再成立。力学中常用的有限元方法虽然可以对任意载荷下的机械臂变形进行求解,但计算复杂,且机械臂几何结构的任一微小改动都需要重新划分网格,时间成本过高。Cosserat杆模型可以精确描述连续体的拉压、剪切、扭转和弯曲变形,能够弥补常曲率假设的不足,对多段连续体机械臂精确描述来说是较为理想的选择。
结合上述情况,对于多段连续体机械臂,需要一种结合Cosserat杆模型的高精度形态预测方法,兼顾计算效率和精度,能够根据驱动丝位移输入直接求解机械臂形态。
发明内容
本发明目的在于提供一种多段连续体机械臂形态预测方法。
实现上述目的的技术解决方案为:
一种多段连续体机械臂形态预测方法,包括以下步骤:
步骤1、基于Cosserat杆理论,建立单段连续体机械臂的几何描述及静力学模型;
步骤2、通过组合单段连续体机械臂,建立多段连续体机械臂的几何描述和静力学模型;
步骤3、考虑多段连续体机械臂中前一段机械臂形态变化对后一段机械臂所属驱动丝的位移量的影响,建立每段机械臂的驱动丝有效位移量的概念,并给出每段机械臂的驱动丝有效位移量的求解公式;
步骤4、根据力的平衡方程和几何方程,给出各段机械臂形态求解时初值条件的迭代公式;
步骤5、基于多段连续体机械臂的静力学模型,结合步骤4的初值条件迭代公式和驱动丝有效位移量的求解公式,依次求解各段机械臂形态,建立驱动器输入量与形态映射关系。
本发明与现有技术相比,其显著优点为:
(1)能够直接通过驱动器输入量预测多段机械臂形态,无需其它传感器辅助;
(2)使用了Cosserat杆模型进行静力学建模,相比于常曲率假设精度更高并且可考虑外部载荷对机械臂的影响,方法适用于任意段数和驱动丝数的机械臂;
(3)同有限元法相比,本发明的计算速度更快,且与有限元法的误差仅为机械臂长度的3.05%。
下面结合附图和具体实施方式对本发明作进一步的详细描述。
附图说明
图1为本发明多段连续体机械臂形态预测方法的几何描述图;
图2为本发明的实施实例的两段式连续体机械臂的结构组成图;
图3是本发明的实施实例的驱动器输入量示意图;
图4是本发明的实施实例的驱动丝沿机械臂截面分布图;
图5是本发明的实施实例结果与有限元方法的对比图。
图6为本发明预测的两段机械臂形态与有限元法求解结果的对比图。
具体实施方式
现针对两段式连续体机械臂的实施实例,对本发明作进一步描述。
步骤1、基于Cosserat杆理论,建立单段连续体机械臂的几何描述及静力学模型:
步骤1-1:如图1所示,定义P(s)为随机械臂中心杆弧长s变化的三维笛卡尔曲线,R(s)为随机械臂中心杆弧长s变化的三维旋转矩阵。图2所示为驱动丝在中心杆截面出局部坐标系下的位置,据此定义第i根驱动丝的空间位置为
pi(s)=R(s)ri(s)+P(s) (1)
其中ri(s)为驱动丝在中心杆截面上的分布。
步骤1-2:根据图3的力和力矩平衡关系,得到力平衡方程,可求得
Figure BDA0003839735690000031
其中
Figure BDA0003839735690000032
符号表示对s的一阶导数;符号*代表各项变量的初始值;
Figure BDA0003839735690000033
为u的反对称矩阵;v(s)和u(s)为线性应变和角性应变;l(s)和f(s)为分布力矩和分布力;KSE和KBT为相应刚度矩阵;
步骤1-3:结合步骤1-2中公式(1)和(2),引入驱动丝与中心杆之间的耦合关系,得到驱动丝对中心杆的力和力矩为
Figure BDA0003839735690000034
其中τi为第i根驱动丝的拉力。
同时定义中间变量如下:
Figure BDA0003839735690000035
Figure BDA0003839735690000041
Figure BDA0003839735690000042
Figure BDA0003839735690000043
Figure BDA0003839735690000044
其中符号(·)b表示该变量在局部坐标系下的表达形式,n为驱动丝数量。
步骤1-4:结合以上步骤及其中公式,建立单段连续体机械臂静力学模型为:
Figure BDA0003839735690000045
其中
Figure BDA0003839735690000046
Figure BDA0003839735690000047
步骤2、通过组合单段连续体机械臂,建立如图2所示的多段连续体机械臂的几何描述和静力学模型:
多段连续体机械臂中心杆的空间位置和对应旋转矩阵可写为
Figure BDA0003839735690000048
其中,
Figure BDA0003839735690000049
代表第k段机械臂的空间位置分布,
Figure BDA00038397356900000410
代表第k段机械臂的旋转矩阵分布,s的取值范围为[∫Lk,∫Lk+1],Lk为第k段机械臂的长度,∫Lk为前k段机械臂的长度之和;
Figure BDA00038397356900000411
为前k段机械臂的空间分布;
Figure BDA00038397356900000412
为前k段机械臂的姿态矩阵分布;
为了便于每一段的姿态计算,额外定义
Figure BDA00038397356900000413
此时δ的取值范围为[0,Lk]。
定义驱动丝的空间位置
Figure BDA0003839735690000051
pk,i(s)为第k段的第i根驱动丝的空间分布;
Figure BDA0003839735690000052
代表第k段的空间位置分布;rk,i(s)为控制第k段的第i根驱动丝在中心杆截面局部坐标下的位置;
定义
Figure BDA0003839735690000053
为第k段的所有驱动丝的驱动器输入量,
Figure BDA0003839735690000054
是第k段的第i根驱动丝的驱动器输入量;
Figure BDA0003839735690000055
步骤3、考虑多段连续体机械臂中前一段机械臂形态变化对后一段机械臂所属驱动丝的位移量的影响,建立每段机械臂的驱动丝有效位移量的概念,并给出每段机械臂的驱动丝有效位移量的求解公式:
结合公式(7),对于第k段机械臂的第i根驱动丝,其有效位移量的计算公式如下:
Figure BDA0003839735690000056
其中qk,i为是第k段的第i根驱动丝的有效位移量,类比公式(8),可以得到qk为第k段的所有驱动丝的有效位移量。
步骤4、根据力的平衡方程和几何方程,结合公式(6)的定义,给出各段机械臂形态求解时初值条件的迭代公式:
Figure BDA0003839735690000057
其中0k+1为第k+1段机械臂起始位置。
步骤5、基于多段连续体机械臂的静力学模型,结合上述步骤的静力学模型和形态求解的迭代公式,依次求解各段机械臂形态,建立驱动器输入量与形态映射关系,其求解过程如下:
1)对于k段连续体机械臂,根据公式(8)的定义,给定期望的驱动器输入量
Figure BDA0003839735690000058
给定各段的空间位置初值
Figure BDA0003839735690000059
旋转矩阵
Figure BDA00038397356900000510
2)对于第1段机械臂,结合公式(7)、(8)、(9),其驱动丝有效位移量
Figure BDA0003839735690000061
根据公式(10)可得其初值条件为
Figure BDA0003839735690000062
将二者代入式(4),即可得到第1段形态
Figure BDA0003839735690000063
Figure BDA0003839735690000064
3)对于第2段机械臂,结合公式(7)、(8)、(9)计算第2段的驱动丝有效位移量q2,再根据式(10)计算第2段机械臂的初值条件,将二者代入式 (4),计算即可得到第2段形态
Figure BDA0003839735690000065
Figure BDA0003839735690000066
4)以此类推,直至求得全部k段机械臂的形态,根据公式(5)将其组合,最终得到多段连续体机械臂的形态
Figure BDA0003839735690000067
Figure BDA0003839735690000068
如图4所示,计算实例的机械臂本体共有k=2段,由中心杆、间隔盘和驱动丝构成,第2段的驱动丝穿过第1段。两段机械臂的长度L1=L2=l,中心杆上分布有若干间隔盘。
如图5所示,每段机械臂都有n=4根驱动丝控制,驱动丝在驱动器输入量下产生位移,驱动机械臂实现不同形态。两段的驱动丝都沿圆周均布,驱动丝到中心杆中心的偏距为loff=0.023m。
计算实例中,给定中心杆初始形态为
Figure BDA0003839735690000069
驱动器输入量为
Figure BDA00038397356900000610
两段机械臂的驱动丝在局部坐标下的分布为
Figure BDA00038397356900000611
Figure BDA00038397356900000612
按以下步骤进行形态预测:
步骤1、基于Cosserat杆理论,建立单段连续体机械臂的几何描述及静力学模型如公式(4)。
步骤2、通过组合单段连续体机械臂,建立如图2所示的两段连续体机械臂的几何描述为
Figure BDA0003839735690000071
Figure BDA0003839735690000072
Figure BDA0003839735690000073
其中,P(s)为随机械臂中心杆弧长s变化的三维笛卡尔曲线,P1 2(s)代表第 2段的空间位置分布,P0 2(s)为两段机械臂整体的空间分布;R(s)为随机械臂中心杆弧长s变化的三维旋转矩阵,上下标定义同P(s);pk,i(s)为第k段的第i根驱动丝的空间分布;rk,i(s)为控制第k段的第i根驱动丝在中心杆截面局部坐标下的位置;
Figure BDA0003839735690000074
Figure BDA0003839735690000075
为第1段和第2段的驱动丝的驱动器输入量;
步骤3、考虑多段连续体机械臂中前一段机械臂形态变化对后一段机械臂所属驱动丝的位移量的影响,建立每段机械臂的驱动丝有效位移量的概念,并给出每段机械臂的驱动丝有效位移量的求解公式:
Figure BDA0003839735690000076
其中q2,i为是第2段的第i根驱动丝的有效位移量,L1 0为前1段中心杆的长度。
步骤4、根据力的平衡方程和几何方程,给出各段机械臂形态求解时初值条件的迭代公式:
P2(02)=P1(L1) (15)
R2(02)=R1(L1)
其中,L1为第1段机械臂的长度。
步骤5、基于多段连续体机械臂的静力学模型,结合上述步骤的静力学模型和形态求解的迭代公式,依次求解各段机械臂形态,建立驱动器输入量与形态映射关系,其求解过程为:
1)给定期望的驱动器输入量为
Figure BDA0003839735690000077
给定各段的空间位置初值
Figure BDA0003839735690000078
旋转矩阵
Figure BDA0003839735690000079
2)对于第1段机械臂,根据公式(12)、(13)、(14)可计算驱动丝有效位移量
Figure BDA0003839735690000081
其初值条件为
Figure BDA0003839735690000082
将二者代入式(4),即可得到第1段形态
Figure BDA0003839735690000083
Figure BDA0003839735690000084
3)对于第2段机械臂,根据公式(12)、(13)、(14)可计算第2段的驱动丝有效位移量q2,再根据式(15)计算第2段机械臂的初值条件,将二者代入式(4),计算即可得到第2段形态P1 2和R1 2
4)根据公式(11)将其组合可得到多段连续体机械臂的形态P0 2
Figure BDA0003839735690000085
图6为上述实例所预测的两段机械臂形态与有限元法求解结果的对比图,可以看到二者差别很小,末端位置误差仅为两段机械臂长度的3.05%。
由上述实例可知,本发明的建模方法可以根据驱动器输入量准确预测多段机械臂形态;通过引入Cosserat杆模型突破了常曲率假设的限制,实现了准确且高效的形态预测。在实现了与有限元法接近的解算精度的同时,本发明的解算时间相比于有限元法也大大缩短,为多段机械臂的实时形态预测与控制提供了基础。
以上显示和描述了本发明的基本原理、主要特征及优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。

Claims (6)

1.一种多段连续体机械臂形态预测方法,其特征在于,包括以下步骤:
步骤1、基于Cosserat杆理论,建立单段连续体机械臂的几何描述及静力学模型;
步骤2、通过组合单段连续体机械臂,建立多段连续体机械臂的几何描述和静力学模型;
步骤3、考虑多段连续体机械臂中前一段机械臂形态变化对后一段机械臂所属驱动丝的位移量的影响,建立每段机械臂的驱动丝有效位移量的概念,并给出每段机械臂的驱动丝有效位移量的求解公式;
步骤4、根据力的平衡方程和几何方程,给出各段机械臂形态求解时初值条件的迭代公式;
步骤5、基于多段连续体机械臂的静力学模型,结合步骤4的初值条件迭代公式和驱动丝有效位移量的求解公式,依次求解各段机械臂形态,建立驱动器输入量与形态映射关系。
2.根据权利要求1所述的多段连续体机械臂形态预测方法,其特征在于,所述步骤1包括以下步骤:
步骤1-1:定义P(s)为随机械臂中心杆弧长s变化的三维笛卡尔曲线,R(s)为随机械臂中心杆弧长s变化的三维旋转矩阵,定义第i根驱动丝的空间位置为
pi(s)=R(s)ri(s)+P(s) (1)
其中ri(s)为驱动丝在中心杆截面上的分布,
步骤1-2:根据力平衡方程,求得
Figure FDA0003839735680000011
其中
Figure FDA0003839735680000013
符号表示对s的一阶导数;符号*代表各项变量的初始值;
Figure FDA0003839735680000012
为u的反对称矩阵;v(s)和u(s)为线性应变和角性应变;l(s)和f(s)为分布力矩和分布力;KSE和KBT为相应刚度矩阵;
步骤1-3:结合公式(1)和(2),引入驱动丝与中心杆之间的耦合关系,得到驱动丝对中心杆的力和力矩为:
Figure FDA0003839735680000021
其中τi为第i根驱动丝的拉力;
同时定义中间变量如下:
Figure FDA0003839735680000022
Figure FDA0003839735680000023
Figure FDA0003839735680000024
Figure FDA0003839735680000025
Figure FDA0003839735680000026
其中符号(·)b表示该变量在局部坐标系下的表达形式,n为驱动丝数量;
步骤1-4:结合以上步骤,建立单段连续体机械臂静力学模型为:
Figure FDA0003839735680000027
其中
Figure FDA0003839735680000028
3.根据权利要求2所述的多段连续体机械臂形态预测方法,其特征在于,步骤2具体包括:将单段连续体机械臂组合为多段,则多段连续体机械臂中心杆的空间位置和对应旋转矩阵为:
Figure FDA0003839735680000031
其中,
Figure FDA0003839735680000032
代表第k段机械臂的空间位置分布,
Figure FDA0003839735680000033
代表第k段机械臂的旋转矩阵分布,s的取值范围为[∫Lk,∫Lk+1],Lk为第k段机械臂的长度,∫Lk为前k段机械臂的长度之和;
Figure FDA0003839735680000034
为前k段机械臂的空间分布;
Figure FDA0003839735680000035
为前k段机械臂的姿态矩阵分布;
为了便于每一段机械臂的姿态计算,额外定义
Figure FDA0003839735680000036
其中δ的取值范围为[0,Lk];
定义驱动丝的空间位置:
Figure FDA0003839735680000037
pk,i(s)为第k段的第i根驱动丝的空间分布;rk,i(s)为控制第k段的第i根驱动丝在中心杆截面局部坐标下的位置;
定义
Figure FDA0003839735680000038
为第k段的所有驱动丝的驱动器输入量,
Figure FDA0003839735680000039
是第k段的第i根驱动丝的驱动器输入量如下:
Figure FDA00038397356800000310
4.根据权利要求3所述的多段连续体机械臂形态预测方法,其特征在于,提出了驱动丝有效位移量的概念,结合公式(7),对于第k段机械臂的第i根驱动丝,其有效位移量的计算公式如下:
Figure FDA00038397356800000311
其中qk,i为是第k段的第i根驱动丝的有效位移量,类比公式(8),得到qk为第k段的所有驱动丝的有效位移量。
5.根据权利要求4所述的多段连续体机械臂形态预测方法,其特征在于,结合公式(6),所述步骤4中第k段机械臂姿态计算的初值条件的迭代公式为:
Figure FDA00038397356800000312
其中,Lk为第k段机械臂的长度,0k+1为第k+1段机械臂的起始位置。
6.根据权利要求5所述的多段连续体机械臂形态预测方法,其特征在于,步骤5具体包括:
1)对于k段连续体机械臂,结合公式(8),给定每一段期望的驱动器输入量为
Figure FDA0003839735680000041
同时给定各段机械臂的空间位置初值
Figure FDA0003839735680000042
旋转矩阵
Figure FDA0003839735680000043
2)对于第1段机械臂,结合公式(7)、(8)、(9),其驱动丝有效位移量
Figure FDA0003839735680000044
根据公式(10)可得初值条件为
Figure FDA0003839735680000045
代入公式(4),即得到第1段形态
Figure FDA0003839735680000046
Figure FDA0003839735680000047
3)对于第2段机械臂,根据公式(7)、(8)、(9)计算第2段的驱动丝有效位移量q2,再根据公式(10)计算第2段机械臂的初值条件,代入式(4),计算得到第2段形态P1 2
Figure FDA0003839735680000048
4)以此类推,直至求得全部k段机械臂的形态,根据公式(5)将其组合,最终得到多段连续体机械臂的形态
Figure FDA0003839735680000049
Figure FDA00038397356800000410
CN202211099656.4A 2022-09-09 2022-09-09 一种多段连续体机械臂形态预测方法 Pending CN115383793A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211099656.4A CN115383793A (zh) 2022-09-09 2022-09-09 一种多段连续体机械臂形态预测方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211099656.4A CN115383793A (zh) 2022-09-09 2022-09-09 一种多段连续体机械臂形态预测方法

Publications (1)

Publication Number Publication Date
CN115383793A true CN115383793A (zh) 2022-11-25

Family

ID=84126485

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211099656.4A Pending CN115383793A (zh) 2022-09-09 2022-09-09 一种多段连续体机械臂形态预测方法

Country Status (1)

Country Link
CN (1) CN115383793A (zh)

Similar Documents

Publication Publication Date Title
WO2020216155A1 (zh) 一种绳驱动连续型机械臂的三维静力学建模方法
CN112757306B (zh) 一种机械臂逆解多解选择和时间最优轨迹规划算法
Rucker et al. Computing jacobians and compliance matrices for externally loaded continuum robots
Mahvash et al. Stiffness control of a continuum manipulator in contact with a soft environment
CN108237534A (zh) 一种连续型机械臂的空间避障轨迹规划方法
Wu et al. Vibration reduction of delta robot based on trajectory planning
CN105598968B (zh) 一种并联机械臂的运动规划与控制方法
CN104933232B (zh) 一种杆端浮动型六自由度并联机器人带角度补偿的运动学求解方法
CN112338912A (zh) 一种柔性单链机械臂的有限时间稳定控制方法及系统
CN108621160B (zh) 八索并联重力补偿系统的去冗余控制方法
CN108098777B (zh) 一种冗余度机械臂力矩层重复运动控制方法
CN112936273B (zh) 一种绳驱柔性机械臂的速度级运动学建模方法
CN112936287B (zh) 一种基于动力学迭代学习的柔性机器人控制方法及装置
He et al. Kinematic design of a serial-parallel hybrid finger mechanism actuated by twisted-and-coiled polymer
CN112276940A (zh) 一种六自由度非球型手腕机器人逆运动学求解方法
Gao et al. Tension distribution algorithm based on graphics with high computational efficiency and robust optimization for two-redundant cable-driven parallel robots
CN109434838B (zh) 线驱动连续机器人内窥操作的协同运动规划方法及系统
CN115383793A (zh) 一种多段连续体机械臂形态预测方法
CN111300424A (zh) 一种三自由度并联结构运动学系统及其求解方法
CN114714351B (zh) 用于移动机械臂的抗饱和目标跟踪控制方法及控制系统
Wang et al. Experimental investigation on adaptive grasping of a novel 3D-MSSPA gripper in complex space
CN114840947A (zh) 一种带约束的三自由度机械臂动力学模型
Shi et al. Study on the Articulated Finger Based on Pneumatic Soft Joint
CN112461491B (zh) 基于匀加速运动的捕获轨迹(cts)试验速度控制方法
CN113246121B (zh) 一种基于Actor-Critic深度强化学习的同心管机器人控制方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination