机器人楼梯推进技术研究

机器人楼梯推进技术研究

0移动机器人的基本功能移动机器的技术越来越多地用于工业应用、海洋开发、家庭服务、太空探索和现代战争等场所。楼梯是最常见的障碍物之一,爬楼梯能力是移动机器人应具有的基本功能。国内外现有的爬楼梯机器人按推进方式主要分为轮式、腿式、履带式和轮腿式等。1u3000阶段计划1.1机器人的结构模型六足机器人AmphiHex采用半圆腿为推进机构,具有良好的环境适应性,能够适应平地、楼梯和泥地等不同环境。机器人由驱动模块、变形腿模块、控制电路和防水壳体组成,左侧3条腿依次编号为1,2,3,右侧3条腿依次编号为4,5,6。机器人的主要结构参数如表1所示。AmphiHex采用弧形腿为推进机构,每条腿仅有1个自由度,降低了控制的复杂度。机器人在楼梯上运动如图1所示。1.2足机器人身体运动特性六足机器人在陆地上运动时,按照支撑在地面上的腿的数量不同,可将步态分为三角步态、四足步态和波动步态。这3种步态是六足机器人陆地运动最常用的步态,其中三角步态速度快,灵活性高;波动步态速度慢,但稳定性好;四足步态介于以上两者之间。六足机器人在运动时,腿的运动状态可以分为支撑相和摆动相。支持相是机器人的腿处于支撑或者着地的状态,此时腿承受载荷并朝运动反方向转动;摆动相则是指机器人的腿处于空中转动的不着地状态。用T表示机器人腿的运动周期,并且用tsi表示机器人的第i条腿处于支撑相的时间,则占空比βi可以用支撑相的时间tsi与运动周期T的比值来表示,即占地系数δ是指机器人运动过程中处于支撑相的腿的平均个数,对于腿的总条数为n的机器人为:用S表示机器人腿的单步位移,则机器人的平均速度可以用v来表示,即对于不同的步态,占地系数δ影响机器人的稳定性和平均速度。较小的占地系数意味着机器人处于支撑相的腿较少,速度较快;相反,占地系数较大时,处于支撑相的腿的条数增加,能承受更大的载荷,但是速度较慢。1.3驱动相和摆动相六足机器人AmphiHex运动时,6条腿按照一定的时序整周转动。图2为机器人运动时,单腿的运动示意图,其中,P0是由机器人身体内部的零位检测装置决定的绝对零度位置;P1和P2分别是支撑相的开始和结束位置。用参数ωs,ωf,ts,tf,θ0和θ1来描述机器人的运动。θ0是腿从OP0位置到OP1位置转过的角度,θ1是支撑相的角度,ts和tf分别是支撑相和摆动相的时间。在AmphiHex半圆腿的一个运动周期中,支撑相的角度为[θ0,θ0+θ1],其余角度为摆动相。在支撑相,腿以较慢的角速度ωs转动,以支撑机器人并提供推进力;在摆动相,腿以较快的角速度ωf转动。由于半圆腿在转动的过程中,旋转中心离地面的距离是变化的,所以当支撑相结束时,处于摆动相的腿也应该结束摆动相,因此,半圆腿的运动应满足:2u3000mmphihex四足步骤2.1足态度运动过程六足机器人四足步态的灵感来自于蟑螂的运动,蟑螂在攀爬运动时会增加支撑腿的条数来维持身体的稳定,由常规的三足支撑运动变为四足支撑运动。采用四足步态,六组昆虫或六足机器人可以获得较大的推进力和稳定性。在四足步态中,AmphiHex的6条腿被分为3组,每一组腿由左侧和右侧的2条腿组成。3组腿分别为前足(1号腿和4号腿),中足(2号腿和5号腿)和后足(3号腿和6号腿)。机器人的3组腿按照由前到后的顺序依次转动。在四足步态中,任意时刻至少有4条腿处于支撑相,占空比为2/3,占地系数为4。机器人四足步态运动的时序如图3所示。图4为AmphiHex四足步态的运动过程,可以分为以下3步:a.前足从P2转到P1,处于摆动相,中足停留在P1,后足从P1转到P2,处于支撑相,如图4a所示。b.前足停留在P1,中足从P2转到P1,处于支撑相,后足从P1转到P2,处于摆动相,如图4b所示。c.前足从P1转到P2,处于支撑相,中足从P2转到P1,处于摆动相,后足停留在P1,如图4c所示。按照上述步骤循环,AmphiHex以四足步态向前推进。与三角步态相比,四足步态的速度稍慢,任意时刻只有2条腿处于摆动相,但四足步态的承载能力和稳定性较好。三角步态常用于在平地上行走,可以获得更大的前进速度和运动灵活性。四足步态则用于斜坡或者楼梯等机器人容易发生倾斜或翻到的场合,以获得稳定的运动。2.2身体重心稳定试验McGhee和Iswandhi于1976年提出静态稳定裕度SSM(staticu3000stabilityu3000margin)的概念。SSM稳定裕度定义为重心投影点距离投影支撑多边形各边的最小距离,其数学表达式为:SSSM为静态稳定裕度;ln为支撑腿数,diG为重心投影至支撑多边形第i条边的距离。当SSSM>0时,机器人处于稳定状态;反之,则是不稳定的。六足机器人以四足步态运动时,当2条前腿或2条后腿处于摆动相时,机器人的稳定性最差。以前足离地的状态为例,机器人处于稳定状态需满足以下条件:中足和后足处于支撑相,且中足的支撑点不能越过身体的中心线。机器人在该状态下的稳定裕度计算如5所示。图5中,O为机器人身体重心的投影;s1,s2,s3,s4分别为机器人重心投影到支撑多边形各边的距离。根据静态稳定裕度SSSM=min(s1,s2,s3,s4),由图6可得:此时的最小稳定裕度为:由上式可得,SSSM>0,因此,机器人的四足步态是稳定的。3u3000mm13635dx楼梯实验与分析3.1安装滑楼梯失败时的动态调整与翻越单个或者几个障碍物相比,爬楼梯要求机器人能够更好地适应环境,以避免由于楼梯台阶长度限制而导致机器人运动若干周期后身体的姿态无法和适应楼梯,导致爬楼梯失败。对于不同尺寸的楼梯,机器人在楼梯上行走时,可能出现腿无法接触到下一级楼梯的情况,发生踩空,进而导致后续的步态无法与楼梯相适应,导致爬楼梯失败。在步态设计中,支撑相的角度可以在一定范围内变化。对于不同长度和高度的楼梯,可以通过改变支撑相的角度,使机器人的运动与楼梯协调。楼梯较长时,通过增加支撑相的角度,使得机器人身体的前端能够接触楼梯,继续完成爬楼梯运动。相反,当楼梯较短时,减小支撑相的角度能确保机器人腿的着地点和楼梯保持协调。3.2温度对机器人可靠墙的影响选取了校园5种不同类型参数的楼梯来测试六足机器人AmphiHex的爬楼梯性能,实验所选楼梯的尺寸及实验结果如表2所示。其中,楼梯的角度为楼梯的高和长的比值的反正切值,机器人爬楼梯的速度为平均每秒钟爬上的楼梯的台阶数。实验中,机器人成功爬上了4种楼梯,机器人能够爬上的楼梯的最大角度为32.3°,机器人在爬22.8°的楼梯时速度最快,为0.3台阶/s。3.3实验结果分析通过对比试验中不同楼梯的尺寸,发机器人能否爬上楼梯主要取决于楼梯台阶的高度,与台阶的长度,倾斜角度和表面情况无关。楼梯台阶过高,机器人的腿处于摆动相时,力臂较长,所需转矩较大,机器人因驱动能力不足而无法爬上楼梯;相反,台阶高度较低时,力臂相对较短,所需转矩较小,