浙江大学学报(工学版), 2020, 54(11): 2204-2213 doi: 10.3785/j.issn.1008-973X.2020.11.016

机械工程

TBM钢拱架拼接机械手抓取对接机构

何源福,, 夏毅敏,, 龙斌, 邓朝辉, 雷茂林, 姚捷

Grasping docking mechanism of TBM steel arch splicing robot

HE Yuan-fu,, XIA Yi-min,, LONG Bin, DENG Zhao-hui, LEI Mao-lin, YAO Jie

通讯作者: 夏毅敏,男,教授,博导. orcid.org/0000-0001-6174-0377. E-mail: xiaymj@mail.csu.edu.cn

收稿日期: 2019-11-18  

Received: 2019-11-18  

作者简介 About authors

何源福(1995—),男,硕士生,从事钢拱架安装机器人研究.orcid.org/0000-0003-0526-3937.E-mail:173712148@csu.edu.cn , E-mail:173712148@csu.edu.cn

摘要

为了提高钢拱架拼接效率,降低人工作业对施工的影响,提出隧道掘进机(TBM)钢拱架拼接机械手的抓取对接机构. 利用图谱法对抓取对接机构进行构型设计,根据机构功能实现方式,将机构分解成2个支链,确定其自由度(DOF)空间和约束空间;根据线图的功能等效性,得到各支链自由度空间的若干同维子空间,配置合理的支链运动副,通过叠加组合,得到机构整体构型;建立机构的运动学模型,推导出机构各滑块位置与转动角的逆解;给出机构性能指标,利用螺旋理论,分析机构抓取模块的传递性能,结果表明,抓取对接机构的全局传递指标达到至少0.75,具有较好的传递性能,且其工作空间最大取值应小于π/2. 制作抓取对接机构的样机,对钢拱架拼接过程进行实验,验证机构的可行性.

关键词: TBM钢拱架拼接 ; 抓取对接机构 ; 图谱法 ; 构型设计 ; 性能指标

Abstract

A grasping docking mechanism for tunnel boring machine (TBM) steel arch splicing manipulators was proposed to improve the splicing efficiency of steel arch and reduce the impact of manual work on construction. Firstly, the configuration of the grasping docking mechanism was constructed by the graphic method. The mechanism was decomposed into two branch chains according to the mechanism function realization method, and the degree of freedom (DOF) space and the constraint space were obtained. Some homogenous subspaces of the DOF space of each branch chain were obtained according to the functional equivalence of the line graph. The overall configuration of the mechanism was obtained by superposing and combining the motion pairs of branch chains which were reasonable for each homogenous subspace. Then, the kinematics model of the mechanism was established, and the inverse solutions of the position and rotation angle of each slider were obtained. The performance index of the mechanism was proposed. The transmission performance of the grasp module was analyzed by using the screw theory, and results show that the global transfer index of the grasping docking mechanism reached at least 0.75, which has good transfer performance, and the maximum value of its working space should be less than π/2. Finally, the prototype of the grasping docking mechanism was made, and experiments were conducted on the grasping process of the steel arch to verify the feasibility of the mechanism.

Keywords: TBM steel arch splicing ; grasping docking mechanism ; graphic method ; configuration design ; performance indicator

PDF (1876KB) 元数据 多维度评价 相关文章 导出 EndNote| Ris| Bibtex  收藏本文

本文引用格式

何源福, 夏毅敏, 龙斌, 邓朝辉, 雷茂林, 姚捷. TBM钢拱架拼接机械手抓取对接机构. 浙江大学学报(工学版)[J], 2020, 54(11): 2204-2213 doi:10.3785/j.issn.1008-973X.2020.11.016

HE Yuan-fu, XIA Yi-min, LONG Bin, DENG Zhao-hui, LEI Mao-lin, YAO Jie. Grasping docking mechanism of TBM steel arch splicing robot. Journal of Zhejiang University(Engineering Science)[J], 2020, 54(11): 2204-2213 doi:10.3785/j.issn.1008-973X.2020.11.016

隧道掘进机(tunnel boring machine,TBM)隧道施工近年来在我国发展迅猛,但是机械化程度仍然落后于发达国家[1-3]. 钢拱架安装支护作为隧道施工的关键一环,严重影响施工进程. 目前,TBM钢拱架拼接普遍采用人工操作的方式进行,须人工进行钢拱架位姿调整与螺栓连接工作,工作环境恶劣,操作空间狭小,且拱架沉重,对接困难,使得钢拱架拼接效率较低,易导致支护不及时或质量不稳定最终造成塌方事故[4]. 为了降低人工作业对施工效率的不利影响,须设计钢拱架拼接机械手抓取对接机构,实现自动快速拼接钢拱架.

目前,国内外学者针对各种类型机械手的设计方法、结构设计、运动学分析、性能指标等方面进行了许多分析. 在设计方法方面,Huang[5]提出多种空间型3自由度等向性机械手的设计方法,并以3自由度机器手作为模块开发六自由度冗余机器手. Babin等[6]采用行星轮系代替传统的转动关节,提出适用于受限空间内抓取细小物体的机械手设计方法;于红英等[7-8]提出变胞并联机构设计方法,通过分解作业任务,得到基于子任务的基本支链构型,组合变型实现变胞并联机构的综合. 在结构设计方面,Yang等[9]利用螺旋理论,得到由平行运动元件组成的运动链,通过对这些运动链的综合,设计用于自动对接的2自由度平移机构. Erol等[10-11]从机构的操作和抓取需求出发,分析平面机械手和空间机械手的自由度与结构形式,并对所设计机械手的抓取性能进行分析. Gao等[12-14]设计能够实现自适应包络抓取功能的机械手,对不同形状的物体具有较好的适应性. 在运动学分析方面,Lu等[15-16]推导机械手指尖接触力的计算公式,并提出最优自适应控制方案,通过力分解来调节最优接触力. 在性能指标方面,Hwang等[17-19]提出机械手的工作空间指数、运动或力传递指数、灵活度指数等性能指标,对机械手的结构尺寸参数进行优化设计. 但是,钢拱架拼接机械手须具备结构简单,占用空间小,坚固可靠,对接精度高等特点,使其能够在空间受限、重载的条件下完成钢拱架抓取、调整、对接等动作,以上研究都无法直接应用于钢拱架安装.

