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

爬杆机器人理论 方案 气瓶 现场处置方案 .pdf气瓶 现场处置方案 .doc见习基地管理方案.doc关于群访事件的化解方案建筑工地扬尘治理专项方案下载 设计说明书 ++ 学校名称： 中国计量学院 学生队长： 学生队员： 指导教师： 联系方式： 0 0 第1页 共 18 页 目录 一．方案构思---------------------------------------------1 机械部分---------------------------------------------3 三. 电控部分---------------------------------------------17 四．设计小结---------------------------------------------19 第2页 共 18 页 我们通过三个手臂来抓紧杆件再通过手臂上的电机来实现机器人的爬升和下降。 原理上两个就能实现,但三个手臂是一作联结,二可起稳定作用。手臂上升下降是通过齿 轮齿条来实现的。 ．机器人的整体装配图如下： 图1 我们是通过三个手臂爬杆的，上手臂装在一个齿条的最上端，并且固 第3页 共 18 页 定，在具体设计时我们可以使上手臂有一定的上下和左右转动范围,具体的设计将在下面介绍。下手臂装在下杆C上齿条的下端,中间手臂固定在滑槽 上,上手臂的上升和下降是通过装在滑槽上端的电动机带动齿轮啮合齿条 来实现的.下手臂的上升和下降是通过装在滑槽下端的电动机带动齿轮啮 合齿条来实现的,中间手臂的升降是通过上下两对齿轮齿条反转来实现的。 2 在地上行走，我们通过装在下手臂上的三个车轮来实现地面上的行走，动力由后 车轮上的两个电机来提供，用两个电机主要是为了能实现走弯路，具体的三视图形如下： 图2 底部车轮结构 第4页 共 18 页 2 机器手臂的设计 图3 机械手的结构 我们设计的这个机器手采用了曲柄滑块机构，A，B，C点处安装了橡胶皮，1，2两点固定在支撑板上，当滑块W向前移动时，根据杆子的结构， A，B，C点将向中心收缩，产生一个收缩的趋势，就抓紧杆件。当滑块W向后移动时，A，B，C点会张开，即松开杆件。再配合机构的移动构件， 机械手就能很好的实现上升和下降。 在本方案中，由曲柄滑块机构的一系列动作，使机械手实现抱紧松开 的动作，机械手的夹紧依靠滑块使3个橡胶皮与构件紧紧地接触。在接触 的时间内实现另一个机械手的升降，在松开杆件的时间内实现自身的升降。 这两段时间的长度很难控制，可以说光靠电机是不可能实现的。此外考虑到机械手垂直夹紧杆件时支撑板所受的力矩很大，难以锁住杆件，因此可 以改变机械手臂与杆件的角度来减小力矩，但角度不能太小，太小的话就 第5页 共 18 页 会使上升的速度变慢，因此角度应在70——80度之间为好，具体的角度要 计算后为准。 机械手臂是这个机器人的主体，在这个设计过程中我们花了好多时间查 阅了很多资料，最后选用了这个曲柄滑块机构，在设计时我们想了很多， 最初设计时觉得比较容易，可是真正设计时碰到了很多困难。 其中最主要的问题是如何使手臂按我们要求的实现放开和抓紧，特别是 时间上的控制最重要。我们刚开始时想到了凸轮来控制，凸轮能够实现， 但是也有缺陷，就是凸轮的设计难度较大，时间上的控制也很难，我大致 算了一下，如果我的转速是10r/min ，那么转一圈要六秒，那么抓紧的时 间是3秒，而放开的时间是1.5秒。那么物体上升的时间很短，难以实现。 后来我们确定用电磁铁来控制，电磁铁很容易通过单片机来控制时间， 特别是三个手臂之间的协调可以比较准确的控制。可用电磁铁也有缺点， 就是电磁铁的磁性会影响单片机的运行，那样就会给电机控制带来问题。 但在外面加上一些防磁场的装置就会减少影响。因此最后确定用电磁铁机 构，这样在计算少的同时更容易控制时间以及各方面的协调。 第6页 共 18 页 电磁铁手臂的设计图及连杆机构图 4电磁铁手臂的设计 5连杆机构图 电磁铁的工作过程：当在地面行走时，通过单片机控制使手臂全都张开， 这样就能在行进后立刻抓住杆件。抓住后就通过编程来控制使手臂，使三 个手臂松开和抓紧的循环过程，同时通过电机的转动来实现手臂的上升和 下降。具体的过程如下： 第7页 共 18 页 上手臂 中手臂 下手臂 地面行走过程 松开 松开 松开 上手臂上升 松开 抓紧 抓紧 中手臂上升 抓紧 松开 抓紧 下手臂上升 抓紧 抓紧 松开 上手臂上升 松开 抓紧 抓紧 1 机械手臂工作的具体过程 为了实现抓不同直径的杆件，我们设计了使装在滑块上的两根杆的长 度可以通过一个滑杆机构来改变，就是一根杆放在另一个滑筒内，可以抽 动来无级改变杆的长度，然后用一个紧固螺钉来夹紧，结构如下： 6 滑杆机构 但我们设计的手臂不能爬无限杆的直径，它是有一定的范围的，而我 们设计的手臂是可以爬升直径40到50毫米的任何杆件，只要调节两根杆 的长度就能实现，在这我设计了两个极限位置的杆件，设计如下： 考虑到我们设计机器人是从地面滑行的，因此我们手臂张开时要能够 抓住杆件，即手臂B，C两点的距离必须大与杆的直径，否则就不能进行 下一步的运动。还有我们设计的手臂上的三点，要分别抓在圆的三等分上， 这样就能更加抓紧杆件，由于抓不同直径的杆件时，三个橡胶皮运动的距 离是不一样的，因此每次都要调节滑块两端杆的长度，使三个橡胶皮能同 第8页 共 18 页 时和杆件接触抓紧。根据图形我们知道滑块移动的距离就是电磁铁吸引铁 块的距离，因此当杆件是40毫米时，滑块移动的距离是17.03毫米，则电磁铁和铁块之间的长度也是17.03毫米，杆1 的长度为19.07毫米；当直径是50毫米时滑快移动的距离是5.1毫米，则电磁铁和铁块之间的长度也 是5.1毫米，杆1的长度为29.93毫米。具体图形如下： 7 8 第9页 共 18 页 9 机器人原始、极限状态图 第10页 共 18 页 图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; 第11页 共 18 页 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*mm?*1.4g/cm?=22.4g 2、电磁铁质量（2块） m2=d*［(l1+l2)* h-?*r?］=5*［(40+35)*20-?*5?］mm?*7.6 g/cm?=54g 3、弹簧质量（1只） m3=1g 4、橡胶皮质量（3只） 第12页 共 18 页 m4=v=*r*Θ*d*h=0.95 g/cm?*25*(2*10?/360)*7*20=0.58g 5、滑块质量（1只） m5=30g 6、连杆质量（5根） m6=(L1+L2+L3+L4+L5 )hd=7.8 g/cm?*(250*20*3)mm=117g 7、联结螺栓螺母质量(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 第13页 共 18 页 , 联杆质量 A杆 体积Va=V侧+V底 铝材（密度2.7 g/cm?） =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.792cm? 质量Ma=2.7*29.792=80.4384g 第14页 共 18 页 B杆 体积Vb 整框V1=117*1*(100+45*2+25*2+10*2+15*2+28*2+80)=49842 mm? 截空 V2=1*117*80*2=18720 mm? 挡板 V3=80*10*1=800mm? 则Vb= V1- V2+ V3=49842-18720+800=31922 mm?=31.922 cm? 质量 Mb=2.7*31.922=86.1894g C杆 质量Mc=Ma=80.4384g , 电机质量：我们共用到4个直流电机，每个电机质量约为35g , 齿条质量：我们共用到两对齿轮齿条传动 每个齿条的质量为 m=LWH=(14*118*6) mm?*7.8 g/cm?=77.3136g , B杆上 我们设计其半径为R=1mm, 长L=60mm,材质为钢 转轴的质量 M’=?R?L=(?*1?*60) mm?*7.8 g/cm?=1.4703g (2只) , 预定一个动作周期的攀爬距离 S=68mm 第15页 共 18 页 (一个周期内) 1、 杆A的攀爬时间T1=L/V1，V1=2n?r1/60(mm/s)=n?1r1/30(mm/s) , 则T1=30SL(n1?r1)=30*68/(80*?*6)=1.352817016s,取T1=1.36s ； 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 齿轮齿条的重合度 , ,=〔20*（tana1-tan）+2ha*/(sin,0 ?*cos,0 ?)〕/2 ? ,,1, =〔20*（tanarc(cos20/22)-tan20?）+2*1/(sin,0 ?*cos,0 ?)〕/2? =1.290530458<,max=1.981 完全符合要求 第16页 共 18 页 , G 为重力 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 关 \ \ \ \ \ 第17页 共 18 页 调整过程 270-272 关 关 关 开 开 开 回程 272-300 开 关 关 关 关 关 进程 时间段 电动机控制 电磁铁的控制 单位（S） 上手臂 下手臂 上手中手下手 臂 臂 臂 上手臂上升 0-1.36 开（正） 关 关 开 开 中手臂上升 1.36-2.73（1.36） 开（反） 开（反） 开 关 开 下手臂上升 2.73—4.08（1.36） 关 开（正） 开 开 关 下手臂下降 0-1.36 关 开（反） 开 开 关 中手臂下降 1.36-2.73（1.36） 开（正） 开（正） 开 关 开 上手臂下降 2.73-4.08（1.36） 开（反） 关 关 开 开 ：手臂的电动机正转是使本身手臂上升的状态，反转则是与其相反的 转动。这是按我们的要求设计的。 虽然我们完全可以通过单片机来控制时间，可是我们为了防止在中途出现我们没有遇到的问 题，因此我们有加入了一些优先级，通过遥控来控制或者用电线直接控制。 具体的手臂爬升编程如下： P1.0控制上手臂的电机正转 P1.4 控制上手臂的电磁铁 P1.1控制上手臂的电机反转 P1.5 控制中手臂的电磁铁 P1.2控制下手臂的电机正转 P1.6 控制下手臂的电磁铁 P1.3控制下手臂的电机反转 我们选用方式一，T0来定时，晶振是6MHZ，则T=2us 定时1.36S 20个循环周期 则单个定时时间1.36/20=0.068S， 定时初值X=M-定时值/T=65536-68000/2=31536=7B2CH 杆顶暂停时间?T=36S 500个循环周期 则单个定时时间36/500=0.072S， 定时初值X=M-定时值/T=65536-72000/2=29536=7360H 第18页 共 18 页