深海履带式采矿车运动控制仿真

深海履带式采矿车运动控制仿真

履带式采购机构以其自身的固有结构特征广泛应用于军事、农业和采购机械等特殊道路环境。对于深海6km多金属结核及钴结壳采矿领域而言,德国、印度、韩国、中国等众多国家,相继研制出了包含海底履带式采矿车的深海采矿系统。深海采矿的工作环境极为特殊。深海底海泥的力学特性直接影响到采矿车的行走性能。Zvi等对于履带车辆进行了理论建模和分析,但此模型仅适应于一般陆地,对于深海底特殊复杂环境下的履带车辆行驶力学的研究缺乏研究。针对软路面车辆行驶地面力学,Bekker提出确定剪切应力与剪切位移之间关系的实验方法;德国的Schulte等通过模拟海泥的沉陷和剪切实验,获得了剪切应力与剪切位移之间的关系;中南大学的李力等利用膨润土模拟我国深海矿区海泥特性,通过实验得到了我国深海表层海泥的剪切应力和位移关系。上述研究着重于履带驱动力和打滑之间的关系,对于深海履带采矿车行走过程中遇到的阻力问题未过多涉及。采矿车在行走过程中会受到来自海底沉积物的压实阻力、推土阻力、转弯阻力以及水动力和与之相连的输送软管等作用力的影响。这些阻力在深海履带式采矿车行走过程动力学分析研究中是极其重要的,这也是本文研究的重点之一。深海履带式采矿车的行走动力是通过履带相对地面打滑产生的剪切力获得的,打滑率直接影响到采矿车的行驶性能。传统陆地车辆的打滑控制方法主要有逻辑门法、PID控制法、模糊控制法以及滑模控制法;Herzog等对于深海环境下履带车辆打滑控制进行了实验研究,缺乏一定的理论分析。本文作者对深海履带式采矿车行走过程中打滑率进行了控制研究,通过模拟海泥的特性,结合我国深海表层海泥的剪切应力与位移之间的关系,得到了深海履带式采矿车牵引力与打滑之间的关系;通过对深海履带式采矿车行走过程的动力学分析提出采矿车打滑率的控制要求(i≤20%),并设计了模糊PID控制系统,对打滑率进行控制。仿真结果表明,采矿车行走过程打滑率可以满足控制要求,确保了深海特殊环境下履带式采矿车的行驶性能。1酶切应力我国深海履带式采矿车行走时履带齿达到200mm深的海泥层。为了模拟该层海泥的土力学特性,选取膨润土和水以一定的比例混合作为模拟海泥。表1所示为深海海底200mm深海泥与模拟海泥的物理力学特性。根据Wong的车辆地面力学理论,土壤所提供的驱动力为:其中:F1为土壤驱动力;b为履带宽度;l为履带接地长;τ为土壤剪切强度;x为接触点履带前端距离。李力等通过实验获得了模拟海泥剪切应力与位移的关系表达式:其中:τ为水平剪切应力;j为履带前端接触点距离的剪切位移,j=ix,i为打滑率;τmax为最大剪切应力;τr为残余剪切应力;k1=55;k2=3。由式(1)和(2)可以得到深海履带式采矿车履带总牵引力的计算式为:式中:F2为履带总牵引力;取模拟海泥最大剪切应力τmax=4.9kPa,残余剪切应力τr=1.4kPa,同时,根据我国1000m海试系统深海履带采矿车的设计参数(见表2),可以得到深海采矿车履带总牵引力计算式为:由式(4)可以绘制得到深海履带式采矿车履带总牵引力与打滑率之间的关系曲线。从图1可知:当模拟深海底沉积物剪切强度为4.9kPa时,采矿车的履带牵引力随着打滑率的增加而急剧减小,当打滑率大于20%时,牵引力基本稳定在30kN附近。为使采矿车在深海软底质环境行驶过程中具有良好的动力性能,需要对采矿车进行动力学分析,并对其行走过程的打滑率进行控制。2海底未来采矿车转向驱动结构方程深海履带式采矿车采用履带自行式。行走机构包括履带、履带架、驱动轮、张紧轮与张紧装置、支重轮、拖链轮、动力装置等,用于载运集矿机构在海底自动行走作业。2条履带分别选用液压马达驱动,利用速度差实现采矿车转向。深海履带式采矿车在海底直行过程中,其单侧履带的动力学方程为:式中:J为履带驱动轮相对于转轴的转动惯量;ωl为履带的转动角速度;Tw为单侧履带液压马达的驱动力矩;FL为内外侧履带的牵引力;R为驱动轮半径;Mi为深海履带式采矿车单侧模型质量;v为履带速度,即驱动轮线速度;Rb和Rc分别为履带受到的推土阻力和压实阻力;Fw为水阻力。3在工作环境下计算阻力3.1推土阻力与生履带式采矿车行驶在海底稀软沉积物上,沉陷较大,不可避免地将产生较大的压实阻力与推土阻力。压实阻力可由下列公式得到:其中:kc和kφ分别为内聚变形模量和摩擦变形模量;m为车体质量;n为单条履带支重轮数;b为履带宽度;p为履带板节距;D为支重轮直径。3.2沉陷量表z推土阻力可由参考文献得到:其中:γ为沉积物湿密度;z为沉陷量;Kc和Kγ为被动土系数,其中,这里,Nc和Nγ为太沙基承载能力系数,由土壤内摩擦角φ2唯一确定,可通过太沙基承载力系数表获得。3.3走车速度、行驶温度和海流速度的计算水下履带式采矿车有较大的迎水体积及迎水面积,海水密度较大,且海底存在着一定的洋流,这些都对采矿车有一定的动力影响。水动力可以由水阻力和惯性力线性叠加而成:其中:Cd为水阻力系数(dragco-efficiency);Cm为附加质量系数;ρw为海水密度;Am为采矿车的迎水面积;vm和vw分别为采矿车的行驶速度与海流速度。根据我国深海采矿系统对采矿车行走速度的要求,本文以0.5m/s作为采矿车行走控制速度;海底洋流速度根据我国大洋多金属结核中试系统1000m海试区域的介绍,约为0.15m/s。3.4行驶阻力及滑动率对于履带式采矿车而言,其转向是通过左右履带差速来实现的,在转弯的过程中由于偏心的存在导致转弯阻力的产生,转弯阻力可通过下式计算得到式中:m为履带车质量,B为履带间距,L为车体长度,E为纵向偏心距,阻力系数μ取0.23。阻力计算参数见表3。由表1～3和计算式(7)～(12)可以得到深海履带式采矿车行驶过程受到的行驶阻力约为31510N,对应牵引力与打滑率关系曲线可知,此时的打滑率为29%。由于采矿车在行驶的过程中还会受到与之相连的输送软管的作用力,所以履带的打滑率应该有一定的余量。故本文取20%作为履带式采矿车打滑率的控制标准。4液压回路系统组成深海履带式采矿车左右履带的行走均采用液压系统来实现。该液压系统是一个液压阀控马达系统,由变量泵、电液比例阀、定位油缸、液压马达等组成,如图3所示。它通过改变电液比例阀控制油缸位移,进而改变液压泵斜盘倾角,调节液压回路流量来控制液压马达的转速和方向,从而达到深海履带式采矿车前进、后退及转弯的目的。液压马达为深海履带式采矿车提供动力,液压行走系统模型的输入量为比例阀的控制电流,输出量为液压马达的输出转矩,通过控制比例阀的输入电流就对液压马达输出转矩的调整,进而控制驱动轮的驱动力矩,从而达到调节履带的打滑率的目的。5管理系统的设计5.1控制系统设计为使采矿车在直线行驶过程打滑率满足控制要求,设计带模糊PID控制器的打滑率控制系统,控制系统如图4所示。在模糊PID控制器中,控制变量为打滑率i,调节变量为履带液压行走系统比例阀的输入电流I,打滑率偏差e以及偏差变化率e(5)可以实时计算,根据模糊关系可调整此PID控制器的参数kp,ki和kd。5.2模糊pid控制器参数的模糊规则模型模糊控制的输入为控制变量i的偏差以及偏差变化率,输出为PID调节器的参数kp,ki,kd;E和EC为e和e(5)的模糊变量,KP,KI和KD为模糊变量。它们的论域均为{±6,5,4,3,2,1,0},模糊集均为{PB,PM,PS,Z,NS,NM,NB}。图5所示为各个模糊变量的隶属度函数曲线。在模糊PID调节器中,KP,KI和KD模糊参数由控制规则得出。表4给出了模糊规则模型,由表4可知,在|E|比较大的情况下,采用PD控制,可以达到加快相应速度并快速消除稳态误差的作用;在|E|适中的情况下,以保证控制精度为目标;而在|E|较小的情况下,KP和KD取大值,用以提高系统的稳定性。采用重心法进行反模糊化,最终得到PID调节器的参数kp,ki,kd。(a)E的隶属度函数;(b)EC的隶属度函数;(c)KP的隶属度函数;(d)KI的隶属度函数;(e)KD的隶属度函数图5各模糊变量隶属度函数Fig.5Degreeofmembershipoffuzzyvariables5.3液压行驶模型的建立由于采矿车行驶在极其稀软的海底,其行走过程必然存在一定的打滑。采矿车打滑率的计算可通过下式得到:根据我国深海采矿系统对采矿车行走速度的要求,vm=0.5m/s。根据上述模糊PID控制系统,在Matlab/Simulink中建立仿真模型,如图6所示。此系统的输入为期望打滑率(20%),输出为深海履带式采矿车驱动轮的线速度。液压行走模块根据图3建立,限于文章篇幅,液压行走模型的Simulink建模过程参考文献。打滑反向计算模块根据式(13)建立。6液压动力系统的验证图7和8分别为打滑率控制仿真曲线和履带式采矿车驱动轮速度仿真曲线。由图7可以看出:在模糊PID控制器的作用下,深海履带式采矿车直线行驶启动阶段打滑率较高,最高达到54%,之后在控制器的作用下迅速逼近理想打滑率(20%),大约在0.65s达到稳定(20%),此后一直稳定在理想打滑率附近,符合控制要求。由图8可以看出:采矿车启动阶段驱动轮速度由0m/s迅速增大,约在0.65s时达到稳定,速度稳定在0.625m/s左右,对应采矿车设定的行驶速度0.5m/s可知,打滑率基本稳定在20%左右。图8的仿真结果与图7打滑率的变化规律吻合,由此验证了履带式采矿车行走液压动力系统模型的正确性。综上仿真结果,整个控制系统能使深海履带式采矿车迅速稳定在最佳工作状态,确保了采矿车行驶过程中的动力性能。7指导作业模型材料建立,建立了规范的采矿车编码机构(1)基于我国深海采矿特定海泥层土力学特性分析,得到深海履带式采矿车牵引力与打滑率之间的关系:牵引力随打滑率增加而急剧减小,最终稳定在30kN。为我国深海采矿车动力学分析提供理论基础。(2)建立完整的履带式采矿车动力学模型,根据采矿车牵引力与打滑