间隙式单吸盘爬壁机器人动力特性分析.pdf

第12卷第31期2012年11月16711815(2012)31-8271-05科学技术与工程ScienceTechnologyandEngineeringVol.12No.31Nov20122012Sci.Tech.Engrg.计算机技术间隙式单吸盘爬壁机器人动力特性分析武丽君吴善强(中国计量学院机械电子研究所，杭州310018)摘要研究了带有新型吸盘结构的具有间隙式负压吸附方式特点的爬壁机器人的动力学问题。采用间隙吸附方式的爬壁机器人，其运动性能(可操作性、驱动性能等)主要由轮式移动结构决定，因此对爬壁机器人运动结构进行动力学分析是合理和必要的。基于拉格朗日乘子方程建立了机器人的动力学模型。利用Matlab/Simulink的动力学仿真，分析了吸盘吸附力和机器人方位角变化对爬壁机器人运动特性的影响，为改善和提高机器人的运动性能并为其结构优化设计与运动控制提供了理论研究基础。关键词间隙吸附爬壁机器人轮式移动动力学中图法分类号TP242；文献标志码A2012年7月2日收到浙江省自然科学基金(Y1090042)、浙江省教育厅资助项目(Y200909253)和浙江省大学生孵化项目(2011R409045)资助第一作者简介:武丽君(1988)，女，硕士生，研究方向:机器人技术、运动控制。E-mail:。爬壁机器人是一类能够在高空危险环境下作业的特种机器人，在反恐防暴、石化、建筑、能源等多个行业中有广泛的应用前景，具有重要的研究意义和实用价值1。近十几年，国内外很多研究者针对爬壁机器人的壁面吸附能力和机构的运动形式进行了研究，其中，轮式运动机构作为爬壁机器人的一种有效运动方式，以其运动速度快、机构简单等优点得到了很多研究者的重视2，3。相对于传统的以研究机器人智能、决策等为目的而开发的轮式移动机器人相比，在爬壁能力、机动性、集成设计、智能检测等方面提出了许多新的挑战。卡耐基梅隆大学研究了Walbot机器人和加州大学伯克利分校与Robot合作开发了机器人Hexa-Gecko4；哈尔滨工业大学研制了轮式驱动的低噪声负压吸附反恐爬壁机器人5；上海交通大学和北京理工大学也分别研制了高楼壁面清洗作业机器人和四轮移动机构的爬壁机器人样机6，7。对于间隙吸附单吸盘爬壁机器人，与传统滑动式单吸盘爬壁机器人最大不同是吸盘与壁面间不存在滑动摩擦，因此减少了机器人运动时部分阻力。由于壁面移动机器人工作于垂直壁面上，吸附能力和运动结构设计是机器人设计的两个关键问题。首先介绍了爬壁机器人的整体结构，并利用流体仿真软件fluent仿真分析了吸盘与壁面缝隙间的空气流场分布，然后针对所设计的四轮驱动单吸盘间隙吸附式爬壁机器人，研究了单个驱动轮的受力情况，并分析了机器人在任意姿态下在壁面上安全移动的运动状态和约束条件，建立了其动力学模型，最后利用Matlab/Simulink软件对爬壁机器人的动力学模型进行了仿真分析，将吸附力和方位角作为变量，使其根据实际情况可以调整大小，得出吸附力变化对爬壁机器人运动特性的影响，为四轮驱动爬壁机器人的结构优化和安全运动控制提供了理论依据。1机器人机构组成所设计的四轮驱动单吸盘间隙式爬壁机器人组成结构如图1所示，包括吸附结构和运动结构两部分。其中吸附结构是由离心风扇、滑动吸盘、上下导流密封机构和风扇电机组成，滑动吸盘通过离心风扇在吸盘与壁面的缝隙之间产生负压，使机器人附着在壁面上。同时，上下导流机构使风扇出口气体与壁面产生一定的夹角，即出口气体与缝隙入口气体间形成对流，从而阻止部分气体的流入，具有一定的气封作用。运动机构由驱动轮fl，驱动轮fr，驱动轮bl，驱动轮br，分别表示前左轮，前右轮，后左轮，后右轮组成，每个轮子的驱动装置都是安装在与轮子同轴心的位置，这种机构能够使机器人在平滑壁面上具有快速的移动能力。图1机器人本体结构在遇到不同壁面条件时，可以通过改变吸盘与壁面间的缝隙高度来提高机器人壁面适应能力。在缝隙高度增大时，空气泄漏量增大，吸盘与壁面间的负压值减少，通过提高离心风扇的转速增大抽吸空气的能力，从而保证机器人安全吸附在壁面上。2吸盘与壁面缝隙内空气流场的模拟仿真利用CFD对滑动吸盘内空气泄漏量和压力场进行数值模拟，为爬壁机器人负压吸盘研究与设计提供了理论依据。当离心风扇入口处始终提供4000Pa负压时，图2是导流机构与吸盘成30度夹角时根据Fluent分别对2mm，4mm，6mm，8mm以及10mm的缝隙高度下得到的吸盘内空气泄漏量绘制的曲线。图2加入气封结构前后吸盘内空气泄漏量对比图2中黑色曲线代表在未加入导流气封结构前吸盘内的空气泄漏量，红色曲线代表加入导流气封结构后吸盘内的空气泄漏量，由图2可知当加入吸盘气封结构后，空气的泄漏量有所减小。其中，在缝隙高度为6mm时，空气泄漏减小幅度最大，气封效果最明显。图3加入气封结构前后缝隙内压力场分布对比同时，对在2mm，4mm，6mm，8mm以及10mm的缝隙高度下吸盘内压力场也做了模拟。图3为缝隙高度为4mm时，加入导流气封结构前后吸盘内压力场分布对比。从图中3可以看出，加入导流气封结构后，吸盘内的压力梯度变化明显，低负压区向外扩展，从而爬壁机器人吸盘内保持了一定的真空度，保证机器人能有效吸附在壁面上，不至于滑落或倾覆，提高了机器人的自适应能力。通过对吸盘与壁面的缝隙间空气流场分布的数值模拟，可以数值计算机器人吸盘负压吸附力，为爬壁机器人负压吸盘研究与设计提供了理论依据。2728科学技术与工程12卷3机器人的动力学建模3.1机器人单个驱动轮动力学方程当运动轮与墙壁接触时，墙壁都会对其表面产生应力。假设机器人运动轮与壁面刚性接触，驱动轮受力情况如图4所示。图4单个驱动轮受力分析图4中，机器人运动轮半径为r，宽度为b；Fs为运动轮阻力，Ff为墙壁对运动轮的摩擦力；Fp为机器人本体作用在运动轮轴上的正压力，FN(=Fp)为墙壁对运动轮的反作用力；Mc(=T)为墙壁对运动轮的阻力矩，T为驱动电机的输出力矩。根据图4的受力分析，单个驱动轮的动力学方程为。v=rmv=FfFsmgJ=TFfrMc(1)式(1)中，v为轮子中心线速度，为驱动轮角速度，m和J分别为驱动轮的质量和惯性矩。Ff与驱动轮的摩擦系数和机器人本体作用在运动轮轴上的正压力Fp有关。驱动轮的动摩擦力方向与机器人运动方向一致，为机器人运动提供驱动力。所有运动轮均采用驱动轮的方式，产生的摩擦力都被用来驱动机器人运动，可以最大限度地利用有限的负压吸附力，从而提高了机器人的负载能力。3.2任意姿态下驱动轮支撑力分析机器人以任意姿态在壁面上运动情形如图5所示。首先定义固定于壁面的惯性笛卡尔坐标系X，Y，Z-O和广义坐标系为x，y，z-o，驱动轮中心沿X方向间距为2L，沿Y方向间距为2B，机器人重心距墙壁距离为H。Fffl，Fffr，Ffbl，Ffbr分别为前左轮、前右轮、后左轮、后右轮的滑动摩擦力。机器人处于静止吸附状态时，各驱动轮所受壁图5机器人任意姿态下驱动轮受力分析面支撑力满足下式FNfl+FNfr+FNbl+FNbrFp=02L(FNfl+FNfr)+GHsinFpL=02L(FNfl+FNbl)+GHcosFpB=0(2)式(2)中FNfl，FNfr，FNbl，FNbr分别表示前左轮、前右轮、后左轮、后右轮的支撑力。Fp为机器人的吸附力。机器人处于任意姿态下的直线运动状态时，各驱动轮所受壁面支撑力满足下式:FNfl+FNfr+FNbl+FNbrFp=0FfFxMaGcos=02L(FNfl+FNfr)+GHsinFpL=02L(FNfl+FNbl)+GHcosFpB=0(3)式(3)中Fx为驱动轮所受到的阻力和。运动轮摩擦力提供机器人驱动力，Ff=Fp，其中，为运动轮的摩擦系数。运动过程中应满足min(FNfl，FNfr，FNbl，FNbr)0，即保持4个驱动轮始终与壁面接触。采用拉格朗日乘子方程建立四轮驱动单吸盘爬壁机器人在纯滚动条件下的动力学模型为8:M(q)q+C(q)Fp+D(q)G=B(q)TAT(q)(4)式(4)中M(q)是对称、正定惯性矩阵；假设机器人始终不发生侧向移动，B(q)，C(q)，D(q)为输入变换矩阵，AT(q)为约束矩阵，为拉格朗日约束乘子矢量。取驱动力矩向量T=(l，r)T，l=rFl，r=rFr。372831期武丽君，等:间隙式单吸盘爬壁机器人动力特性分析3.3机器人的动力学分析各驱动轮转速分别为vfl，vfr，vbl，vbr，驱动轮转速分别为fl，fr，bl，br，驱动轮半径为r。设四个驱动轮的尺寸、材质一致，轮胎刚度系数一致。从以上假设可以得到l=fl=bl；r=fr=br(5)vl=rl；vr=rr(6)采用Routh方程可得到式(4)中的系数矩阵。M(q)=M000M000I；B(q)=1rcoscossinsinBB；C(q)=cossin0；D(q)=sincossin20。假设在理想的纯滚动非滑移条件，即存在非完整约束使(sin，cos，0)(x，y，)T=A(q)q=0(7)取驱动轮角速度向量=(l，r)T，则有珋q=S(q)w。其中，S(q)是一组光滑分布在零空间的满秩矩阵向量S(q)=r2coscossinsin1B1B，可以证明A(q)S(q)=0，即q始终处于A(q)的零空间，满足约束条件式(7)。在式(4)两边左乘ST(q)，可得ST(q)(M(q)q+C(q)Fp+D(q)G)=ST(q)B(q)T(8)可以证明ST(q)B(q)是I22矩阵，所以可以得到驱动力矩为:T=ST(q)(M(q)q+C(q)Fp+D(q)G)(9)吸附压力Fp作用下驱动轮最大允许驱动力矩TmaxFp=rFNfl+FNblFNfr+FNbr。4机器人动力学仿真机器人结构参数为:M=8kg，r=0.0675m，B=230mm，L=220mm，=0.6，机器人以速度为2m/s，半径R为1m做等半径匀速圆周运动。依据所建立的机器人动力学模型，利用Matlab对机器人进行仿真分析。图6不同吸附压力为Fp下驱动轮的驱动力矩图6为不同吸附压力Fp为下驱动轮的驱动力矩曲线。可以看出，随吸附压力的增大，机器人所需的驱动力矩也增大，同时也可以看出，随着机器人方位角的变化，机器人安全移动驱动力矩也在变化。在实际环境的不确定干扰的存在，如缝隙的增大，摩擦系数突变等，对机器人移动产生影响，因此要保证机器人的安全移动，必须通过改变吸盘吸附力来使爬壁机器人适应不同工作环境。5结论本文对四轮驱动间隙式爬壁机器人的动力学进行了研究。首先，分析了单个驱动轮的受力情况并对其建立了动力学方程，然后，针对任意姿态下，分别在机器人静止吸附和运动两种状态下对驱动轮所受支撑力进行了分析，进而利用拉格朗日乘子方程建立了机器人非完整约束系统的动力学模型，把吸附压力作为自由度引入动力学方程中。最后，将机器人尺寸代入模型，利用Matlab/Simulink模块仿真分析了所设计的机器人在不同吸附压力作用下，以任意姿态角运动所需的驱动力矩，从而得出通过改变吸盘吸附力来使爬壁机器人适应不同工作环境的方案。为提高其壁面适应性和安全运动控制提供了理论依据。4728科学技术与工程12卷参考文献1崔旭明，孙英飞，等壁面爬行机器人研究与发展科学技术与工程，2010；10(11):267226772LongoD，MuscatoGTheAlicia3climbingrobotIEEERoboticsandAutomationMagazine，2006；13(1):42503李明河，王伟，等一种全方位移动机器人的系统设计，安徽工业大学学报，2011；28(1):51544MenonC，MurphyM，SittiGMInspiredsurfaceclimbingrobotsPro-ceedingsofthe2004IEEEInternationalConferenceonRoboticsandBiomimeticsShenyang，China:IEEEServiceArtificialLifethatLoco-motesProceedingsCenter，2004:4314365WuShanqiang，LiMantian，XiaoShu，etalAwirelessdistributedwallclimbingroboticsystemforreconnaissancepurposeProc2006IEEEIntConfonMechatronicsandAutomation2006:130813126潘雷，赵言正，等具有双负压吸盘的爬壁机器人吸附特性上海交通大学学报，2005；39(6):8738767MaB，LiuR，ZhangR，etalDesignofwallclimbingrobotswithtran-sitioncapabilityIEEEIntern-ationalconferenceonRoboticsandBio-mimeticsPiscaltaway，NJ，USA:IEEE，2007:187118758李志海，付宜利，等四轮驱动滑动吸盘爬壁机器人的动力学研究机器人2010；32(5):601607DynamicsAnalysisonWall-climbingRobotwithGap-typeSingleSuctionCupWULi-jun，WUShan-qiang(MechatronicsInstitute，ChinaJiliangUniversity，Hangzhou310018，PRChina)AbstractDynamicsofthegapadsorptionwall-climbingrobotwithanewstructureofsuctioncupisstudiedThemovingperformance(