为了设计出能够代替人工实现钢拱架安装需求的机构,从钢拱架安装形式与机构运动自由度要求出发,对钢拱架的抓取对接机构进行构型设计和性能分析. 基于图谱法,对抓取对接机构进行构型设计;根据功能等效性,获得各支链满足功能要求的若干运动副,通过叠加组合获得机构整体构型;建立抓取对接机构的运动学模型,求得机构初始位置的逆解;提出机构性能指标,利用螺旋理论,分析机构抓取模块的传递性能,优化结构尺寸参数.

1. 图谱法构型设计的基本理论

1.1. 线几何理论

抓取对接机构的自由度和约束是构型设计的基础,基于Grassmann线几何,通过引入线簇的方法对其进行描述,机构作基本运动(转动或移动)时的自由度和约束的表征如表1所示. 表中,实线表示自由度,虚线表示约束.

表 1   线图的表示形式及意义

Tab.1  Representation and significance of line graph

转动自由度线 移动自由度线 约束线 力偶约束线

新窗口打开| 下载CSV


将这些元素进行组合,可以扩展成一个线图,用于表示抓取对接机构的线空间,包括自由度空间或约束空间. 如图1所示为一些基本型线空间的线图表达形式和映射关系.

图 1

图 1   部分基本型线空间的映射

Fig.1   Partial basic line space mapping


基于线图分析法,可以实现抓取对接机构的构型设计,即图谱法构型设计. 图谱法的构型设计流程如图2所示. 从TBM钢拱架的运动轨迹要求出发,确定抓取对接机构的运动方式和自由度要求;依据抓取对接机构的预期功能实现形式,将其分解成若干支链;根据线几何理论,确定各支链自由度空间;由线图的功能等效性原则,得到若干同维子空间,并为各子空间配置合理的运动副;将得到所有支链结构进行叠加组合,根据抓取对接机构的实际应用需求,选择最合理的机构构型.

图 2

图 2   图谱法构型设计流程图

Fig.2   Flow chart of design of graphic method


1.2. 螺旋理论

利用螺旋理论研究抓取对接机构的传递性能,单位运动旋量可以通过Plücker坐标表示为

$ {{\textit{\$}}} {\rm{ = }}\left( {{{\omega}} ;{{\nu}} } \right) = \left( {{{\omega}} ;{{r}} \times {{\omega}} + h{{\omega}} } \right). $

式中: ${{\omega}} $为表示旋量的单位转轴矢量;r为坐标系原点到运动旋量轴线上任意一点的矢量;h为旋量的节距, $h{\rm{ = }}{{\omega}} {{\nu}} $. $h{\rm{ = }}0$表示抓取对接机构中的转动关节; $h{\rm{ = }}\infty $表示抓取对接机构中的移动关节.

单位旋量$1$2之间的互易积为

$ {\textit{\$}} _1 \circ {\textit{\$}} _2{\rm{ = }}\left( {{{{s}}_1};{{s}}_1^0} \right) \circ \left( {{{{s}}_2};{{s}}_2^0} \right) = {{{s}}_1} {{s}}_2^0 + {{{s}}_2} {{s}}_1^0. $

$1$2的互易积为零,则$1$2的反旋量,反之亦然.

2. 抓取对接机构的构型设计

2.1. 抓取对接机构的功能需求

传统TBM钢拱架的拼接以人工为主,机械为辅,劳动强度较大,工作效率较低,如图3所示. 在整个钢拱架的拼接过程中,须人工完成钢拱架位姿调整、螺栓预连接以及钢拱架撑紧后的螺栓紧固工作,严重影响施工效率.

图 3

图 3   人工拼接钢拱架作业

Fig.3   Manual splicing of steel arch


为了实现钢拱架快速拼接,须设计钢拱架拼接机械手抓取对接机构,以替代人工作业. 该机构须具备以下功能要求. 1)几何尺寸要求. 由于拼装环、主梁框架的空间位置约束,要求在设计拱架对接机构的几何尺寸时,考虑在有限的空间内实现拱架对接的所有动作. 2)运动特性要求. 机构须能够灵活地对钢拱架进行抓取、调整与对接,且在工作过程中不与钢拱架发生干涉碰撞. 3)结构强度要求. 拱架对接机构采用Q235钢材料,在工作过程中,须保证钢拱架对接精度小于10 mm,要求所设计结构的强度和刚度满足设计要求.

通过抓取对接机构进行TBM钢拱架拼接作业的方法如图4所示. 抓取对接机构利用上、下2个反向布置的“L”型卡爪,如图4(a)所示,分别自动抓取拼装环上的相邻2榀钢拱架;将抓取的2榀钢拱架进行位姿调整,并强制对接,如图4(b)所示,确保2榀钢拱架连接孔位置的对准,方便对钢拱架进行插销预连接;钢拱架拼接完成后的撑紧工序,可以使连接处的自动拼接接头卡死,实现钢拱架自动连接.

图 4

图 4   钢拱架拼接示意图

Fig.4   Schematic diagram of steel arch installation


为了适应钢拱架自动拼接的要求,在现有钢拱架的基础上,增加插销连接与单向自锁机构,设计免螺栓工序的新型钢拱架结构,如图5所示. 图中,R为钢拱架半径,h为横截面工字钢的腰高,b为腿宽,φ为钢拱架周向角度.

图 5

图 5   新型钢拱架结构

Fig.5   New steel arch structure


2.2. 抓取对接机构的构型设计

要完成钢拱架抓取对接作业,须上、下2个卡爪分别在工作空间内完成相应运动,故将机构分为2个支链进行研究.

