方立霞,王 彤,李一鸣,吴 淼
(1.中国矿业大学(北京) 机电与信息工程学院,北京 100083; 2.中国矿业大学银川学院 信息工程学院,宁夏 银川 750011; 3.北京信息科技大学 机电工程学院,北京 100101)
据国家能源局2018年统计,我国主体能源的原煤产量高达35.5 亿t[1],且90%为井工开采,故需要大量掘进巷道。尽管综合机械化掘进量(综掘)逐年大幅提高,但始终无法跟上综采的速度,造成“掘采失调”矛盾日益加剧[2]。同时,综掘工作面环境(高温、高湿、高尘等环境因素与冒顶、片帮等安全因素的交互作用)恶劣、作业过程中复杂多变的煤岩情况[3]等因素严重制约了无人化、智能化精准综掘的进展。因此,研究并精确掌控掘进作业中机身位姿响应规律,对巷道成形质量与掘进效率的提高,乃至实现智能化自动采掘最终达到“无人化”综掘,具有实质性的价值和意义。
目前,掘进机位姿方面国内外已有相关研究:SHAFFER GK等[4]建立了掘进机工作机构参数与巷道断面尺寸之间的数学模型;李军利等[5]将掘进机简化为履带式机器人,将视其为一系列连杆通过运动副关节串联而成的开式运动链,建立了关节空间和驱动空间的运动学方程,求出末端截割臂的位姿矩阵;田劼等[6]提出悬臂式掘进机的空间位姿运动学模型,采用DH算法,利用雅克比矩阵建立了悬臂式掘进机机身及截割头空间位姿坐标变化矩阵,从而得到了截割头空间运行轨迹;田原等[7]利用机器视觉技术检测摄像机与激光指向仪之间的相对空间位姿,通过空间矩阵变换计算出掘进机机身相对指向激光的空间位姿参数。以上研究提供了掘进机空间位姿的运动学推导思路,但局限于对掘进机位姿偏差研究提供理论分析思路,缺少对掘进机在实际复杂变载工况下产生位姿偏差的实时动态分析,且分析方法为多解析法,采用数学方法推导,存在消元过程复杂、计算量大的弊端。基于此,宗凯等[8]建立了悬臂式掘进机横向截割机身位姿动力学耦合模型,仅以对巷道成形质量产生较大影响的机身卧底量及机身俯仰角为重点目标研究其对机身位姿的影响,为悬臂式掘进机智能化自主纠偏提供了导向依据;张敏骏等[9]对悬臂式掘进机支撑机构进行了力学分析,建立了仰俯位姿偏差与执行机构运动数学模型,提出基于模糊神经网络PID控制的俯仰位姿智能控制算法,但缺少考虑动载荷对空间位姿偏差的影响分析。
综上可知,目前考虑实际变载工况下悬臂式掘进机全方位空间位姿偏差的综合分析及相关工作研究较少,故笔者基于EBZ160型悬臂式掘进机机械结构的拓扑结构分析,建立了悬臂式掘进机空间并联行走/支撑机构可补偿仰俯角、横滚角、巷顶距偏差的数学模型,截割串联机构可补偿水平偏向角、水平偏距及车前距偏差数学模型;利用空间机构正/逆解思想,正解求解已知各机构回路几何结构参数时机身的空间位姿偏差;逆解推导对应空间极限位姿偏差时各驱动回路的几何结构参数,以验证该模型的准确性。结合本项目组陶云飞等[10]掘进机位姿激光自动测量法提供的掘进机实时空间位姿信息,可实现为悬臂式掘进机的智能化实时位姿纠偏提供准确依据。
根据机构拓扑结构分析EBZ160悬臂式掘进机空间拓扑结构简图如图1所示,其机械结构采用空间混联结构形式:下部分为由机身/行走机构-前铲板四连杆液压回路-后支撑四连杆液压回路共同组成的掘进机行走/支撑空间并联机构,该结构形式不仅可增强掘进机机身整体的刚度,还可保证在较大的冲击截割载荷下整机的平稳性及保障空间位姿纠偏的有效实施;上部分结构为由截割臂水平回转回路-截割臂升降回路共同组成的截割串联机构,该结构形式可保障执行部件具有较大工作空间的优势[11]。
实际作业过程中,复杂多变的截割工况导致悬臂式掘进机机身偏离预设掘进规划路径,从而产生空间位置和姿态偏差,即空间位姿全偏差W(W=[α,β,γ,A,L,H]T),各空间位姿偏差描述及影响见表1[12]。位姿偏差的存在对巷道的成型及质量产生极大的影响,大大制约了智能化精准掘进的进展与实施,故本文将从空间机构拓扑学角度对其空间位姿偏差展开详细分析研究。
图1 悬臂式掘进机结构分析示意Fig.1 Structural analysis sketch of cantilever roadheader
表1 悬臂式掘进机空间机身位姿偏差描述及影响Table 1 Description and effect of spatial posture deviation for cantilever roadheader
基于悬臂式掘进机空间拓扑结构,本节将对其下部分(行走/支撑并联机构)和上部分(水平回转回路和截割臂升降回路机构)各自产生的空间位姿偏差进行数学模型的构建。
依据以上对EBZ160悬臂式掘进机空间结构采用空间分析,在掘进工作面(掘进高度方向YOZ平面、掘进滚动方向XOZ平面)搭建其行走/支撑机构空间并联机构模型[13-14]如图2所示。该机构主要由前铲板/后支撑与机身上旋转铰接点Ri3构成的动平台{R13-R23-R33-R43}(机身平面)、前铲板(后支撑)与巷道底部静接触点Fi构成的静平台{F1,F2,F3,F4}和4条SOCi(Single Open Chain)({-Ri1⊥Pi2‖Ri1-Fi-},i=1,2,3,4)单开链共同构成,其中,Pi2为前铲板/后支撑液压油缸平移铰链;Ri1为前铲板(后支撑)液压油缸下铰接点[15]。对应单开链及动、静平台共同组成空间POCi(Per Open Circuit)并联回路(i=1,2,3,4):
POC1回路:{-F3-R31⊥P32‖R33-R23⊥P22‖
R31-F2-};
POC2回路:{-F2-R21⊥P22‖R23-R13⊥P12‖
R11-F1-};
POC3回路:{-F1-R11⊥P12‖R13-R43⊥P42‖
R41-F4-};
POC4回路:{-F4-R41⊥P42‖R43-R33⊥P32‖
R31-F3-}。
图2中,l1,l2,l3,l4分别为前铲板/后支撑所在单支链SOCi的边长,mm;δ为后支撑支链与巷道底部夹角,(°)。
构建掘进机仰俯角偏差+β时的空间位姿结构模型如图3所示(为方便计算推导将SOC1和SOC2单支链分别沿X轴对称平移)。以静平台中心为坐标系原点建立静坐标系O-XOY,坐标系Y轴方向与实际掘进方向保持一致;以动平台中心为坐标系原点建立动坐标系p(o)-xoy。
图3 仰俯误差时行走/支撑空间并联机构模型Fig.3 Spatial parallel structural model of walking/supporting mechanism with pitching error
图3中,L1为机身长度(R′13R43=R′23R33=L1);L′1为前铲板/后支撑与巷道接触点间的长度(R′23F3=R′13F4=L′1);B为机身实际宽度(R′13R23=R33R43=F′1F′2=F3F4=B)。
POC1回路中,动坐标系中的动铰接点R′23,R33及静坐标系中的固定点F′2和F3相对静坐标系的坐标[15]分别为
(1)
式中,Δlsu为后支撑液压油缸长度调节变化量。
2.1.1机身仰俯偏差β数学模型的建立
组成POC1回路的两条单开支链SOC2和SOC3满足约束方程:
Zp=(l2+Δlsu)sinδ+(L1sinβ)/2
式中,xp,yp,zp分别为动坐标系原点相对于静坐标系原点的X,Y,Z方向的坐标。
则:
R33F3=
(2)
式中,Δlsh为前铲板液压油缸调节变化量。
将式(2)代入约束方程式得
[(l2+Δlsu)cosδ+L1cosβ-L′1]2+
[L1sinβ+(l2-Δlsu)sinδ]2=(l3+Δlsh)2
(3)
为简化表达,设a=(l2-Δlsu)cosδ-L′1,最终得机身动平台相对巷道底部静坐标系的仰俯角偏差β数学模型:
(4)
利用MATLAB对机身仰俯角偏差β与前铲板液压油缸调节变化量Δlsh和后支撑的液压油缸调节量Δlsu间的关联性进行解算,结果如图4所示。
图4 仰俯角偏差与前/后支撑液压油缸长度变化关系Fig.4 Diagram between front/rear support hydraulic cylinder and pitch deviation
由图4悬臂式掘进机仰俯角偏差与前/后支撑液压油缸长度变化关系曲线解算结果可知,机身仰俯角β与前铲板液压油缸长度变化Δlsh和后支撑的液压油缸长度变化Δlsu之间呈空间微弧状曲面变化规律。
为定性研究前铲板和后支撑两者分别对机身仰俯角偏差的影响程度,设定前铲板和后支撑液压油缸调节变动量均为[-48.5 mm,48.5 mm],用Matlab进行解算。如图5(a)所示,设定范围内,保持后支撑液压油缸变动量Δlsu=0恒定,由前铲板液压油缸变动引起的机身仰俯角偏差βsh呈空间微弧状曲线变化趋势,对应βsh变动范围为:-4.409°≤βsh≤2.593°;同理,如图5(b)所示,设定范围内,保持前铲板液压油缸调节量Δlsh=0恒定,后支撑液压油缸长度变动引起的机身仰俯角βsu亦呈空间弧状曲线规律变化,对应βsu变动范围为:-6.941°≤βsu≤4.529°。
图5 仰俯角偏差与前铲板/后支撑液压油缸调节量关系Fig.5 Relational between front-spade/rear-support hydraulic cylinder and pitch deviation
比较分析结果发现,图5(a)曲线变化趋势比图5(b)曲线变化趋势平缓,即前铲板液压油缸长度变动引起的机身仰俯角变动较后支撑板液压油缸长度变化引起的机身仰俯角变动要小,说明前铲板液压油缸变动量对机身仰俯角的影响程度较小;且在同等变动范围内,前铲板液压油缸对机身仰俯角偏差β变动补偿范围也较小。故实施机身仰俯角纠偏时,可优先考虑采用首先调节后支撑液压油缸作为粗调,补偿粗大仰俯角偏差,而后采用调节前铲板液压油缸作为精调节,补偿微小仰俯角偏差。
2.1.2机身可补偿横滚角偏差γ数学模型的建立
假设后支撑的移动副P12(P22)和前铲板的移动副P32(P42)可分别通过调节相对应控制液压油缸以实现对SOCi支链边长长度li(i=1,2,3,4)的调节,同理,选择POC2并联回路得到机身动系相对于巷道静坐标系的横滚角偏差γ数学模型:
(5)
可补偿横滚角偏差γ与前(后)支撑液压油缸长度变化关系如图6所示。
图6 横滚角偏差与前(后)支撑液压油缸长度变化关系Fig.6 Diagram between front/rear support hydraulic cylinder and compensable ±γ deviation
分析结果可知:机身横滚角γ与前铲板液压油缸长度变化Δlsh(后支撑的液压油缸长度变化Δlsu)间亦呈空间微弧状曲线变化关系,即当前铲板液压油缸(后支撑板液压油缸)长度变化,机身横滚角γ随之发生递增(递减)变化(实际工程中,实现分别对两个前铲板(后支撑)的液压回路控制,则会增大整机的液压回路复杂度)。
2.1.3巷顶距偏差±H的推导解算
截割过程中由于掘进巷道底部不平以及截割载荷的变动造成机身产生巷道高度方向的巷顶距偏差±H。选择POC1和POC3并联回路,通过同步控制调节液压回路边长(即同步等量控制前铲板液压油缸和后支撑液压油缸变动量),可实现对巷顶距偏差的补偿:
H=±(Zp-H0)
(6)
式中,H0为机身动坐标系的起始高度(H0=858.81 mm);Zp为机身动点的Z坐标值。
巷顶距偏差±H的变化曲线如图7所示。 分析图7仿真曲线可知:同步调节前铲板(后支撑)液压油缸变动量(Δlsh=Δlsu),可补偿一定量的巷顶距偏差,且液压油缸调节变动量与可补偿的巷顶距偏差两者之间符合对应线性关系。
图7 机身巷顶距与前/后支撑液压油缸长度变化曲线Fig.7 Relational curve of between roof distance and front/back support hydraulic cylinder
至此,综合式(6)~(8),得到机身上任意测量动点[xp,yp,zp]相对巷道底面静平台坐标系产生的可补偿仰俯偏差(±β)、横滚角偏差(±λ)和巷顶距偏差(±H)的数学模型。
截割过程中,随机变化的截割载荷是掘进机机身空间位姿偏差产生的重要因素之一,很多文献对截割载荷都有研究,该动载荷在截割平面内可分解为Fx,Fy和Fz三个方向的分力[20-22]:
(7)
分析式(7)发现:空间截割载荷不仅与掘进机本体几何结构参数、截割工况相关联,同时亦与截割过程中截割臂水平转角和升降摆角存在对应关系。故同理以截割机构的拓扑结构为分析基础,分别对截割机构中的截割臂回转和升降回路进行拓扑结构研究,进而对其在掘进水平面(XOY)的位姿偏差展开研究。
2.2.1水平回转回路和截割臂升降回路机构拓扑结构分析
(1)悬臂式掘进机截割机构水平回转并联回路拓扑结构分析。截割机构水平回转并联回路的拓扑结构如图8所示,图中,R53和R63分别为截割臂回转油缸与机身旋转铰接点;P52和P62分别为回转油缸移动副;R73和R83分别为回转油缸与回转台旋转铰接点;R3为回转台与机身旋转铰接点。
图8 悬臂式掘进机截割水平回转并联机构Fig.8 Horizontal rotary loop for cutting mechanism of cantilever roadheade
截割臂水平回转并联回路POC5由两条单开链组成,对应方位特征集Msh1和Msh2[18-20]为
式中,ρ53,ρ63,ρ73,ρ83为铰接点R53,R63,R73,R83到回转圆台旋转基点的径矢;ti,ri为第i个有限移动和转动(i=0,1,2,3)。
由并联机构拓扑结构综合[17]可知POC5回路方特集Msh为
为简化表达设:q=(l5+Δll)cosθ-h,推导出POC5并联回路输出截割臂水平回转转角Δλ为
(8)
图9 截割臂升降机构回路Fig.9 Lifting-loop structure of cutting-arm
图9中,R93和R103分别为截割臂与机身旋转铰接点;P72为截割臂升降液压油缸移动副;R4为截割臂升降液压油缸与截割臂旋转铰接点。
由串联机构拓扑结构综合[15]可知截割臂升降机构回路POC6方特集Msv为
(9)
2.2.2水平回转回路和截割臂升降回路机构及对应位姿偏差数学模型建立
(1)偏向角α和水平偏距A偏差数学模型建立。截割头承受的动态截割载荷最终作用至掘进机机身动坐标系p-xoy,将对机身同时产生一定力F′x和转矩M′x的作用,使得机身产生相对巷道底部的运动趋势,超过摩擦极限Ffmax时,机身将偏离预设截割轨迹,产生水平偏距A和偏向角α偏差,反之机身处于平稳状态。
① 当等效转矩MFx≥MFfmax时(Mx=FxL2),机身将会产生水平偏角α,根据功能守恒定理得
整理得机身水平偏角α的数学模型为
Δll)cosλcosφ]/{πL′1P1Rn[S1(l5-Δll)×
sin(C+λ)+(l5+Δlt)S′1sin(C-λ)]}
(10)
② 当等效转换力F′x≥Ffmax时,机身将产生水偏距A。根据能转换守恒关系:
整理并将上述截割载荷Fx、截割臂水平回转角Δλ及升降摆角Δφ代入,得机身水平偏距A偏差的数学模型为
Δll)cosλcosφ]/{4P1Rn[S1(l5-Δll)×
sin(C+λ)+(l5+Δlt)S′1sin(C-λ)]}
(11)
式中,M为悬臂式掘进机整机质量(包括截割头质量(m1)、截割臂质量(m2)、机身和行走(支撑)部质量(m3));μ为机身与巷道底部的摩擦因数,μ=0.8~1.0[15]。
(2)机身车前距偏差±L数学模型建立。掘进机机身空间车前距偏差±L主要是由截割载荷Fy及Fz产生,根据力学平衡关系可知:当Fysinφ≥Ff时,产生车前距偏差±L。
根据功能转换平衡定律:
整理得FysinφL=μL1(Mg+Fzcosφ)/2,最终得车前距偏差的数学模型为
(12)
综合式(10)~(12)可知,悬臂式掘进机在水平掘进面内产生的水平偏角、水平偏距及车前距偏差不仅与掘进机本身相关几何结构参数、截割动态载荷相关联,同时亦与掘进机截割臂截割过程中的姿态(截割臂水平转角和升降摆角)相关联。
综上对悬臂式掘进机在截割过程中产生的空间动态位姿偏差W=[α,β,γ,A,L,H]T的各偏差因素的定性分析,建立了截割过程中各截割空间的空间位姿偏差的数学模型,并对各位姿偏差的变化规律展开分析研究。分析结果表明:机身仰俯角偏差、横滚角偏差、巷顶距偏差与掘进机行走/支撑机构相关联,故可通过调节相应行走/支撑机构回路的结构参数进行相对应粗细偏差的补偿;而水平偏角、水平偏距及车前距偏差则与动态截割载荷及截割臂的位姿状态相关联,故可通过实时动态调整截割臂的位姿状态来补偿相应的偏差。此结论将为智能化悬臂式掘进机实时动态精准纠偏提供有效的实施依据。
已知EBZ160实体几何参数:L1=3 627.21 mm,L′1=7 352.34 mm,L2=3 900 mm,LG=1 750 mm,l1=l2=1 487.54 mm,l3=l4=2 637.87 mm,l5=1 662.08 mm,l6=1 370.86 mm,B=1 855 mm,R=844 mm,m1=1 600 kg,m2=5 700 kg,M=4.5 t以及各单支链回路边长li(i=1,2,3,4)(由GUC1000液压油缸位移传感器[22]测出),直接代入位姿正解计算公式(4)~(12),避免了复杂数学矩阵解析方法,直接得到机身动平台的坐标相对于巷道底面静坐标系的位置及位姿偏差及可补偿空间位姿偏差的极限范围,见表2。
表2 悬臂式掘进机拓扑结构正解分析Table 2 Forward solution for topological structure analysis of cantilever roadheade
(1)由表2中1,2行正解信息可知:通过调节前铲板液压油缸Δlsh∈[-63.335 9 mm,63.730 1 mm]和后支撑液压油缸ΔLsu∈[-48.5 mm,48.5 mm],可实现补偿机身空间仰俯误差的范围为:β∈[-27.468°,26.731°]。
(2)由表2中3行正解信息可知:当各回路液压油缸不发生变化时,机身动点的起始坐标为[xp,yp,zp]=[0,465.308 2,1 745.254 4]。
(3)由表2中4,5行正解信息可知:当同步调节前铲板和后支撑液压油缸长度时(Δlsh=Δlsh∈[-48.5 mm,48.5 mm]),可补偿机身巷顶距偏差范围为:H∈[-43.107 9 mm,11.875 3 mm]。
(4)由表2中6,7行正解信息可知:当水平回转液压油缸长度(Δlt∈[-606.701 9 mm,606.719 mm])并同步调节截割臂竖直升降液压油缸长度(Δlv∈[-210.691 mm,691.328 7 mm]),可实现动态补偿机身水平偏角偏差范围为:α∈[-4.95°,6.24°]。
同理,根据机构的空间拓扑结构可知机构位姿偏差的逆解可归结为:已检测到机身动平台的位姿[21-22]信息[xp,yp,zp],反求对应该位姿时各液压油缸所在支链回路边长li(i=1,2,3,4),即
(13)
同理,根据YHJ001型机载激光测距仪测量机身提供的机身实时位置信息[23],代入逆解求解式(13),可方便快捷得到掘进机对应的结构参数逆解结果(各液压回路边长li(i=1,2,3,4)),见表3。
表3 悬臂式掘进机拓扑结构逆解分析Table 3 Inverse solution for topological structure analysis of cantilever roadheade
分析表3中的逆解数据:
(1)实际EBZ160悬臂式掘进机设计工作条件:前铲板下向上抬起340 mm,向下卧底260 mm,即要求前铲板液压油缸的理论调节范围为:-63≤ΔLsh≤62,设计选配的后支撑液压油缸理论调节量为:-240≤ΔLsu≤240。根据表3逆算结果,机身仰俯角偏差β在[-27.468°,26.731°]的变动范围内:前铲板液压油缸实际变动量Δlsh为[-63.336 mm,61.732 9 mm],后支撑液压油缸实际变动量Δlsu范围为[-240.000 2 mm,240.001 mm],即逆解计算出对应液压油缸实际变动量Δli≤10-2(i=1,2,3,4),满足工程设计要求,从而验证了本文所提供的位姿逆解的正确性。
(2)同理,要求截割臂截割范围:高度4.8 m,宽度5.4 m,可知回转液压油缸理论变动范围量ΔL5为[-607 mm,607 mm];截割臂升降液压油缸变动量ΔL6范围为[-210 mm,691 mm]。根据本文推导出水平偏角α在[-34.067°,36.205 5°]的可补偿变动范围内,逆推导出回转液压油缸实际变动范围量Δl5为[-606.701 9 mm,606.701 9 mm];截割臂升降液压油缸实际变动量Δl6范围为[-210.422 8 mm,691.329 mm],即逆解计算出对应液压油缸实际变动量偏差均满足Δli≤10-2(i=5,6),亦验证了本文所提供的位姿逆解完全满足工程要求。
为验证本文推论的可实践性,以EBZ160悬臂式掘进机为实验基体,将实验设备(表4)分别安装在标定的掘进机机身转盘中心位置,沿掘进前进方向 20~60 m长度内,每隔10 m模拟在截割头施加恒定瞬间截割动载荷,采集并记录测量悬臂式掘进机机身姿态偏差数据信息并进行数据处理[23]。
将测量解算出的悬臂式掘进机机身质点的空间位姿偏差信息数据代入逆解公式(13)即可求解出相应纠偏液压回路边长Δli,将逆解结果反馈给控制液压回路实施实时空间位姿偏差调节。利用MATLAB对纠偏前后的实验测量数据进行轨迹曲线进行拟合,如图10所示。
图10 纠偏前后掘进机空间位姿偏差变化曲线Fig.10 Spatial deviation curves of cantilever roadheader before and after rectification
均方差为
Sx′=-0.767 2,Sy′=0.295 4,Sz′=-0.190 8
实验统计数据表明:随测量距离的增大,机身空间各方向的动态位姿偏差亦呈随机递增趋势,但经过本方案对机身进行相应纠偏调节之后,机身的空间位姿偏差不论从稳定性和实施结果上来讲都得到显著改善。
(1)基于悬臂式掘进机的结构分析,首次提出悬臂式掘进机机身空间全方位位姿偏差W=[α,β,γ,A,L,H]T,实现了悬臂式掘进机空间全方位各项位姿偏差的定性描述;并提出通过结合空间机构的拓扑结构思想来定性分析和研究悬臂式掘进机结构特性及机身空间全方位位姿偏差。
(2)基于悬臂式掘进机的拓扑结构分析,分别建立了行走/支撑机构在掘进平面、掘进高度平面内产生的各项相关位姿偏差的数学模型,通过缩减数学模型分析可知:调节前铲板/后支撑液压油缸驱动量,可实现补偿机身最大仰角偏差26.731°,最大俯角偏差27.468°,可补偿最大巷顶距偏差20.253 7 mm;同时,通过动态实时调整截割臂截割姿态,可补偿机身最大水平偏角偏差36.067°。从而实现了对悬臂式掘进机空间全方位位姿偏差的定性分析和定量分析,同时也为悬臂式掘进机的实时纠偏提供了准确分析数学模型和依据。
(3)利用空间机构正/逆解思想,正解通过各机构回路支链的几何结构信息求解出动平台位姿偏差信息及可补偿空间位姿;通过检测动平台的位姿信息逆解求解出对应该位姿时悬臂式掘进机的相关几何结构参数信息,最后通过实验结合软件仿真分析纠偏前后的空间位姿偏差,结果表明:经本方案纠偏后的各项空间位姿偏差的均方差大大降低,进一步验证了利用空间机构拓扑结构分析悬臂式掘进机空间位姿偏差的准确性和可行性。