CN115383793A - 一种多段连续体机械臂形态预测方法 - Google Patents
一种多段连续体机械臂形态预测方法 Download PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 29
- 238000006073 displacement reaction Methods 0.000 claims abstract description 33
- 230000003068 static effect Effects 0.000 claims abstract description 20
- 238000013507 mapping Methods 0.000 claims abstract description 5
- 239000011159 matrix material Substances 0.000 claims description 17
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 4
- 230000004660 morphological change Effects 0.000 claims description 3
- 230000008878 coupling Effects 0.000 claims description 2
- 238000010168 coupling process Methods 0.000 claims description 2
- 238000005859 coupling reaction Methods 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 claims 1
- 230000008859 change Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000877 morphologic effect Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000005452 bending Methods 0.000 description 1
- 230000006835 compression Effects 0.000 description 1
- 238000007906 compression Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 239000013013 elastic material Substances 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000002324 minimally invasive surgery Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000010008 shearing Methods 0.000 description 1
- 125000006850 spacer group Chemical group 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means 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的力和力矩平衡关系,得到力平衡方程,可求得
步骤1-3:结合步骤1-2中公式(1)和(2),引入驱动丝与中心杆之间的耦合关系,得到驱动丝对中心杆的力和力矩为
其中τi为第i根驱动丝的拉力。
同时定义中间变量如下:
其中符号(·)b表示该变量在局部坐标系下的表达形式,n为驱动丝数量。
步骤1-4:结合以上步骤及其中公式,建立单段连续体机械臂静力学模型为:
其中
步骤2、通过组合单段连续体机械臂,建立如图2所示的多段连续体机械臂的几何描述和静力学模型:
多段连续体机械臂中心杆的空间位置和对应旋转矩阵可写为
其中,代表第k段机械臂的空间位置分布,代表第k段机械臂的旋转矩阵分布,s的取值范围为[∫Lk,∫Lk+1],Lk为第k段机械臂的长度,∫Lk为前k段机械臂的长度之和;为前k段机械臂的空间分布;为前k段机械臂的姿态矩阵分布;
为了便于每一段的姿态计算,额外定义
此时δ的取值范围为[0,Lk]。
定义驱动丝的空间位置
步骤3、考虑多段连续体机械臂中前一段机械臂形态变化对后一段机械臂所属驱动丝的位移量的影响,建立每段机械臂的驱动丝有效位移量的概念,并给出每段机械臂的驱动丝有效位移量的求解公式:
结合公式(7),对于第k段机械臂的第i根驱动丝,其有效位移量的计算公式如下:
其中qk,i为是第k段的第i根驱动丝的有效位移量,类比公式(8),可以得到qk为第k段的所有驱动丝的有效位移量。
步骤4、根据力的平衡方程和几何方程,结合公式(6)的定义,给出各段机械臂形态求解时初值条件的迭代公式:
其中0k+1为第k+1段机械臂起始位置。
步骤5、基于多段连续体机械臂的静力学模型,结合上述步骤的静力学模型和形态求解的迭代公式,依次求解各段机械臂形态,建立驱动器输入量与形态映射关系,其求解过程如下:
如图4所示,计算实例的机械臂本体共有k=2段,由中心杆、间隔盘和驱动丝构成,第2段的驱动丝穿过第1段。两段机械臂的长度L1=L2=l,中心杆上分布有若干间隔盘。
如图5所示,每段机械臂都有n=4根驱动丝控制,驱动丝在驱动器输入量下产生位移,驱动机械臂实现不同形态。两段的驱动丝都沿圆周均布,驱动丝到中心杆中心的偏距为loff=0.023m。
计算实例中,给定中心杆初始形态为
驱动器输入量为
两段机械臂的驱动丝在局部坐标下的分布为
按以下步骤进行形态预测:
步骤1、基于Cosserat杆理论,建立单段连续体机械臂的几何描述及静力学模型如公式(4)。
步骤2、通过组合单段连续体机械臂,建立如图2所示的两段连续体机械臂的几何描述为
其中,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根驱动丝在中心杆截面局部坐标下的位置;和为第1段和第2段的驱动丝的驱动器输入量;
步骤3、考虑多段连续体机械臂中前一段机械臂形态变化对后一段机械臂所属驱动丝的位移量的影响,建立每段机械臂的驱动丝有效位移量的概念,并给出每段机械臂的驱动丝有效位移量的求解公式:
其中q2,i为是第2段的第i根驱动丝的有效位移量,L1 0为前1段中心杆的长度。
步骤4、根据力的平衡方程和几何方程,给出各段机械臂形态求解时初值条件的迭代公式:
P2(02)=P1(L1) (15)
R2(02)=R1(L1)
其中,L1为第1段机械臂的长度。
步骤5、基于多段连续体机械臂的静力学模型,结合上述步骤的静力学模型和形态求解的迭代公式,依次求解各段机械臂形态,建立驱动器输入量与形态映射关系,其求解过程为:
3)对于第2段机械臂,根据公式(12)、(13)、(14)可计算第2段的驱动丝有效位移量q2,再根据式(15)计算第2段机械臂的初值条件,将二者代入式(4),计算即可得到第2段形态P1 2和R1 2;
图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:根据力平衡方程,求得
步骤1-3:结合公式(1)和(2),引入驱动丝与中心杆之间的耦合关系,得到驱动丝对中心杆的力和力矩为:
其中τi为第i根驱动丝的拉力;
同时定义中间变量如下:
其中符号(·)b表示该变量在局部坐标系下的表达形式,n为驱动丝数量;
步骤1-4:结合以上步骤,建立单段连续体机械臂静力学模型为:
其中
3.根据权利要求2所述的多段连续体机械臂形态预测方法,其特征在于,步骤2具体包括:将单段连续体机械臂组合为多段,则多段连续体机械臂中心杆的空间位置和对应旋转矩阵为:
其中,代表第k段机械臂的空间位置分布,代表第k段机械臂的旋转矩阵分布,s的取值范围为[∫Lk,∫Lk+1],Lk为第k段机械臂的长度,∫Lk为前k段机械臂的长度之和;为前k段机械臂的空间分布;为前k段机械臂的姿态矩阵分布;
为了便于每一段机械臂的姿态计算,额外定义
其中δ的取值范围为[0,Lk];
定义驱动丝的空间位置:
pk,i(s)为第k段的第i根驱动丝的空间分布;rk,i(s)为控制第k段的第i根驱动丝在中心杆截面局部坐标下的位置;
6.根据权利要求5所述的多段连续体机械臂形态预测方法,其特征在于,步骤5具体包括:
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) |
-
2022
- 2022-09-09 CN CN202211099656.4A patent/CN115383793A/zh active Pending
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 |