1)下卡爪支链设计. 在进行抓取对接作业时,下卡爪须在钢拱架所在竖直平面内进行位置调整,以到达钢拱架抓取点位置;在完成钢拱架抓取之后,在该平面上进行相应位置移动,实现钢拱架对接;下卡爪支链须具有转动能力,以调整抓取姿态. 根据线图分析法,得到下卡爪支链的自由度空间与约束空间,如图6所示. 根据空间线图的功能等效性[20],可以得到其自由度空间的同维子空间,并配置相应运动副,如表2所示. 表中,R表示转动关节(revolute joint),P表示移动关节(prismatic joint). 下卡爪作为机构的输出末端,须由移动关节带动,以方便对钢拱架进行夹持动作,因此RPP、PRP、RRP结构可以作为下卡爪机构的构型选择参考.

表 2   线图的同维子空间及运动副

Tab.2  Same-dimensional subspace and kinematic pair of line graph

同维子空间 运动简图

新窗口打开| 下载CSV


图 6

图 6   下卡爪支链的自由度空间

Fig.6   DOF space of lower jaw chain


2)上卡爪支链设计. 上卡爪的运动与下卡爪相似,但是须增加一个自由度,用于实现上、下卡爪的分离,以免在靠近钢拱架时,与钢拱架发生碰撞. 上卡爪支链的2种自由度空间与约束空间如图7所示. 根据空间线图的功能等效性,获得线图1(见图7(a))与线图2(见图7(b))的自由度空间同维子空间,并配置相应运动副,如表34所示. 上卡爪须由移动关节带动,故只罗列了部分合理的运动链结构.

表 3   线图1的同维子空间及运动副

Tab.3  Same-dimensional subspace and kinematic pair of line graph one

同维子空间 运动简图

新窗口打开| 下载CSV


表 4   线图2的同维子空间及运动副

Tab.4  Same-dimensional subspace and kinematic pair of line graph two

同维子空间 运动简图

新窗口打开| 下载CSV


图 7

图 7   上卡爪支链的自由度

Fig.7   DOF space of upper jaw chain


上卡爪与下卡爪配合完成钢拱架抓取动作,需要上卡爪与下卡爪始终位于同一空间平面内,且保持相同的转动姿态. 因此,上卡爪支链与下卡爪支链的位姿调整部分的结构可以重叠,在简化机构的同时,保证2个卡爪位姿的一致性. 例如,在将上支链的RPRP结构进行一定的关节转动后,和下支链的RPP结构进行叠加,得到如图8所示的结构.

图 8

图 8   上、下卡爪支链结构叠加

Fig.8   Superposition of upper and lower jaws chain structure


3)抓取对接机构的构型确定. 通过分析两支链结构的可叠加性,获得能够满足机构运动要求的结构,如图9所示. 可以看出,构型(e)、(f)在完成钢拱架抓取动作之后,需要2个相互平行的转动副共同控制,才能完成钢拱架对接作业,使得机构控制更加困难,而且钢拱架不方便在TBM有限的空间内进行较多的姿态变换,容易出现干涉现象,故构型(e)、(f)不予考虑;构型(c)、(d)的钢拱架抓取部分的结构从平移滑块上伸出,在机构及钢拱架重量的作用下,会产生较大挠度,不满足钢拱架高对接精度的要求;构型(a)、(b)均可以实现钢拱架抓取对接功能,但是构型(a)须设置横向导轨,用于实现上、下卡爪的分离,考虑到TBM内部工作空间有限,选择构型(b)作为钢拱架抓取对接机构的基本构型.

图 9

图 9   抓取对接机构的可选构型

Fig.9   Optional configuration for grasping docking mechanism


抓取对接机构须同时抓取2榀钢拱架进行对接,将基本构型对称布置,得到机构的结构示意图,如图10(a)所示. 根据机构的功能,将其分为抓取模块和对中模块. 抓取模块通过滑块O0O1固定在对中模块上,“L”型下卡爪固定在滑块O2O3上,上卡爪固定在滑块O4O5上.

图 10

图 10   抓取对接机构的结构示意图

Fig.10   Schematic diagram of structure of grasping docking mechanism


4)抓取模块结构优化. 抓取模块在进行钢拱架夹持动作时,须控制构件E0G0进行转动. 当机构靠近钢拱架时,下卡爪下降,同时构件E0G0下摆,使得V型口张开. 在进行夹持作业时,下卡爪上升,同时构件E0G0上摆,V型口闭合. 可以利用滑块,将下卡爪与构件E0G0连接起来,如图11所示. 在满足机构抓取需求的同时,减少输入控制,优化机构性能.

图 11

图 11   抓取模块结构示意图

Fig.11   Schematic diagram of grasp module


3. 基于运动学模型的位置参数设计

3.1. 运动学模型建立

建立抓取对接机构的运动学模型[21],如图12所示. 以机构的转动关节B0为原点建立定坐标系B0-xyzx轴平行于构件C0C1且指向点C1z轴平行于构件B0C0向上,y轴的方向由右手螺旋定则确定. 针对抓取模块,以点E0为原点建立动坐标系E0-uvww轴平行于构件E0F0向上,u轴平行于B0O0且指向点O0v轴由右手螺旋定则确定.

图 12

图 12   抓取对接机构的运动学建模

Fig.12   Kinematic modeling of grasping docking mechanism


在对中模块中,O0B0长度为l2B0C0长度为l3C0C1长度为2l4B0C0垂直于C0C1,构件B0C0B0O0之间的夹角为θ1,如图10(c)所示;在抓取模块中,构件E0O2长度为l5E0O0长度为l6E0O4长度为l7O2R0长度为l8R0I0长度为l9I0J0长度为l10J0O6长度为l11L0O4长度为l12O2E0R0I0J0O6相互平行,O2R0平行于I0J0O2R0垂直于E0O2L0O4垂直于E0O4,构件E0O2E0O4之间的夹角为θ2,如图11所示.

动坐标系E0-uvw相对于定坐标系B0-xyz,沿y轴逆时针旋转了 ${\theta _1} - {{\text{π}} / 2}$,动坐标系E0-uvw相对于定坐标系B0-xyz的姿态变换矩阵表达式为

