爬杆机器人理论方案设计说明书转载

++ 爬杆机器人理论方案设计说明书学校名称:中国计量学院学生队长:学生队员:指导教师:联系方式:二00五年一月目录一、方案构思---------------------------------------------1二.机械部分---------------------------------------------3三、电控部分---------------------------------------------17四.设计小结---------------------------------------------19一方案构思我们通过三个手臂来抓紧杆件再通过手臂上的电机来实现机器人的爬升和下降。原理上两个就能实现,但三个手臂是一作联结,二可起稳定作用。手臂上升下降是通过齿轮齿条来实现的。二、机械部分1.机器人的整体装配图如下：图1我们是通过三个手臂爬杆的,上手臂装在一个齿条的最上端,并且固定,在具体设计时我们可以使上手臂有一定的上下和左右转动范围,具体的设计将在下面介绍。下手臂装在下杆C上齿条的下端,中间手臂固定在滑槽上,上手臂的上升和下降是通过装在滑槽上端的电动机带动齿轮啮合齿条来实现的.下手臂的上升和下降是通过装在滑槽下端的电动机带动齿轮啮合齿条来实现的,中间手臂的升降是通过上下两对齿轮齿条反转来实现的。2.路面行走结构在地上行走,我们通过装在下手臂上的三个车轮来实现地面上的行走,动力由后车轮上的两个电机来提供,用两个电机主要是为了能实现走弯路,具体的三视图形如下：图2底部车轮结构2机器手臂的设计图3机械手的结构我们设计的这个机器手采用了曲柄滑块机构,A,B,C点处安装了橡胶皮,1,2两点固定在支撑板上,当滑块W向前移动时,根据杆子的结构,A,B,C点将向中心收缩,产生一个收缩的趋势,就抓紧杆件。当滑块W向后移动时,A,B,C点会张开,即松开杆件。再配合机构的移动构件,机械手就能很好的实现上升和下降。在本方案中,由曲柄滑块机构的一系列动作,使机械手实现抱紧松开的动作,机械手的夹紧依靠滑块使3个橡胶皮与构件紧紧地接触。在接触的时间内实现另一个机械手的升降,在松开杆件的时间内实现自身的升降。这两段时间的长度很难控制,可以说光靠电机是不可能实现的。此外考虑到机械手垂直夹紧杆件时支撑板所受的力矩很大,难以锁住杆件,因此可以改变机械手臂与杆件的角度来减小力矩,但角度不能太小,太小的话就会使上升的速度变慢,因此角度应在70——80度之间为好,具体的角度要计算后为准。机械手臂是这个机器人的主体,在这个设计过程中我们花了好多时间查阅了很多资料,最后选用了这个曲柄滑块机构,在设计时我们想了很多,最初设计时觉得比较容易,可是真正设计时碰到了很多困难。其中最主要的问题是如何使手臂按我们要求的实现放开和抓紧,特别是时间上的控制最重要。我们刚开始时想到了凸轮来控制,凸轮能够实现,但是也有缺陷,就是凸轮的设计难度较大,时间上的控制也很难,我大致算了一下,如果我的转速是10r/min,那么转一圈要六秒,那么抓紧的时间是3秒,而放开的时间是1.5秒。那么物体上升的时间很短,难以实现。后来我们确定用电磁铁来控制,电磁铁很容易通过单片机来控制时间,特别是三个手臂之间的协调可以比较准确的控制。可用电磁铁也有缺点,就是电磁铁的磁性会影响单片机的运行,那样就会给电机控制带来问题。但在外面加上一些防磁场的装置就会减少影响。因此最后确定用电磁铁机构,这样在计算少的同时更容易控制时间以及各方面的协调。电磁铁手臂的设计图及连杆机构图图4电磁铁手臂的设计图5连杆机构图电磁铁的工作过程:当在地面行走时,通过单片机控制使手臂全都张开,这样就能在行进后立刻抓住杆件。抓住后就通过编程来控制使手臂,使三个手臂松开和抓紧的循环过程,同时通过电机的转动来实现手臂的上升和下降。具体的过程如下:上手臂中手臂下手臂地面行走过程松开松开松开上手臂上升松开抓紧抓紧中手臂上升抓紧松开抓紧下手臂上升抓紧抓紧松开上手臂上升松开抓紧抓紧表1机械手臂工作的具体过程为了实现抓不同直径的杆件,我们设计了使装在滑块上的两根杆的长度可以通过一个滑杆机构来改变,就是一根杆放在另一个滑筒内,可以抽动来无级改变杆的长度,然后用一个紧固螺钉来夹紧,结构如下:图6滑杆机构但我们设计的手臂不能爬无限杆的直径,它是有一定的范围的,而我们设计的手臂是可以爬升直径40到50毫米的任何杆件,只要调节两根杆的长度就能实现,在这我设计了两个极限位置的杆件,设计如下:考虑到我们设计机器人是从地面滑行的,因此我们手臂张开时要能够抓住杆件,即手臂B,C两点的距离必须大与杆的直径,否则就不能进行下一步的运动。还有我们设计的手臂上的三点,要分别抓在圆的三等分上,这样就能更加抓紧杆件,由于抓不同直径的杆件时,三个橡胶皮运动的距离是不一样的,因此每次都要调节滑块两端杆的长度,使三个橡胶皮能同时和杆件接触抓紧。根据图形我们知道滑块移动的距离就是电磁铁吸引铁块的距离,因此当杆件是40毫米时,滑块移动的距离是17.03毫米,则电磁铁和铁块之间的长度也是17.03毫米,杆1的长度为19.07毫米；当直径是50毫米时滑快移动的距离是5.1毫米,则电磁铁和铁块之间的长度也是5.1毫米,杆1的长度为29.93毫米。具体图形如下：图7图8图9机器人原始、极限状态图图10机器人爬管的四个过程主要任务:攀爬一个垂直距离L=68mm运动过程:1.初始状态——杆A.杆C缩于杆A内至整体呈最短状态,为300mm长;2.第一步运动——杆B.杆C的机械手抓牢攀爬物,杆A的机械手呈松弛状态。由电机通过齿轮齿条啮合的形式,驱动杆A上升一额定距离L=68mm,移动完毕,杆A的机械手抓牢攀爬物,同时,杆B的机械手松开;3、第二步运动——此时,杆A.杆C的机械手抓牢攀爬物,杆B由电机通过绳索拉升一额定距离L=68mm,拉升完毕,杆B的机械手抓牢攀爬物,同时,杆C的机械手松开;4.第三步运动——此时,杆A.杆B的机械手是抓牢攀爬物的,杆C由电机通过齿轮齿条啮合的形式,驱动杆C上升一额定距离L=68mm;5、回复至初始状态,再重复循环第一、二、三步的运动;6、下降过程与理论上与上升步骤相反,故不必再赘述。通过上面的运动步骤,机器人可实现垂直杆件上的攀爬。主要参数:杆A长a=133mm,杆B长b=170mm,杆C长c=a=133mm；驱动杆A的电机转速为n1=48r/min,上拉杆B的电机转速为n2=50r/min,驱动杆C的电机转速为n3=n1=48r/min;与A啮合的的齿轮半径为r1=10mm,拉升杆B的电机的皮带盘的半径为r2=10mm,与C啮合的齿轮半径为r3=10mm,计算步骤:尺寸及其质量机械手质量:1.有机玻璃板架质量(2块)m1=L*w*d*=200*80*mm3*1.4g/cm3=22.4g2.电磁铁质量(2块)m2=d*［(l1+l2)*h-∏*r2］=5*［(40+35)*20-∏*52］mm3*7.6g/cm3=54g3.弹簧质量(1只)m3=1g4、橡胶皮质量(3只）图11立体图及其尺寸m4=v=*r*Θ*d*h=0.95g/cm3*25*(2*10∏/360)*7*20=0.58g5.滑块质量(1只)m5=30g6、连杆质量(5根）m6=(L1+L2+L3+L4+L5)hd=7.8g/cm3*(250*20*3)mm=117g7、联结螺栓螺母质量(7只)m7=2g则一个机械手的质量为M1=2*m1+2*m2+m3+3*m4+m5+5*m6+7*m7=2*22.4+2*54+1+3*0.58+30+117+7*2=316.54g联杆质量图12A杆视图及其尺寸A杆体积Va=V侧+V底铝材(密度2.7g/cm3)=2*(W1+W2+H1+H2)*L*D+2*(10H1+10W2)*2D=2*(78+58+138+118)*28*1+2*2*(10*138+10*58）=29.792cm3质量Ma=2.7*29.792=80.4384g图13B杆的视图及尺寸B杆体积Vb整框V1=117*1*(100+45*2+25*2+10*2+15*2+28*2+80)=49842mm3截空V2=1*117*80*2=18720mm3挡板V3=80*10*1=800mm3则Vb=V1-V2+V3=49842-18720+800=31922mm3=31.922cm3质量Mb=2.7*31.922=86.1894gC杆质量Mc=Ma=80.4384g电机质量:我们共用到4个直流电机,每个电机质量约为35g齿条质量:我们共用到两对齿轮齿条传动每个齿条的质量为m=LWH=(14*118*6)mm3*7.8g/cm3=77.3136gB杆上我们设计其半径为R=1mm,长L=60mm,材质为钢转轴的质量M’=∏R2L=(∏*12*60)mm3*7.8g/cm3=1.4703g(2只)运动计算1.距离L预定一个动作周期的攀爬距离S=68mm(一个周期内)时间T上升过程1.杆A的攀爬时间T1=L/V1,V1=2n∏r1/60(mm/s)=n∏1r1/30(mm/s),则T1=30SL(n1∏r1)=30*68/(80*∏2.杆B的攀爬,由于齿轮齿条的运动与A杆上升时完全相反,故其上升时间为时间T2=T1=1.36s;3.杆C的的个参数与杆A相同,故其攀爬时间与A相等,即T3=1.36s;由以上各段时间相加就是杆每上升完整的一段距离L所用的时间,即总时间T=T1+T2+T3=1.36+1.36+1.36=4.08S,由此可得爬升的平均速度V=L/T=68/4.3=16.67mm/s。下降过程设平均速度为V′,攀爬杆长为P,在杆上时间为T=4min,扣除机器人本身的高度300mm,则实际在杆上攀爬路程为（2P-2*300）mm。下降过程我们有两个方案备选。方案一:采用与上升过程相反的状态,则下降的平均速度V′=V=16.67mm/s,可由2P-2*300=VT=16.67mm/s*4min*60s/min,则可知攀爬杆长P=2300.4mm;方案二：采用下滑的方式,（P-300）/15.81+（P-300）/V′=240假设V′=16.67n,下滑时间为T′则P=240*16.67n/(n+1)+300当n=2时,P=2967.2mm,T′=240/3=80s当n=3时,P=3300.6mm,T′=240/4=60s当n=4时,P=3500.64mm,T′=240/5=48s当n=5时,P=3634mm,T′=240/6=40s.........虽然采用方案二能大大增加机器人的爬升高度,但考虑到下滑速度较快,不稳定因素较多,为保险起见,我们决定采用方案一。有关齿轮齿条传动的计算:齿轮——模数m=1mm齿数z1=20齿顶高系数ha*=1顶隙系数c*=0.25分度圆压力角??0°分度圆直径d=mz=1*20=20mm齿顶圆直径da=m(z+2ha*)=1*(20+2*1)=22mm齿根圆直径df=mz-2m(ha*+c*)=1*20-2*1*(1+0.25)=17.5mm齿条——齿形角??0°齿厚、齿槽宽s=e=∏m/2=∏*1/2=1.57mm齿顶高ha=(ha*+c*)m=(1+0.25)*1=1.25mm齿轮齿条的重合度1=〔20*(tana1-tan)+2ha*/(sin?0°*cos?0°)〕/2∏=〔20*(tanarc(cos20/22)-tan20°）+2*1/(sin?0°*cos?0°)〕/2∏max=1.981完全符合要求电磁铁的吸力计算:图14G为重力G=14.7N,F为电磁铁的吸力,U为摩擦系数U=1.2,F3为最大弹簧弹力F3=2N,W为转距,F1为压力,则F4=F-F3,G=F4*COS10°*U=》F4=G/（COS10°*U),则F=F4+F3=G/(COS10°*U)+F3=14.7/(COS10°*1.2)+2=14.44N因为每次有两根杆是抓紧的,因此每根杆上的吸力为14.44/2=7.22N电磁铁的吸力要大于7.22N。三电机控制部分我们的机器手臂控制是通过单片机来定时来控制电机和电磁铁的通电和断电,具体的时间控制我们通过计算如下行程时间段电动机控制电磁铁控制单位(S）车轮上手臂下手臂上手臂中手臂下手臂地面行程0-28开关关关关关调整过程28-30关关关关开开爬升过程30-132关/////暂停过程132-168关关关开开开下降过程168-270关\\\\\调整过程270-272关关关开开开回程