2. 哈尔滨工业大学机器人技术与系统国家重点实验室, 黑龙江 哈尔滨 150001
2. State Key Laboratory of Robotics and System, Harbin Institute of Technology, Harbin 150001, China
随着航空航天技术的发展和太空探索脚步的加快,航天器频繁地进入太空执行任务。太空环境中的高真空、大温差、强辐射等恶劣条件,极易引发航天器故障,降低航天器使用年限。为了提高航天器使用寿命,可采用机械手代替宇航员从事舱外作业,利用多自由度空间机械手进行部件更换、装配和在轨维修等任务[1-11]。
根据是否做刚性折叠面,可以将折纸分为刚性折纸和非刚性折纸。刚性折纸在折叠/展开过程中,折痕面之间始终保持刚性,只有折痕处发生变形,可以沿着预定的折痕,在不同状态间实现连续运动。Yasudai[12]在使用刚性折纸条件下,引入Yoshimura折纸设计了移动避难所系统。Onal[13]等基于管状折纸结构设计了一种爬行机器人,该机器人通过形状记忆合金丝的驱动,使管状折纸结构进行轴向伸缩运动,实现模仿毛毛虫运动模式的爬行运动。此外,Jeong和Lee[14]提出了一种基于扭曲塔折纸结构的三爪机器人机械手。Li等[15]通过对折纸的人造肌肉结构进行分析,实现收缩、弯曲和扭转等运动方式。Overvelde[16]分析了折纸多重自由度3维可转换元材料的力学理论。Silverberg等[17-18]对折纸结构的自由度产生的双稳定性进行理论分析。Suh等[19-20]提出了一种Yoshimura折纸结构的折叠新方法,并通过静力分析证实了所提出的折叠方法的有效性。中国科学技术大学陈小平等[21]研发了一种基于蜂巢气动网络的夹持器,该结构柔软且灵活,表现出良好的相容性;结合蜂巢网络的变形特点,能够抓取形状复杂的物体。
目前折纸机械手存在包络抓取范围偏小、只能对某一相同类型的目标进行抓取的不足。鉴于此,本文提出一种Kresling和Miura折痕混合型三指机械手结构,对Kresling折痕进行几何分析,建立了Kresling折痕参数与应变能之间的关系方程。利用坐标法建立多层Miura单元力矩与指节长宽比之间的关系方程;基于虚功原理建立了混合型单元各参数之间关系的数学模型,确定了机械手的各个参数,采用D-H(Denavit-Hartenberg)坐标法计算出末端点的分布,确定机械手的工作空间;采用力矩平衡方法,以圆柱体和长方体为例,分别对机械手指尖抓取和包络抓取两种情况进行分析,建立了各接触力与各关节角之间关系的理论模型。
2 机械手结构(Manipulator structure)混合型机械手结构如图 1所示。该结构由上层Miura折痕与下层Kresling折痕组合而成的基本混合层,由该基本混合层沿纵向叠加可以形成单个手指结构,其中Miura折痕构成关节、Kresling折痕构成指段,3根由混合折痕层构成的手指通过组合形成机械手整体结构。通过对Kresling折痕单元长度和Miura折痕弯曲角度进行调整可抓取不同形状、重量、大小的物体从而满足设计要求。
![]() |
图 1 混合型机械手几何示意图 Fig.1 Geometric sketch of the hybrid manipulator |
Kresling平面折痕结构和柱状结构如图 2所示,Kresling多边形外接圆半径
$ \begin{align} R=\dfrac{a}{2\sin \dfrac{\pi}{n}} \end{align} $ | (1) |
![]() |
图 2 Kresling折痕结构和柱状结构 Fig.2 Kresling crease structure and columnar structure |
式中,
上、下平面之间的高度
$ \begin{align} H=b\sin \delta \end{align} $ | (2) |
式中,
$ \begin{align} b=\sqrt{4R^{2}\sin^{2}\dfrac{2{\pi} -n\theta}{2n}+(b\sin \delta)^{2}} \end{align} $ | (3) |
式中,
若Kresling折痕能实现完全折叠,则要求Kresling折痕必须满足
$ \begin{align} \dfrac{b\cos \delta}{2R} \leqslant 1 \end{align} $ | (4) |
将式(1) 代入式(4),可得
$ \begin{align} \dfrac{b}{a}\leqslant \frac{1}{\sin \dfrac{\pi}{n}\cos \delta} \end{align} $ | (5) |
根据几何关系可得
$ \begin{align} \dfrac{c}{a}=\sqrt{I_{1}^{2} +\arcsin (I_{1} \cos \delta \dfrac{b}{a})/I_{1} +I_{2}^{2}} \end{align} $ | (6) |
式中,
取
$ \begin{align} \omega =W/E=\dfrac{1}{2}(c/c_{0} -1)^{2} \end{align} $ | (7) |
式中,
不同条件下折痕
![]() |
图 3 不同条件下的比值 |
Kresling折痕运动的平面高度差
$ \begin{align} \Delta H=h_{0} -H=b-b\sin \delta \end{align} $ | (8) |
式中,
柱状结构旋转
$ \begin{align} W=\dfrac{1}{2}nk(b_{1} -b_{0})^{2}+\dfrac{1}{2}nk(c_{1} -c_{0})^{2} \end{align} $ | (9) |
式中,
$ \begin{align*} b_{1}&= \sqrt{(b - \Delta H)^{2}+ 2 R^{2}(\theta +{\pi} / n - \theta_{0})} \\ c_{1}&= \sqrt{( b - \Delta H)^{2}+ 2 R^{2}(\theta - {\pi} / n+\theta_{0})} \end{align*} $ |
由式(9) 可以得到旋转高度
![]() |
图 4 应变能 |
Miura平面折痕图如图 5所示。图中红色虚线表示山谷折痕,黑色实线表示山峰折痕,平面Miura折痕为矩形单元,
![]() |
图 5 Miura的折痕图 Fig.5 Crease pattern of Miura |
由图 5可知
$ \begin{align} l_{AO} =\sqrt{a_{0}^{2} +{b_{0}^{2}} /4-a_{0} b_{0} \cos \alpha} \end{align} $ | (10) |
式中,
输入角度
![]() |
图 6 Miura折痕单元 Fig.6 Miura crease unit |
不同的输入角度对应不同的Miura折痕单元山峰、山谷折痕的位置状态,山峰折线折痕角
$ \begin{align} \begin{cases} \beta_{\rm m} =\arccos (2\cos c-1)-{\pi} \\ \beta_{\rm v} =2(\angle CAB+\angle EAB-{\pi} /2) \end{cases} \end{align} $ | (11) |
式中,
$ \begin{align} \beta_{\rm v} = \begin{cases} 2(\arcsin \chi_{11} +\arccos \chi_{12})-{\pi}, \\[-5pt] \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \beta_{\rm v}\in (0 ^{\circ} , 90 ^{\circ})\\ 2(\arccos (\csc c-\cot c)-\arcsin \chi_{11} -{\pi} /2), \\[-5pt] \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \beta_{\rm v}\in (90 ^{\circ} , 135 ^{\circ}) \end{cases} \end{align} $ | (12) |
式中,
输入的角度
![]() |
图 7 山谷折痕角 |
由图 7可知,山峰折线折痕角
对多层Miura折痕单元建立坐标系,如图 8所示。
![]() |
图 8 8多层Miura单元 Fig.8 Multilayer Miura units |
在垂直于水平面的方向施加压力
$ \begin{align} M_{\rm T} =Fd\frac{\sin \dfrac{{\pi} -\alpha_{1}}{2}}{\sqrt{\lambda^{2}+2\lambda \cos \dfrac{{\pi} -\alpha_{1}}{2}+1}} \end{align} $ | (13) |
取
![]() |
图 9 力矩 |
当
$ \begin{align} W_{F{1}} =Fd(\varsigma_{1} -\varsigma_{2})/\lambda \end{align} $ | (14) |
式中,
平均力矩
$ \begin{align} \begin{cases} \bar{M}_{F{1}} =Fd({\varsigma_{1} +\varsigma_{2}})/({\lambda \Delta \alpha_{2} -\lambda \Delta \alpha_{1}}) \\ W_{F{1}} =\bar{M}_{F{1}} ({\Delta \alpha_{2} -\Delta \alpha_{1}}) \end{cases} \end{align} $ | (15) |
当
$ \begin{align} W_{F{1}} = \begin{cases} 2Fd/\lambda, & \lambda \geqslant 1 \\ 2Fd, & 0<\lambda <1 \end{cases} \end{align} $ | (16) |
由式(16) 可知,在关节宽度
![]() |
图 10 |
建立混合型手指单元的坐标系,如图 11所示。每层Miura单元之间的夹角为
![]() |
图 11 11混合型折痕单元坐标系 Fig.11 Coordinate system of the hybrid crease element |
线段长度
$ \begin{align} {\rm d}l_{B_{\rm M} C_{\rm K}} =-\frac{ab\sin \beta} {\sqrt{a^{2}+b^{2}-2ab\cos \beta} {\rm d}\beta} \end{align} $ | (17) |
假设在垂直于水平面的外力
$ \begin{align} {\rm d}Fb_{ F} {\rm d}\beta =k_{\rm T} {\rm d}l_{B_{\rm M} C_{\rm K}} \end{align} $ | (18) |
式中,
令
$ \begin{align} \frac{k_{ F} b_{ F}} {k_{\rm T}} =\frac{ab\sin^{2}\beta} {1+a^{2}b^{2}-2ab\cos \beta} \end{align} $ | (19) |
旋转角度
![]() |
图 12 单位刚度比 |
假设Miura折痕间的夹角
$ \begin{align} \alpha_{1} =nb_{\rm m} \cdot \sin (\varphi /2)\cdot \varphi {\pi} /(90d) \end{align} $ | (20) |
Miura单元层数为
![]() |
图 13 13最小单元角 |
该研究中提出的机械手结构是由Kresling和Miura单元组成,如图 14所示。Kresling折痕构成的指段可以简化看作杆件,简化后的杆件长度分别对应指段长度
![]() |
图 14 机械手单根手指坐标图 Fig.14 Coordinate diagram of a single finger of the manipulator |
上、下平面必须保持平行,则绕
$ \begin{align} \begin{cases} \varepsilon_{\rm d} =l_{i} -\dfrac{2al_{i} {\pi} -a^{2}l_{i} \varepsilon_{\theta}} {2a{\pi} } \\[5pt] \phi_{i}^{\max} =2\arcsin \dfrac{l_{i} -\varepsilon_{\rm d}} {4R} \\[5pt] d_{i} =l_{i} -2R\sin \dfrac{\phi_{i}} {2} \end{cases} \end{align} $ | (21) |
由D-H变换矩阵得机械手工作空间为
$ \begin{align} {\rm rot} (x, \varphi_{i} )& = \begin{bmatrix} {c_{1}} & {-s_{1}} & 0 & 0 \\ {s_{1}} & {c_{1}} & 0 & 1 \\ 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 1 \end{bmatrix} \end{align} $ | (22) |
$ \begin{align} {\rm rot} (y, a_{i} )& = \begin{bmatrix} {c_{1}} & 0 & {-s_{1}} & 0 \\ 0 & 1 & 0 & 0 \\ {-s_{1}} & 0 & {c_{1}} & 0 \\ 0 & 0 & 0 & 1 \end{bmatrix} \end{align} $ | (23) |
$ \begin{align} \mathit{\boldsymbol{P}} & = \begin{bmatrix} 1 & 0 & 0 & {d_{i} s_{i} c_{i} f_{i} /2} \\ 0 & 1 & 0 & {d_{i} s_{i} s_{i} f_{i} /2} \\ 0 & 0 & 1 & {d_{i} c_{i} f_{i} /2} \\ 0 & 0 & 0 & 1 \end{bmatrix} \end{align} $ | (24) |
$ \begin{align} (x, y, z)&=\prod\limits_{i=1}^m {{\mathit{\boldsymbol{D}}}_{i}} {\mathit{\boldsymbol{\kappa}}} \end{align} $ | (25) |
式中,
机械手工作空间如图 15所示。图中点表示机械手末端所到达的位置,越密集表明抓取物体越容易;点较疏的地方则需要通过特定姿态才能实现抓取。从整体来看,该机械手指抓取的范围较广。
![]() |
图 15 机械手工作空间 Fig.15 Manipulator workspace |
在机械手执行抓取任务时,需要考虑抓取的稳定性,下面对机械手进行指尖抓取和手指包络抓取的稳定性分析。机械手的3根手指的结构完全相同,因此这里以单根手指为例进行抓取分析,机械手指尖抓取物体的情形如图 16所示,
![]() |
图 16 机械手指尖抓取 Fig.16 Fingertip grasping by the manipulator |
折纸机械手抓取半径为
$ \begin{align} r_{1} =\, & l_{1} \cos \phi_{123 {\rm A}} -d_{\rm{oj}} +(d_{\rm{oj}} -l_{1} \sin \phi_{1 {\rm A}})\sin \phi_{1{23 {\rm A}}}+ \\ & l_{1} \cos \phi_{23{\rm A}} +\phi_{2{\rm A}} +l_{1} \cos \phi_{1{\rm A}} +L \end{align} $ | (26) |
若抓取物块为长度为
$ \begin{align} h=\, & 2l_{1} \cos \varUpsilon_{11} +2(d-l_{1} \sin \phi_{1\rm A})\sin \varUpsilon_{11} + \\ & 2l_{1} \cos \varUpsilon_{12} +2l_{1} \cos \phi_{1\rm A} +\frac{3}{2}L-2d_{\rm{oj}} \end{align} $ | (27) |
式中,
由受力平衡可得单个手指受力
$ \begin{align} F_{1} =\frac{T_{1} \sin \phi_{3{\rm A}}} {r_{1} \cos \phi_{1{\rm A}} +l_{1} (\cos \phi_{2{\rm A}} +\cos \phi_{3\rm A})} \end{align} $ | (28) |
式中,
手指包络抓取长方体的几何模型如图 17所示,由几何关系可以推导出如下角度关系:
$ \begin{align} \begin{cases} \tan \alpha_{1} =\dfrac{a}{\mu_{1} -\psi_{1}} \\[5pt] \tan \zeta_{12} =\dfrac{a-l_{1} \sin \alpha_{1}} {l_{1} \cos \alpha_{1} -\mu_{2} +\psi_{1}} \\[5pt] \tan \zeta_{13} =\dfrac{a+b_{0}} {l_{1} \cos \alpha_{1} -\mu_{3} +\psi_{1}} \end{cases} \end{align} $ | (29) |
![]() |
图 17 手指包络抓取长方体 Fig.17 A finger grasping a cuboid in an envelope manner |
式中,
若抓取长度
![]() |
图 18 物体长度 |
机械手抓取圆柱体时的情形如图 19所示。
![]() |
图 19 手指包络抓取圆柱体截面图 Fig.19 Section diagram of a finger grasping a cylinder in an envelope manner |
根据机械手的尺寸,可以得出
$ \begin{align} \begin{cases} \tan \alpha_{1} =\dfrac{a}{\mu_{1} -{b_{0}} /2+r/\sin \alpha_{1}} \\[8pt] \varTheta_{12} =\dfrac{l_{1} \sin \alpha_{1} -a-\omega} {\xi -\mu_{2} -\chi} \\[8pt] \varTheta_{123} =-\dfrac{(a+\omega)(2P-rQ)}{\psi -h_{0}} \end{cases} \end{align} $ | (30) |
式中,
不同半径的圆柱体与关节角度之间的关系如图 20所示。由图可知,第1指节的转动角度
![]() |
图 20 圆柱体长度 |
根据虚功原理,各外力在所有方向上的代数和为0,即
$ \begin{align} \delta W=\sum _{i=1}^n {F_{i}} \delta r_{i} =0 \end{align} $ | (31) |
式中,
因为
$ \begin{align} & k_{1} {\Delta} \theta_{1} F_{1} +k_{1} {\Delta} \theta_{1} F_{2} -l_{1} {\Delta} \theta_{1} F_{2} \cos \alpha_{2} + \\ & \;\;\;\;k_{3} {\Delta} \theta_{3} F_{3} -l_{2} {\Delta} \theta_{2} F_{3} \cos (\alpha_{3} -\alpha_{2}) - \\ &\;\;\;\; l_{1} {\Delta} \theta_{1} F_{3} \cos \alpha_{2} +\delta_{\rm s} F_{\rm s} =0 \end{align} $ | (32) |
$ \begin{align} & \begin{cases} k_{1} F_{1} -l_{1} \cos \alpha_{2} (F_{2} -F_{3})+\dfrac{l_{2} NF_{\rm s}} {\sin \alpha_{1}} =0 \\[5pt] k_{2} F_{2} -l_{2} NF_{\rm s} -\dfrac{l_{2} NF_{\rm s}} {\sin \alpha_{1}} =0 \\[5pt] k_{3} F_{3} -\dfrac{k_{3} NF_{\rm s}} {\sin \alpha_{1}} =0 \end{cases} \end{align} $ | (33) |
根据式(33) 可得各接触点的压力为
$ \begin{align} \begin{cases} F_{1} =\dfrac{l_{1} \cos \alpha_{1} (1-Nl_{2} +k_{2})-k_{2} l_{2}} {k_{1} k_{2} \sin \alpha_{1}} NF_{\rm s} \\[5pt] F_{2} =\dfrac{(1-N)l_{2}} {k_{2} \sin \alpha_{1}} NF_{\rm s} \\[8pt] F_{3} =\dfrac{-NF_{\rm s}} {\sin \alpha_{1}} \end{cases} \end{align} $ | (34) |
式中,
设驱动器输入的力
![]() |
图 21 接触力与角度关系 Fig.21 Relationship between the contact force and the angle |
当
(1) 提出一种折痕混合型三指机械手,通过对Kresling折痕与Miura折痕开展几何分析,确定了以Kresling折痕为手指指段、以Miura折痕作为手指关节的折纸机械手。
(2) 通过建立混合型单元,确定了采用1层Kresling折痕作为手指的指段,采用5层Miura折痕作为手指的关节,利用D-H法确定了机械手的抓取空间。
(3) 分析了机械手在包络抓取长方体与圆柱体对象时各接触点的压力与关节角度之间的关系,对比发现各接触点的压力随着关节角度的增大而增大。
[1] |
Tachi T. Origamizing polyhedral surfaces[J]. IEEE Transactions on Visualization and Computer Graphics, 2010, 16(2): 298-311. DOI:10.1109/TVCG.2009.67 |
[2] |
Wu W N, You Z. Modelling rigid origami with quaternions and dual quaternions[J]. Proceedings of the Royal Society, A: Mathematical, Physical and Engineering Sciences, 2010, 466(2119): 2155-2174. DOI:10.1098/rspa.2009.0625 |
[3] |
Zhang Q, Wommer J, O'Rourke C, et al. Origami and kirigami inspired self-folding for programming three-dimensional shape shifting of polymer sheets with light[J]. Extreme Mechanics Letters, 2016, 11: 111-120. |
[4] |
冯李航, 张为公, 龚宗洋, 等. Delta系列并联机器人研究进展与现状[J]. 机器人, 2014, 36(3): 375-384. Feng L H, Zhang W G, Gong Z Y, et al. Developments of Delta-like parallel manipulators – A review[J]. Robot, 2014, 36(3): 375-384. |
[5] |
张旭, 郑泽龙, 齐勇. 6自由度串联机器人D-H模型参数辨识及标定[J]. 机器人, 2016, 38(3): 360-370. Zhang X, Zheng Z L, Qi Y. Parameter identification and calibration of D-H model for 6-DOF serial robots[J]. Robot, 2016, 38(3): 360-370. |
[6] |
Chen W H, Misra S, Gao Y C, et al. A programmably compliant origami mechanism for dynamically dexterous robots[J]. IEEE Robotics and Automation Letters, 2020, 5(2): 2131-2137. DOI:10.1109/LRA.2020.2970637 |
[7] |
Cai J G, Deng X W, Zhou Y, et al. Bistable behavior of the cylindrical origami structure with Kresling pattern[J]. Journal of Mechanical Design, 2015, 137(6). DOI:10.1115/1.4030158 |
[8] |
Al-Mansoori M, Khan K A, Cantwell W J, et al. Harnessing architected stiffeners to manufacture origami-inspired foldable composite structures[J]. Composites Science and Technology, 2020, 200. DOI:10.1016/j.compscitech.2020.108449 |
[9] |
Schenk M, Guest S D. Geometry of Miura-folded metamaterials[J]. Proceedings of the National Academy of Sciences of the United States of America, 2013, 110(9): 3276-3281. DOI:10.1073/pnas.1217998110 |
[10] |
Chen Y, Lv W L, Peng R, et al. Mobile assemblies of four-spherical-4R-integrated linkages and the associated four-crease-integrated rigid origami patterns[J]. Mechanism and Machine Theory, 2019, 142(C). DOI:10.1016/j.mechmachtheory.2019.103613 |
[11] |
Cheung K C, Tachi T, Calisch S, et al. Origami interleaved tube cellular materials[J]. Smart Materials and Structures, 2014, 23(9). DOI:10.1088/0964-1726/23/9/094012 |
[12] |
Yasuda H, Yang J. Origami-based metamaterials with negative Poisson's ratio and bistability[J]. Physical Review Letters, 2015, 114(18). DOI:10.1103/PhysRevLett.114.185502 |
[13] |
Onal C D, Wood R J, Rus D. An origami-inspired approach to worm robots[J]. IEEE/ASME Transactions on Mechatronics, 2013, 18(2): 430-438. DOI:10.1109/TMECH.2012.2210239 |
[14] |
Jeong D, Lee K. Design and analysis of an origami-based three-finger manipulator[J]. Robotica, 2018, 36(2): 261-274. DOI:10.1017/S0263574717000340 |
[15] |
Li S G, Vogt D M, Rus D, et al. Fluid-driven origami-inspired artificial muscles[J]. Proceedings of the National Academy of Sciences of the United States of America, 2017, 114(50): 13132-13137. DOI:10.1073/pnas.1713450114 |
[16] |
Overvelde J T B, de Jong T A, Shevchenko Y, et al. A three-dimensional actuated origami-inspired transformable metamaterial with multiple degrees of freedom[J]. Nature Communications, 2016, 7. DOI:10.1038/ncomms10929 |
[17] |
Silverberg J L, Na J H, Evans A A, et al. Origami structures with a critical transition to bistability arising from hidden degrees of freedom[J]. Nature Materials, 2015, 14(4): 389-393. DOI:10.1038/nmat4232 |
[18] |
Waitukaitis S, Menaut R, Chen B G G, et al. Origami multistability: From single vertices to metasheets[J]. Physical Review Letters, 2015, 114(5). DOI:10.1103/physrevlett.114.055503 |
[19] |
Suh J E, Kim T H, Han J H. New approach to folding a thin-walled Yoshimura patterned cylinder[J]. Journal of Spacecraft and Rockets, 2020, 58(2): 516-530. |
[20] |
Evans A A, Silverberg J L, Santangelo C D. Lattice mechanics of origami tessellations[J]. Physical Review E: Statistical, Nonlinear, and Soft Matter Physics, 2015, 92(1). DOI:10.1103/PhysRevE.92.013205 |
[21] |
王宁扬, 孙昊, 姜皓, 等. 一种基于蜂巢气动网络的软体夹持器抓取策略研究[J]. 机器人, 2016, 38(3): 371-377, 384. Wang N Y, Sun H, Jiang H, et al. On grasp strategy of honeycomb PneuNets soft gripper[J]. Robot, 2016, 38(3): 371-377, 384. |