$ {{R}} = \left[ {\begin{array}{*{20}{c}} {\!\!\!\!\!\!\sin \; {\theta _1}}&0&{\cos \; {\theta _1\!\!\!\!}}\\ \!\!\!\!0&1&0\\ {\!\!\!\! - \cos \; {\theta _1}}&0&{\sin \; {\theta _1 \!\!\!}} \end{array}} \right]. $

在定坐标系B0xyz下,动坐标系原点E0的位置矢量为

$\left. {\begin{array}{*{20}{l}} {\;\;\;\;\overrightarrow {{B_0}{E_0}} = {l_2}{{u}} - {l_6}{{w}},}\\ {{{u}}{\rm{ = }}{{\left[ {\begin{array}{*{20}{c}} {\!\!\!\!\sin \; {\theta _1},}&{0,}&{ - \cos \; {\theta _1 \!\!\!\!}} \end{array}} \right]}^{\rm{T}}},}\\ {{{w}} = {{\left[ {\begin{array}{*{20}{c}} {\!\!\!\!\cos \; {\theta _1},}&{0,}&{\sin \; {\theta _1} \!\!\!\!} \end{array}} \right]}^{\rm{T}}}.} \end{array}} \right\} $

式中: ${{u}}$${{w}}$为动坐标系上的单位矢量.

可以解得

$ \overrightarrow {{B_0}{E_0}} = \left[ {\begin{array}{*{20}{c}} {\!\!\!\!{l_2}\sin \; {\theta _1} - {l_6}\cos \; {\theta _1 \!\!\!}}\\ 0\\ {\!\!\!\! - {l_2}\cos \; {\theta _1} - {l_6}\sin \; {\theta _1 \!\!\!}} \end{array}} \right]. $

在动坐标系E0-uvw中,机构的输出点间的矢量 $\overrightarrow {{I_0}{L_0}} = {\left[\!\!\! {\begin{array}{*{20}{c}}{x,}&{y,}&{\textit{z}}\end{array}}\!\!\! \right]^{\rm{T}}}$可以表示为

$ \left. \begin{aligned} \;\;\overrightarrow {{I_0}{L_0}} & = {l_{10}}{{v}} - {l_{11}}{{w}}{\rm{ + }}\overrightarrow {{O_6}{O_4}} + \overrightarrow {{O_4}{L_0}} ,\\ \overrightarrow {{O_6}{O_4}} & = \left( {{l_7} - S} \right)(\sin \;{\theta _2}{{v}} + \cos \;{\theta _2}{{w}}),\\ \;\overrightarrow {{O_4}{L_0}} & = {l_{12}}( - \cos \;{\theta _2}{{v}} + \sin \;{\theta _2}{{w}}),\\ \;\;\;\;\;\;\;\;S & = \left[ {{{\left( {{l_5} - {l_9} - {l_{11}}} \right)}^2} + {{\left( {{l_8} + {l_{10}}} \right)}^2}} \right]^{1/2}{.} \end{aligned} \right\} $

式中: ${{v}}$为动坐标系上的单位矢量;SE0O6的长度.

式(6)可以化简为

$ \begin{split} \overrightarrow {{I_0}{L_0}} =& ({l_7}\sin \;{\theta _2} - {l_{12}}{\rm{cos}}\;{\theta _2} - {l_8}){{v}} - \\ & ({l_7}{\rm{cos}}\;{\theta _2} + {l_{12}}{\rm{sin}}\;{\theta _2} - {l_5} + {l_9}){{w}} . \end{split} $

根据新型钢拱架工字钢的尺寸与空间位置,可以得到

$ \left. {\begin{array}{*{20}{c}} {{l_7}\sin \;{\theta _2} - {l_{12}}\cos \;{\theta _2} - {l_8}{\rm{ = }}b,}\\ {{l_7}\cos \;{\theta _2} + {l_{12}}\sin \;{\theta _2} - {l_5} + {l_9}{\rm{ = }}h.} \end{array}} \right\} $

根据抓取模块机构的结构,可以得到

$ {\theta _2} = {\rm{arc}}\!\tan \;\left( {\frac{{{l_8} + {l_{10}}}}{{{l_5} - {l_9} - {l_{11}}}}} \right). $

联立式(8)、(9),可以得到滑块O2位置的逆解表达式:

$ {l_5} = \frac{{{H_{\rm{P}}} + {{\left[ {{H_{\rm{P}}}^2 - {F_{\rm{P}}}\left( {{A_{\rm{P}}}^2 - {G_{\rm{P}}}^2 + {l_{12}}^2{E_{\rm{P}}}^2} \right)} \right]}^{1/2}}}}{{{F_{\rm{P}}}}}. $

式中:

由式(8)得到滑块O4位置:

$ {l_7} = \left\{ {{C_{\rm{P}}}{{\left[ {{{\left( {{l_5} - {A_{\rm{P}}}} \right)}^2} + {E_{\rm{P}}}^2} \right]}^{1/2}} + {l_{12}}\left( {{l_5} - {A_{\rm{P}}}} \right)} \right\}\bigg/{E_{\rm{P}}}. $

I0在定坐标系B0xyz下的位置矢量为

$ \overrightarrow {{B_0}{I_0}} = \overrightarrow {{B_0}{E_0}} + \left( {{l_5} - {l_9}} \right){{w}} + {l_8}{{v}}. $

将式(5)代入式(12)可以得到

$ \overrightarrow {{B_0}{I_0}} = \left[ {\begin{array}{*{20}{c}} {\left( {{l_5} - {l_9} - {l_6}} \right)\cos \;{\theta _1} + {l_2}\sin \;{\theta _1}}\\ {{l_8}}\\ {\left( {{l_5} - {l_9} - {l_6}} \right)\sin \;{\theta _1} - {l_2}\cos \;{\theta _1}} \end{array}} \right]. $

为了使卡爪的抓取效果更好,令抓取模块与钢拱架垂直布置,如图13所示.

图 13

图 13   钢拱架抓取示意图

Fig.13   Schematic diagram of steel arch grasp


$ \cos \;{\theta _1}{\rm{ = }}\left[ { - {l_4} + \left( {{l_5} - {l_9} - {l_6}} \right)\cos \;{\theta _1} + {l_2}\sin \;{\theta _1}} \right]/R. $

