刚柔耦合机械手的抓握姿态和力综合优化方法
Comprehensive optimization of gripping gesture and force of soft-rigid robotic hand
收稿日期: 2023-03-29
基金资助: |
|
Received: 2023-03-29
Fund supported: | 国家自然科学基金资助项目(52201398);江苏省自然科学基金资助项目(BK20220343) |
作者简介 About authors
王天磊(1992—),男,博士,从事柔性机器人研究.orcid.org/0000-0002-4894-4559.E-mail:
针对刚柔耦合机械手在抓握物体时既要有合适的抓握姿态,又要有与抓握力匹配的手指刚度的问题,研究抓握姿态和力综合优化方法. 建立机械手的几何模型以获得手指刚度与驱动压强的关系,基于所建模型构造手指姿态曲线与被抓握物体轮廓曲线的贴合度函数、与期望抓握力有关的手指期望刚度函数,并结合姿态贴合度函数和手指刚度函数构造综合优化目标函数. 利用所建目标函数计算不同期望抓握力下的最优抓握姿态,通过实验对比不同最优姿态下施加额外抓握力对抓握稳定性的影响. 实验结果表明,所提综合优化方法能够良好兼顾抓握姿态和抓握力的控制要求,实现刚柔耦合机械手的稳定可靠抓握.
关键词:
Aiming at the problem that a soft-rigid robotic hand not only needs appropriate gripping gesture when grasping objects, but also needs appropriate finger stiffness to match up with the gripping force, a comprehensive gripping gesture and force optimization method was investigated. The geometry model of the robotic hand was established, and the relationship between the soft finger rigidity and the actuation pressure was acquired. Based on the established models, the similarity function of the finger gesture curve and the object counter curve, and the expected finger rigidity function related to the expected gripping force were both established. The comprehensive optimization objective function was synthesized by combining the gesture similarity function and the finger rigidity function. The optimal gripping gestures were calculated under different expected forces using the established objective function. A gripping experiment was conducted on different optimal gestures with different external gripping forces, and the influence of the extra gripping forces on the gesture stability was evaluated. Experimental results show that the proposed comprehensive optimization method acquires both proper gesture and force according to different control requirements, and stable and reliable gripping performance of the robotic hand is achieved.
Keywords:
本文引用格式
王天磊, 冯李航, 孙振兴, 柯云, 李超超, 胡记伟.
WANG Tian-lei, FENG Li-hang, SUN Zhen-xing, KE Yun, LI Chao-chao, HU Ji-wei.
为了解决柔性机械手的抓握姿态和抓握力控制的问题,本研究以前期研究设计的刚柔耦合机械手为平台,在前期研究提出的抓握姿态优化算法的基础上[21],深入研究并提出综合考虑机械手的抓握力和手指姿态贴合适应性的抓握姿态优化方法. 建立期望抓握力与期望手指刚度的联系,综合抓握姿态贴合度和期望刚度构建优化目标函数,对比不同期望抓握力对最优抓握姿态的影响. 通过仿真和实验验证所提算法的可行性.
1. 机械手设计和建模
1.1. 机械手结构设计
以前期研究设计的刚柔耦合机械手为对象,机械手的详细设计方法可以参考文献[21],机械手的整体结构如图1所示. 机械手自然状态下竖直方向长度约为190 mm,直径约为120 mm,由刚性骨架、柔性驱动单元和柔性手指3个部分构成. 刚性骨架采用铝合金材料,为整体结构提供稳定支撑和可靠的力传导. 机械手的手掌(以下简称为手掌)中心气动弹簧和手指均为柔性聚氨酯材料,保证了作业的柔顺性和安全性. 手掌在中心的线性气动弹簧的驱动下,可以模仿人类手掌的开合和抓握姿态调节功能,并在不主动改变手指姿态的情况下,提供额外抓握力. 手掌骨架末端连接3根手指,每根手指均由独立制作的近端指节和末端指节黏合而成. 每个黏合后的完整手指包含2个独立的气动腔体,腔体内的正负气压驱动2个指节分别向正或反方向弯曲,为机械手提供足够的自由度以调节合适的抓握姿态.
图 1
在多路气压驱动下,机械手能够提供多种复杂的不对称抓握姿态,但本研究采用对称的方式驱动机械手,3个近端指节和3个末端指节分别连接2个气动回路,3个手指抓握时在各自的弯曲平面上具有相同的弯曲状态. 相应地,后续的姿态优化方法针对轴对称物体,即物体在各个轴向竖直剖面上均具有相同的轮廓.
1.2. 机械手几何建模
机械手几何模型是抓握姿态优化算法的基础,根据机械手姿态和物体的轴对称性,取单个手指的弯曲平面作为截面对1个手指分支进行建模,如图2所示. 图中,灰色圆表示转动铰链,机械手上的粗实线为刚性连接,虚线为柔性手指曲线,中间灰色块为待抓握物体,灰色块边缘粗实线为物体轮廓曲线. 坐标原点O建立在机械手掌的顶端中心,U为物体轮廓曲线,Ω1、Ω3分别为近端和末端手指曲线,Ω2为中间的连接直线段. Ω1与上端固定骨架的连接点的切线BC平行. 忽略手指材料的伸长,则Ωi(i = 1, 2, 3)在弯曲时保持与物体接触面的总长度不变. 刚性连接线段AB、BC'、C'C、GH的长度分别为d2、d3、d4和da,铰链G固定在刚性杆AB上,线段AG的长度为d1. 柔性手指上的曲线段Ω1、Ω2、Ω3的长度分别为l1、l2、l3. 半径AO和HQ的长度分别为r1和r2.
图 2
为了方便描述,使用带有符号的半径定义手指的弯曲曲率半径ρ1、ρ2,正半径代表正气压下的向中轴线侧的弯曲,负半径代表负气压下的向远离中轴线方向的弯曲. 柔性手指连接点C的坐标为C(xC, yC),其中:
Ω1弯曲后的曲率中心坐标为
Ω1的下端点D的坐标为
与D相连接的Ω2为不可弯曲的直线,其末端点E的坐标为
Ω3弯曲后的曲率中心坐标为
1.3. 柔性手指刚度特性测试
实现稳定可靠的抓握要求柔性手指的刚度与机械手期望施加的抓握力相适应. 为了描述柔性手指刚度与驱动气压压强的关系,进行如图3所示的手指刚度测试实验. 柔性手指固定在测试平台上方,传感器安装在位移标尺的直线滑台上,可以在对手指末端施加位移和力的同时测量位移和力的大小. 每个时刻手指的近端和末端指节同时施加压强p,手指刚度以手指末端压力Ft与末端位移xt的比值来表征,标尺行进相同位移测得的Ft越大,表明手指刚度越大. 由图3(c)、(d)所示的测试结果可以看出,柔性手指的刚度与其内部压强正相关. 增加内部压强不但增加了手指弯曲曲率[21],而且增加了手指刚度,更有利于在施加大抓握力的同时保持较小的手指姿态形变. 因此,根据手指刚度与内部压强的正相关性,可以在抓握姿态优化算法中采用手指内部压强来表征手指刚度.
图 3
2. 抓握姿态和力综合优化算法
图 4
图 4 抓握姿态和力综合优化算法流程图
Fig.4 Flow chart of comprehensive optimization algorithm of gripping gesture and force
1)当
2)当
3)当
其中
为了使抓握更加稳定,在构造优化目标函数时综合考虑手指姿态曲线与被抓握物体轮廓曲线的贴合度,以及与期望抓握力有关的手指期望刚度. 一方面,对于稳定的抓握姿态,手指曲线Ωi应与物体曲线U有尽可能大的贴合度,以保证有足够大的接触面积. 另一方面,手指的刚度应能随物体特性和抓握力需求不同而不同. 根据上述思想,构造综合优化目标函数和约束条件为
式中:pi(i = 1, 2)为表征手指刚度的手指内部压强;σ为手指姿态与物体轮廓曲线贴合度;F为期望抓握力,
pi可以根据前期实验得到的拟合关系由手指的曲率半径计算得到[21]:
相应地,气动弹簧的长度与内部压强的关系为
式中:ps为气动弹簧内压强,pe为提供额外抓握力所施加的压强,ks为弹簧的等效刚度系数,S为有效截面积. σ由手指和物体轮廓曲线段上采样点的平均距离函数来描述:
式中:xi、xi,o分别为手指和被抓握物曲线上的采样点,成对分组,共有m组. 每条曲线上相邻采样点之间的距离相等.
式(11)中的优化约束条件限定了手指正负弯曲曲率均不能高于相应上下限值,即气压高压不能超过手指材料的物理强度限制,低压必须保持手指具有一定的最低刚度. 与气动弹簧伸长量相关的角α1的限制确保弹簧始终工作在线性形变区. 期望手指刚度应与不同期望抓握力相适应,手指刚度与内部压强呈正相关. 因此,式(11)中使用系数
3. 仿真和实验验证
使用如图5所示的圆柱体和球体2种典型形状的物体,通过仿真和实验来验证优化算法的效果. 图中,圆柱体和球体测试件中心都安装有压力传感器,用以在实验中测量机械手抓握时手指施加的压力.
图 5
3.1. 机械手抓握姿态仿真分析
使用Matlab仿真计算不同条件下的最优抓握姿态. 机械手的主要静态几何参数如表1所示,对于球体,取
表 1 机械手主要几何参数
Tab.1
参数 | 数值 | 参数 | 数值 | 参数 | 数值 | ||
d1/mm | 30 | l1/mm | 58 | r1/mm | 25 | ||
d2/mm | 50 | l2/mm | 9 | r2/mm | 23 | ||
d3/mm | 27 | l3/mm | 50 | da/mm | 29 | ||
d4/mm | 8 | β/(°) | 140 | — | — |
图 6
图 6 机械手在不同期望力下的最优抓握姿态
Fig.6 Optimized gesture of robotic hand with different expected forces
表 2 机械手的最优抓握姿态仿真结果
Tab.2
物体类型 | F/N | ρ1/mm | ρ2/mm | α1/(°) |
球体 | 0 | 1000.0 | 115.31 | 43.65 |
0.250 | 174.73 | 221.91 | 37.55 | |
0.500 | 141.87 | 239.36 | 35.61 | |
圆柱体 | 0 | 1000.0 | −166.87 | 57.82 |
0.125 | 536.44 | −144.32 | 56.80 | |
0.250 | 159.38 | −86.39 | 51.57 |
总体来说,由于手指的刚度和姿态相互关联,降低对手指的刚度要求可以获得更好的手指曲线贴合性,亦即抓握柔顺性. 图6(a)为机械手在抓握直径为12 cm的球体时的最优手指曲线. 当期望力F = 0 N时,机械手对抓握力无任何需求,手指曲线较为平直,内部压强较小,刚度较低. 此时若通过手掌施加额外抓握力,则会转化为手指的形变,不易将抓握力通过手指施加到物体上,从而实现利用手指的自身材料柔性保护被抓握物体的作用. 当期望力 F增大时,最优姿态下各指节具有较大的曲率,即较大的内部压强和刚度. 此时若施加额外抓握力,则手指可以相对较好保持其原有形状,并对物体施加较大抓握力. 对于球体物体的抓握,期望力分别为0.5 N和0.25 N的最优姿态差异并不显著. 图6(b)为机械手在抓握直径为5.2 cm的圆柱体时的最优手指曲线. 与图6(a)类似,期望抓握力越小,手指的驱动压强和曲率就越小,手指刚度也越小. 相比于抓握球形物体,抓握圆柱物体时增大期望力F会更显著地改变最优姿态下的手指曲率. 原因是在这种抓握需求下,目标函数式(11)中的曲线贴合度和手指刚度指标更容易达成平衡,不会因为更高的手指刚度过多牺牲手指曲线贴合性. 尽管如此,增加手指刚度仍然会略微减小末端指节抓握时的贴合性,会一定程度影响抓握柔顺性.
3.2. 机械手抓握实验
为了验证理论和仿真结果,进行如图7所示的抓握实验. 抓握实验依据图6的姿态优化结果,对比不同期望抓握力下的最优姿态对实际抓握的影响. 在实验中,机械手的一根手指正向压载在测试件的受压侧,测试件内部传感器直接测量单根手指对物体施加的抓握力. 为了验证手指刚度对额外施加抓握力的影响,实验对比施加额外抓握力后的手指形变状况. 图7(a)~(d)为机械手在抓握球体物体时的实验照片. 可以看出,不同手指刚度下的最优抓握姿态均可以获得较好的姿态贴合性,其中F = 0 N时的姿态贴合最好,且手指刚度最小,最不易损坏被抓握物. 过小的手指刚度不适于施加抓握力,如图7(b)所示,在F = 0 N姿态下,施加单指0.5 N的抓握力会使手指严重变形,导致球体无法被机械手包络,在实际应用中会使被抓取物掉落从而导致抓取失败. 相比之下,F = 0.5 N时的姿态则可以在同样的抓握力下较好地保持原有姿态,如图7(d)所示. 高刚度的手指形成的手爪姿态在施加压力后仍然可以保持对球体的包络,形成较为稳定的抓握. 图7(e)~(f)为机械手在抓握圆柱体物体时的实验照片. 由于F = 0 N时得到的最优姿态中气动弹簧初始伸长很大,能继续伸长并施加额外抓握力的空间较小,且手指刚度过小,无法满足施加足够的额外抓握力的要求,因此,仅对比F = 0.25 N时的施加抓握力前后姿态. 可以看出,由于抓握时手指刚度较大,施加单指0.25 N抓握力后手指形变很小,不会对手指姿态造成太大影响. 相比于几乎无法继续施加额外力的零期望抓握力下的最优姿态,显然考虑手指刚度的优化结果更具实用价值.
图 7
在实际应用中,期望抓握力的设置应与被抓握物体的特性相匹配. 手指刚度越高,在允许形变范围内可施加的抓握力越大. 当被抓握物较为柔软脆弱时,高手指刚度在允许施加更大抓握力的同时,也可能增加损坏物体的风险,较为柔软的手指姿态可以更好地保护物体.
4. 结 论
(1)本研究提出刚柔耦合机械手的抓握姿态和力综合优化方法,建立了期望抓握力与期望手指刚度之间的联系,综合抓握姿态轮廓曲线贴合度函数和手指刚度函数构建了优化目标函数,求解了机械手在不同期望抓握力下的最优抓握姿态.
(2)搭建机械手抓握实验平台,开展仿真和实验. 结果表明,小期望抓握力下求解的最优姿态更利于贴合度的提升,而大期望抓握力下的最优姿态则更利于减小手指因施加抓握力而产生的形变.
(3)仿真和实验结果证明本研究所提算法能充分兼顾抓握姿态和抓握力的控制要求,实现机械手的安全、柔顺和稳定抓握.
(4)未来将研究提升算法的普适性,提升硬件平台的可靠性,增强机械手的灵活性,并将优化方法拓展到复杂和不对称物体上,进一步提升机械手的作业能力.
参考文献
名优茶采摘机器人的系统设计与试验
[J].
Design and experiment of intelligent picking robot for famous tea
[J].
基于ROS的UR5机器人控制系统设计
[J].
Design of UR5 robot control system based on ROS
[J].
TBM钢拱架拼接机械手抓取对接机构
[J].
Grasping docking mechanism of TBM steel arch splicing robot
[J].
A review of soft manipulator research, applications, and opportunities
[J].DOI:10.1002/rob.22051 [本文引用: 1]
A bioinspired soft swallowing gripper for universal adaptable grasping
[J].DOI:10.1089/soro.2019.0106 [本文引用: 1]
A 3D-printed omni-purpose soft gripper
[J].
A fabrication free, 3D printed, multi-material, self-sensing soft actuator
[J].DOI:10.1109/LRA.2020.2986760 [本文引用: 1]
Variable stiffness electroadhesion and compliant electroadhesive grippers
[J].DOI:10.1089/soro.2021.0083 [本文引用: 1]
多杆连续体机构: 构型与应用
[J].DOI:10.3901/JME.2018.13.025 [本文引用: 1]
Multi-backbone continuum mechanisms: forms and applications
[J].DOI:10.3901/JME.2018.13.025 [本文引用: 1]
Toward a flexible variable stiffness endoport for single-site partial nephrectomy
[J].DOI:10.1007/s10439-018-2060-4 [本文引用: 1]
Soft robotic grippers for biological sampling on deep reefs
[J].DOI:10.1089/soro.2015.0019 [本文引用: 1]
A high-payload proprioceptive hybrid robotic gripper with soft origamic actuators
[J].DOI:10.1109/LRA.2020.2974438 [本文引用: 1]
A dexterous soft robotic hand for delicate in-hand manipulation
[J].DOI:10.1109/LRA.2020.3007411 [本文引用: 1]
气动软体采摘机械手设计及实验研究
[J].DOI:10.3785/j.issn.1006-754X.2022.00.085 [本文引用: 1]
Design and experimental research of pneumatic soft picking manipulator
[J].DOI:10.3785/j.issn.1006-754X.2022.00.085 [本文引用: 1]
四指软体机械手机械特性分析与抓取试验
[J].DOI:10.6041/j.issn.1000-1298.2022.09.045
Mechanical performance analysis and grasping experiment for four-finger soft manipulator
[J].DOI:10.6041/j.issn.1000-1298.2022.09.045
变腔室气动软体机械手结构设计与实验
[J].DOI:10.3969/j.issn.1001-3881.2021.11.022 [本文引用: 1]
Structure design and experiment of variable chamber pneumatic soft manipulator
[J].DOI:10.3969/j.issn.1001-3881.2021.11.022 [本文引用: 1]
Soft robotic gripper with compliant cell stacks for industrial part handling
[J].DOI:10.1109/LRA.2020.3020546 [本文引用: 1]
Optimal design of a motor-driven three-finger soft robotic gripper
[J].DOI:10.1109/TMECH.2020.2997743
复合驱动双指柔性机械手的设计与控制
[J].
Design and control of compound driven two-finger flexible manipulator
[J].
Design and gesture optimization of a soft-rigid robotic hand for adaptive grasping
[J].DOI:10.1089/soro.2021.0208 [本文引用: 5]
/
〈 |
|
〉 |