可以解得机构的转动角θ1:

$\left. \begin{array}{l} {\theta _1}{\rm{ = arcsin}}\;\dfrac{{{l_4}}}{{\sqrt {{l_2}^2 + {{\left( {{I_{\rm{P}}} - {l_5}} \right)}^2}} }} - \arctan \;\dfrac{{{l_5} - {I_{\rm{P}}}}}{{{l_2}}},\\ \;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;{I_{\rm{P}}}{\rm{ = }}R + {l_9} + {l_6}. \end{array} \right\}$

3.2. 性能指标与尺度优化

3.2.1. 机构的传递性能指标

以螺旋理论为数学基础,考虑机构的运动或力传递特性[22-23],对抓取模块闭环机构的性能指标进行分析,如图14所示.

图 14

图 14   抓取模块闭环机构示意图

Fig.14   Schematic diagram of closed loop mechanism of grasp module


1)局部传递指标. 为了评价机构抓取模块的运动和力传递性能,定义机构的局部传递指标为

$ \chi {\rm{ = }}\sin \;\left( {{\rm{TA}}} \right);\;{\rm{TA}} = \mu ,\gamma . $

式中: $\mu $为前向传递角, $\gamma $为反向传递角.

$\chi $越大表示运动或力的传递性越好. 为了获得较好的运动或力传递,最被广泛接受的传递角为[45°,135°][24]. 因此,令 ${\rm{sin}}\;\left( {{\rm{{\text{π}} /4}}} \right) \leqslant \chi \leqslant 1$. 抓取模块闭环机构中的 $\mu $$\gamma $和压力角 $\alpha $图14所示, $\mu {\rm{ = }}{\theta _2}$$\gamma {\rm{ = }}90^\circ $$\alpha {\rm{ = }}90^\circ - {\theta _2}$. 可以得到

$ {\theta _2}{\rm{ = arctan}}\; \left( {\frac{{{l_8} + {l_{10}}}}{{{l_5} - {l_9} - {l_{11}}}}} \right) \in \left[ {45^\circ ,135^\circ } \right], $

$ {l_5}_{\max }{\rm{ = }}{l_8} + {l_{10}} + {l_9} + {l_{11}}. $

2)全局传递指标. 局部传递指标只能判断抓取模块在单一姿态下运动或力传递的有效性. 抓取模块是在连续的工作空间内作业的,为了判断整个工作空间上的运动或力传递,定义全局传递指标:

$ \it\Gamma {\rm{ = }}{{\int_W {{{{\chi}} {{\rm{d}}W}}} } \bigg/ {\int_W {{\rm{d}}W} }}. $

式中:W为工作空间,即传递角度满足局部传递指标要求的集合或位姿, $W{\rm{ = }}\left\{ {\left. {{\theta _2} \in {{{{\bf{R}}}}}} \right|\chi \left( {{\theta _2}} \right) \geqslant {\rm{sin}}\;\left( {{\rm{{\text{π}} /4}}} \right)} \right\}$.

3)能耗系数. 由于抓取模块的机构闭环,其上所有旋量必定线性相关,存在不全为零的数 ${\omega _0}$${\omega _1}$${\omega _2}$${\omega _3}$,使得

$ {\omega _{\rm{0}}}{{\textit\$}} _{\rm{0}} + {\omega _{\rm{1}}}{{{\textit\$}} _{\rm{1}}} + {\omega _{\rm{2}}}{{{\textit\$}} _{\rm{2}}} + {\omega _3}{{{\textit\$}} _{\rm{3}}} = {\bf{0}}. $

除去驱动副和输出副之外的运动副旋量线性无关,可以构成旋量系 $\left\{ {\begin{array}{*{20}{c}} {{{\textit\$} _{\rm{1}}},}&{{{\textit\$} _{\rm{2}}}} \end{array}} \right\}$,由旋量系理论可以得到传递力螺旋 ${{{\textit\$}} _{\rm{T}}}$${{{\textit\$}} _{\rm{T}}}$与约束螺旋系线性无关,且满足 ${{{\textit\$}} _{\rm{T}}} \circ {{{\textit\$}} _{\rm{1}}}{\rm{ = }}{{{\textit\$}} _{\rm{T}}} \circ {{{\textit\$}} _{{2}}}{\rm{ = }}0$,得到

$ {\omega _0}{{{\textit{\$}}} _{\rm{0}}} \circ {{{\textit{\$}}} _{\rm{T}}} + {\omega _{\rm{3}}}{{{\textit{\$}}} _{\rm{3}}} \circ {{{\textit{\$}}} _{\rm{T}}} = {\rm{0}}. $

定义输入传递系数 $\varsigma $和输出传递系数 $\sigma $分别为

$ \left. {\begin{array}{*{20}{l}} {\varsigma {\rm{ = }}{{\left| {{{{\textit\$}} _{\rm{0}}} \circ {{{\textit\$}} _{\rm{T}}}} \right|} / {{{\left| {{{{\textit\$}} _{\rm{0}}} \circ {{{\textit\$}} _{\rm{T}}}} \right|}_{\max }}}}}, \\ {\sigma {\rm{ = }}{{\left| {{{{\textit\$}} _{\rm{3}}} \circ {{{\textit\$}} _{\rm{T}}}} \right|} / {{{\left| {{{{\textit\$}} _{\rm{3}}} \circ {{{\textit\$}} _{\rm{T}}}} \right|}_{\max }}}}} . \end{array}} \right\} $

3.2.2. 机构的工作空间参数优化

在动坐标系E0-uvw上,驱动副旋量为 ${{{\textit\$}}_{\rm{0}}}$,输出副旋量为 ${{{\textit\$}}_{\rm{3}}}$,抓取模块的运动螺旋系可以表示为

$ \left. {\begin{array}{*{20}{l}} {{{ {{{\textit\$}} _{\rm{0}}}{\rm{ = }} \left[ {\begin{array}{*{20}{c}} {\begin{array}{*{20}{c}} \!\!\!\!\!0,&0,&0, \end{array}}&0,&0,&1\!\! \! \end{array}} \right]}^{\rm{T}}},}\\ {{{\textit\$}} _{\rm{1}}}{\rm{ = }} {{{\left[ {\begin{array}{*{20}{c}} {\begin{array}{*{20}{c}} \!\!\!\!\!1,&0,&0, \end{array}}&0,&{S\cos \;{\theta _2}},&{ - S\sin \;{\theta _2\!\!\!}} \end{array}} \right]}^{\rm{T}}},}\\ {{{\textit\$}} _{\rm{2}}}{\rm{ = }} {{{\left[ {\begin{array}{*{20}{c}} {\begin{array}{*{20}{c}} \!\!\!\!\!0,&0,&0, \end{array}}&0,&{\sin \;{\theta _2}},&{\cos \;{\theta _2\!\!\!}} \end{array}} \right]}^{\rm{T}}},}\\ {{{\textit\$}} _{\rm{3}}}{\rm{ = }} {{{\left[ {\begin{array}{*{20}{c}} {\begin{array}{*{20}{c}} \!\!\!\!\!1,&0,&0, \end{array}}&0,&0,&0 \!\! \! \end{array}} \right]}^{\rm{T}}}.}\end{array}} \right\} $

式中: $S{\rm{ = }} {\left|\overrightarrow {{E_0}{O_6}} \right|}$,该螺旋系的秩为3. 抓取模块的运动螺旋系为3系,约束螺旋系为3系,由互易积原理可得

$ \left. \begin{array}{l} {{{\textit\$}}} _{{1}}^{\rm{r}}{\rm{ = }} {\left[ {\begin{array}{*{20}{c}} {\begin{array}{*{20}{c}} \!\!\!\!\!{0,} &{0,} &0 \end{array},} &{0,} &{0,} &1 \end{array}} \right]^{\rm{T}}},\\ {{{\textit\$}}} _{{2}}^{\rm{r}}{\rm{ = }} {\left[ {\begin{array}{*{20}{c}} {\begin{array}{*{20}{c}} \!\!\!\!\!{0,} &{0,} &0 \end{array},} &{0,} &{1,} &0 \end{array}} \right]^{\rm{T}}},\\ {{{\textit\$}}} _{{3}}^{\rm{r}}{\rm{ = }} {\left[ {\begin{array}{*{20}{c}} {\begin{array}{*{20}{c}} \!\!\!\!\!{ 1,}&{0,}&0 \end{array},}&{0,}&{0,}&0 \end{array}} \right]^{\rm{T}}}. \end{array} \right\} $

可以得到,该模块的约束螺旋系包含1个约束力和2个轴线相互垂直的约束力偶,即该模块约束u轴上的移动自由度和vw轴上的转动自由度.

可以求解得到抓取模块闭环机构的 ${{{\textit\$}} _{\rm{T}}}$

$ {{{\textit\$}} _{\rm{T}}}{\rm{ = }} {\left[\!\!\! {\begin{array}{*{20}{c}} {0,} &{\cos \;{\theta _2},} &{ - \sin \;{\theta _2},} &{ - S,} &{0,} &0\!\!\! \end{array}} \right]^{\rm{T}}}. $

$\varsigma $$\sigma $分别为

$ \left. {\begin{aligned}& {\varsigma {\rm{ = }}\left| {\sin \;{\theta _2}} \right|/{{\left| {\sin \;{\theta _2}} \right|}_{\max }},}\\ & \qquad\;\;{\sigma {\rm{ = }}S/{S_{\max }}.} \end{aligned}} \right\} $

由式(17)、(18)可以得到

$ {\left| {\sin \;{\theta _2}} \right|_{\max }}{\rm{ = }}1, $

$ {S_{\max }} = \sqrt 2 \left( {{l_8} + {l_{10}}} \right). $

从而得到机构的传递系数:

$ \left. {\begin{array}{*{20}{l}} {\varsigma {\rm{ = }}\sin \;{\theta _2},}\\ {\sigma {\rm{ = }}\left( {\sqrt 2 \sin \;{\theta _2}} \right)^{ - 1}{.}} \end{array}} \right\} $

机构的局部传递指标可以定义为

$ \chi {\rm{ = min}}\;\left\{ {\varsigma ,\sigma } \right\}. $

计算得到,当45°≤θ2≤57°时, $\chi {\rm{ = }}\varsigma $;当57°<θ2≤135°时, $\chi {\rm{ = }}\sigma $. 工作空间W可以表示为45°≤θ2θ2max. 可以得到机构的全局传递指标为

$ {{\varGamma}} {\rm{ = }}\frac{{\int_W {\chi {\rm{d}}{\theta _2}} }}{{\int_W {{\rm{d}}W} }}{\rm{ = }}\frac{{\int_{\text{π} /4}^{19{\text{π}} /60} {\varsigma {\rm{d}}{\theta _2}} }}{{\int_W {{\rm{d}}W} }} + \frac{{\int_{19{\text{π}} /60}^{{\theta _{{\rm{2max}}}}} {\sigma {\rm{d}}{\theta _2}} }}{{\int_W {{\rm{d}}W} }}. $

可以得到

$ {{\varGamma }}{\rm{ = }}\left\{ {\begin{split} &{\frac{{0.71 - \cos \;{\theta _{{\rm{2max}}}}}}{{{\theta _{{\rm{2max}}}} - {{\text{π}} / 4}}},}\quad {\frac{{\text{π}} }{4} < {\theta _{{\rm{2max}}}} \leqslant \frac{{19{\text{π}} }}{{60}}};\\ & {\frac{{0.71\times \ln \; \left| {\tan \;0.5{\theta _{{\rm{2max}}}}} \right| + 0.6}}{{{\theta _{{\rm{2max}}}} - {{\text{π}} / 4}}},} \quad {\frac{{19{\text{π}} }}{{60}} < {\theta _{{\rm{2max}}}} \leqslant \frac{{3{\text{π}} }}{4}}. \end{split}}\right. $

可以得到抓取对接机构的全局传递指标和工作空间最大值θ2max之间的关系,利用Matlab软件生成其关系图,如图15所示. 可以看出,这种抓取对接机构的全局传递指标至少为0.75,具有较好的传递性能;机构的全局传递指标在θ2max位于π/4和11π/32附近时取得较大值,当 ${\rm{{\text{π}} /4 < }}{\theta _{2\max }} \leqslant {{\text{π}} / 2}$时,抓取对接机构的全局传递指标呈先下降后上升,然后再持续下降的趋势,但是总体全局传递指标仍然大于0.765;当 ${\theta _{2\max }} > {{\text{π}} / 2}$时,全局传递指标明显下降,达到较低值. 因此,抓取对接机构的工作空间最大取值θ2max应小于π/2.

图 15

图 15   工作空间与全局传递指标的关系

Fig.15   Relationship between workspace and global transfer index


4. 抓取对接机构的样机实验

为了验证抓取对接机构的运动特性满足要求,能够较好地完成钢拱架的抓取对接动作,制作如图16所示的样机,对其进行钢拱架抓取、对接TBM钢拱架的位姿测试. 机构的各油缸运动情况如表5所示,左右对称油缸的控制是相同的.

表 5   机构各油缸的速度控制

Tab.5  Speed control of each cylinder of mechanism

时间/s 控制速度/(mm·s−1
1号油缸 2号油缸 3号油缸 4号油缸
0~10 0 0 12.50 12.00
10~20 13.00 0 0 0
20~40 0 0 6.25 5.00
40~60 0 6.25 0 0

新窗口打开| 下载CSV


图 16

图 16   抓取对接机构样机

Fig.16   Grasping docking mechanism prototype


抓取对接机构的工作过程分为4个部分:3号油缸收缩,4号油缸伸长,机构的抓取模块张开;1号油缸伸长,将抓取模块上举;当钢拱架进入抓取模块后,3号油缸伸长,4号油缸收缩,将钢拱架抓紧;2号油缸伸长,将钢拱架往中间拉扯,实现钢拱架的对接.

实验结果表明,整个钢拱架拼接所用时间为60 s,其中钢拱架抓取与对接所用时间占总时间的2/3,拼接效率较高;在钢拱架抓取过程中,未发生机构与钢拱架碰撞、钢拱架滑移情况,抓取效果较好;在对接过程中,钢拱架销钉孔对准效果较好,孔中心轴线位置距离小于5 mm,满足钢拱架对接精度要求,证明了机构的可行性.

将实验数据结合Adams软件,可以得到抓取对接机构2个输出末端在工作过程的速度,如图17所示. 图中,v为速度. 可以看出,在抓取模块张开和夹紧的过程中,上卡爪的速度大于下卡爪,在其余时间内2个卡爪速度相同;在整个工作过程中,2个输出末端的速度均小于50 mm/s,机构始终处于低速平稳的工作状态,稳定性较高,证明了机构的可靠性.

图 17

图 17   上、下卡爪速度曲线

Fig.17   Speed curve of upper and lower jaws


5. 结 论

(1)基于图谱法进行抓取对接机构的构型设计,将机构分为上卡爪支链和下卡爪支链,分别得到其自由度空间和约束空间;根据功能等效性,获得各支链自由度空间的同维子空间,为其配置合理的运动副;通过对两支链结构进行叠加组合,获得机构整体构型.

(2)建立抓取对接机构的运动学模型,得到机构各滑块位置与机构转动角的逆解;建立机构的性能指标,利用螺旋理论,分析机构抓取模块的传递性能,得到较优的工作空间范围.

(3)制作抓取对接机构的样机,对其进行钢拱架抓取、对接的位姿测试,并结合Adams进行卡爪速度仿真,验证了机构的可行性.

本研究对于抓取对接机构最优构型的评估方法,采用的是基于工作空间、运动精度和操作控制难度的定性判断形式,未能给出具体的评估指标. 下一步将对机构的抓取模块作进一步的优化设计,减轻设备的重量,提高设备的可靠性. 此外,须对机构的控制方面进行研究与分析,进一步提高钢拱架的拼接效率与拼接精度.

参考文献

霍军周, 吴瀚洋, 朱冬, 等

TBM机电耦合建模与同步控制策略对比分析

[J]. 机械工程学报, 2018, 54 (1): 120- 126

DOI:10.3901/JME.2018.01.120      [本文引用: 1]

HUO Jun-zhou, WU Han-yang, ZHU Dong, et al

TBM electromechanical coupling modeling and comparative analysis of synchronous drive control strategy

[J]. Journal of Mechanical Engineering, 2018, 54 (1): 120- 126

DOI:10.3901/JME.2018.01.120      [本文引用: 1]

夏毅敏, 钱聪, 李正光, 等

隧道掘进机支撑推进系统振动特性

[J]. 浙江大学学报: 工学版, 2018, 52 (2): 233- 239

XIA Yi-min, QIAN Cong, LI Zheng-guang, et al

Vibration characteristics of TBM supporting-thrusting system

[J]. Journal of Zhejiang University: Engineering Science, 2018, 52 (2): 233- 239

陈玉羲, 龚国芳, 石卓, 等

基于施工数据的TBM支撑推进协调控制系统

[J]. 浙江大学学报: 工学版, 2019, 53 (2): 250- 257

[本文引用: 1]

CHEN Yu-xi, GONG Guo-fang, SHI Zhuo, et al

Coordinated control of gripper and thrust system for TBM based on construction data

[J]. Journal of Zhejiang University: Engineering Science, 2019, 53 (2): 250- 257

[本文引用: 1]

MITELMAN A, ELMO D

Analysis of tunnel-support interaction using an equivalent boundary beam

[J]. Tunnelling and Underground Space Technology, 2019, 84: 218- 226

DOI:10.1016/j.tust.2018.11.021      [本文引用: 1]

HUANG C K

A general method for developing different types of 3-DOF and 6-DOF isotropic manipulators

[J]. Journal of the Chinese Society of Mechanical Engineers, 2019, 40 (2): 99- 108

[本文引用: 1]

BABIN V, GOSSELIN C

Picking, grasping, or scooping small objects lying on flat surfaces: a design approach

[J]. International Journal of Robotics Research, 2018, 37 (12): 1484- 1499

DOI:10.1177/0278364918802346      [本文引用: 1]

于红英, 曾重元, 郭震

少自由度变胞并联机构综合设计方法

[J]. 哈尔滨工业大学学报, 2018, 50 (1): 42- 49

[本文引用: 1]

YU Hong-ying, ZENG Zhong-yuan, GUO Zhen

Type synthesis method of lower-mobility metamorphic parallel mechanism

[J]. Journal of Harbin Institute of Technology, 2018, 50 (1): 42- 49

[本文引用: 1]

李树军, 王洪光, 李小彭, 等

面向作业任务的约束变胞机构设计方法

[J]. 机械工程学报, 2018, 54 (3): 26- 35

DOI:10.3901/JME.2018.03.026      [本文引用: 1]

LI Shu-jun, WANG Hong-guang, LI Xiao-peng, et al

Task-orientated design method of practical constraint metamorphic mechanisms

[J]. Journal of Mechanical Engineering, 2018, 54 (3): 26- 35

DOI:10.3901/JME.2018.03.026      [本文引用: 1]

YANG Y, PENG Y, PU H Y, et al

Design of 2-degrees-of-freedom (DOF) planar translational mechanisms with parallel linear motion elements for an automatic docking device

[J]. Mechanism and Machine Theory, 2018, 121: 398- 424

DOI:10.1016/j.mechmachtheory.2017.11.005      [本文引用: 1]

EROL O, GOGU G, MEZOUAR Y

A study on dexterous grasps via parallel manipulation analogy

[J]. Journal of Intelligent and Robotic Systems, 2017, 87 (1): 3- 14

[本文引用: 1]

LAMBERT P, HERDER J L

A 7-DOF redundantly actuated parallel haptic device combining 6-DOF manipulation and 1-DOF grasping

[J]. Mechanism and Machine Theory, 2019, 134: 349- 364

DOI:10.1016/j.mechmachtheory.2019.01.002      [本文引用: 1]

GAO C Q, HUANG H L, LI B, et al

Design of a truss-shaped deployable grasping mechanism using mobility bifurcation

[J]. Mechanism and Machine Theory, 2019, 139: 346- 358

DOI:10.1016/j.mechmachtheory.2019.05.003      [本文引用: 1]

LIANG D Y, ZHANG W Z

PASA-GB hand: a novel parallel and self-adaptive robot hand with gear-belt mechanisms

[J]. Journal of Intelligent and Robotic Systems, 2018, 90: 3- 17

DOI:10.1007/s10846-017-0644-0     

BORISOV I I, BORISOV O I, GROMOV V S, et al

The UHVAT gripper: usable holding versatile adjustable tool to grasp different objects

[J]. IFAC-PapersOnLine, 2018, 51 (11): 722- 727

DOI:10.1016/j.ifacol.2018.08.404      [本文引用: 1]

LU Y, ZHANG C G, CAO C J, et al

Analysis of coordinated grasping kinematics and optimization of grasping force of a parallel hybrid hand

[J]. International Journal of Advanced Robotic Systems, 2017, 14 (3): 1- 14

[本文引用: 1]

MAHYAR A, HAMED R, TALEBI H A, et al

Optimal adaptive Jacobian internal forces controller for multiple whole-limb manipulators in the presence of kinematic uncertainties

[J]. Mechatronics, 2018, 53: 1- 7

DOI:10.1016/j.mechatronics.2018.05.005      [本文引用: 1]

HWANG S, KIM H, CHOI Y, et al

Design optimization method for 7 DOF robot manipulator using performance indices

[J]. International Journal of Precision Engineering and Manufacturing, 2017, 18 (3): 293- 299

DOI:10.1007/s12541-017-0037-0      [本文引用: 1]

SHAO Z F, MO J, TANG X Q, et al

Transmission index research of parallel manipulators based on matrix orthogonal degree

[J]. Chinese Journal of Mechanical Engineering, 2017, 30 (6): 122- 131

ASSAL S F M

A novel planar parallel manipulator with high orientation capability for a hybrid machine tool: kinematics, dimensional synthesis and performance evaluation

[J]. Robotica, 2017, 35 (5): 1031- 1053

DOI:10.1017/S0263574715000958      [本文引用: 1]

XIE F, LI T, LIU X

Type synthesis of 4-DOF parallel kinematic mechanisms based on grassmann line geometry and atlas method

[J]. Chinese Journal of Mechanical Engineering, 2013, 26 (6): 1073- 1081

DOI:10.3901/CJME.2013.06.1073      [本文引用: 1]

秦超, 梁喜凤, 路杰, 等

七自由度番茄收获机械手的轨迹规划与仿真

[J]. 浙江大学学报: 工学版, 2018, 52 (7): 1260- 1266

[本文引用: 1]

QIN Chao, LIANG Xi-feng, LU Jie, et al

Trajectory planning and simulation for 7-DOF tomato harvesting manipulator

[J]. Journal of Zhejiang University: Engineering Science, 2018, 52 (7): 1260- 1266

[本文引用: 1]

XIE F, LIU X J, WANG C

Design of a novel 3-DOF parallel kinematic mechanism: type synthesis and kinematic optimization

[J]. Robotica, 2015, 33 (3): 622- 637

DOI:10.1017/S0263574714000551      [本文引用: 1]

李研彪, 郑航, 徐梦茹, 等

5-PSS/UPU并联机构的多目标性能参数优化

[J]. 浙江大学学报: 工学版, 2019, 53 (4): 654- 663

[本文引用: 1]

LI Yan-biao, ZHENG Hang, XU Meng-ru, et al

Multi-target parameters of performance optimization for 5-PSS/UPU parallel mechanism

[J]. Journal of Zhejiang University: Engineering Science, 2019, 53 (4): 654- 663

[本文引用: 1]

WANG J S, LIU X J, WU C

Optimal design of a new spatial 3-DOF parallel robot with respect to a frame-free index

[J]. Science in China Series E, 2009, 52 (4): 986- 999

DOI:10.1007/s11431-008-0305-4      [本文引用: 1]

/