机电一体化大作业

三自由度平动机械手工作台机电系统设计科目：机电一体化班级：机械工程五班成员：罗欣201325070530卢国文201325070501赵效鲁201325070509贾静然201325070502目录一、设计任务 31、 题目 32、 任务 33、 主参数 3二、产品总功能的确定 41、单坐标定位。 42、三平面直线插补和圆弧插补。 4三、总体方案的确定 71、机械传动部件的选择 72、动力装置的选择 73、.检测与传感装置的选择 84、.控制与信息处理装置的选择 8四、机械传动部件的计算与选型 91、滚珠丝杠螺母副的计算与选型 92、步进电机的计算与选型 12五、检测与传感装置的计算与选型 151、速度的检测与传感装置 15、2.位移的检测与传感装置 17六、控制与信息处理装置的选择 201、 速度控制 202、CPU的选择 26七、工作台系统的功能框图 27八、工作台装配图的绘制 27九、部分源代码 28十、感悟与总结 32十一、参考文献 32

一、设计任务题目三自由度平动机械手工作台机电系统设计任务设计一种适用于机械手空间平动的工作台主参数（1）、X、Y、Z方向脉冲当量：∆x=∆y=∆z（2）、X、Y、Z方向的定位精度均为：±0.01mm（3）、工作台空载最快移动速度：∆xmax=∆ymax=（4）、工作台负载最快移动速度：∆xmax=∆ymax=（5）、工作台空间尺寸：500mm×500mm×500mm（6）、工作台工作空间尺寸：400mm×400mm×400mm（7）、空载启动时间：Δt=25ms二、产品总功能的确定1、单坐标定位。2、三平面直线插补和圆弧插补。本例中采用逐点比较法进行直线和圆弧的插补逐点比较法插补的基本原理逐点比较法插补的基本思路是：在从起点到终点的路程中，根据机械手当前位置与给定轨迹的偏离情况，并为消除这个偏离，在其中一个坐标轴上走一小步，这样一步步直到终点，每一步都是用给定轨迹对实际轨迹进行修正。每一步作为一个插补计算循环。插补循环一般由偏差判别、坐标进给、偏差函数计算和终点判别四个工作节拍组成。=1\*GB3①、偏差判别首先要判断机械手当前点与其要求的运动轨迹的偏离情况。具体方法是根据要求的运动轨迹设计一个偏差函数，该偏差函数是机械手坐标的函数，其函数值反映偏离情况。=2\*GB3②、坐标进给根据上面判断的结果，发出一个进给指令脉冲，控制机械手沿相应坐标轴产生一个脉冲当量的位移。进给脉冲分配给哪一个坐标轴，正向还是负向，总的原则是用这个位移的结果纠正已有的偏离。=3\*GB3③、偏差函数计算用新的机械手位置坐标重新计算偏差函数的值。=4\*GB3④、终点判别判断机械手点是否到达轨迹的终点，如到达轨迹终点则插补结束，否则重复开始下一个插补循环。（2）、逐点比较法直线插补（注：1.本例只介绍直线插补的方法，圆弧插补原理相似2.本例插补平面以水平面为例）为插补计算方便，通常建立与工作台坐标系平行的插补坐标系，插补坐标系与工作台坐标系是简单的平移变换关系。直线插补时，插补坐标原点选在直线起点上。在直线插补指令中，若终点坐标采用增量坐标给出，则与插补坐标系下坐标一致。下面讨论机械手运动轨迹为XOY平面上第一象限直线的插补。如下图所示，直线OA，起点O(0，0)，终点A(Xe,=1\*GB3①、偏差函数将直线OA的方程XY-X改写成YXe-XY设加工时机械手位置为P(Xi,Fi=YiX则当P点在直线上时，Fi=0当P点在直线上方时，Fi>0当P点在直线下方时，Fi<0=2\*GB3②、进给脉冲分配进给脉冲分配应使对应的坐标位移的结果纠正机械手位置P(Xi,Yi)已有的偏离。因此：当P点在直线上方，即Fi>0时，向+X方向分配一个进给脉冲，即向X轴正方向走一步（一个脉冲当量的位移），简记为+ΔX；当P点在直线下方，即Fi<0时，向+Y方向分配一个进给脉冲，即向Y轴正方向走一步，简记为+ΔY；当P点在直线上，即Fi=3\*GB3③、偏差函数的递推计算由上述可知，若Fi≥0，向X轴正方向走一步，则PXi+1=Xi若Fi<0，向Y轴正方向走一步，则PXi+1=Xi采用递推计算式（2-2）、式（2-3）代替式(2-1)计算偏差函数，既可以简化计算，又可以缩短插补时间。=4\*GB3④、终点判别一般常用插补循环或进给的总步数来判断是否到达终点。设插补循环或进给的总步数为E，显然有E=X最简单的方法是每进行一次插补循环，就对E进行一次减1运算，当E等于0时，表明到达终点，插补结束。三、总体方案的确定1、机械传动部件的选择（1）、丝杠螺母副的选择根据设计及参数要求，该传动副能将电机的旋转运动转化为直线运动，且应满足0.005mm的脉冲当量和±0.01mm的定位精度。由于滚珠丝杠螺母副效率高、精度高、响应快等特点，则应选择滚珠丝杠副。（2）、导向机构的选择由于机械手负荷并不大，且工作台脉冲当量小，定位精度高，因此选用直线滚动导轨副。它具有摩擦阻力小、移动效率高、安装预紧方便等特点。（3）、减速装置的选用为圆整脉冲当量，放大电动机的输出转矩，降低运动部件折算到电动机转轴上的转动惯量，需要具有消隙结构的减速装置。因此采用无间隙齿轮传动减速装置。2、动力装置的选择由于直流伺服电动机具有响应迅速、精度和效率高、调速范围宽、负载能力大、控制特性好等特点。因此采用直流伺服电动机。3、.检测与传感装置的选择（1）、电机转速检测装置因增量式旋转编码器在角度测量和角速度测量较绝对式旋转编码器具有更廉价和简易的优势，因此采用增量式旋转编码器。（2）、位移检测装置因为光栅式传感器量程大、精度高，广泛应用于程控、数控机床和三坐标测量的机构体，因此采用光栅式传感器。4、.控制与信息处理装置的选择（1）、电机转速的控制采用晶体管脉宽调制（PWM）调速，这种调速方式有频率高，电流脉动小，电源的功率因数高和动态硬度好等特点。（2）、控制系统的选用=1\*GB3①、CPU的选用为满足任务书给定的相关参数，和对步进电机的半闭环控制，选用MCS-51系列的8位单片机，AT89(52)作为控制系统的CPU。=2\*GB3②、其余辅助装置的选用驱动器、电源开关、存储器、I/D接口电路、A/D转换电路等。注：由于工作台在X、Y、Z三方向的加工范围及工作载荷相近，为减少设计量，X、Y、Z三方向的机械传动、检测与传导装置、控制装置以及电机的选用均相同。四、机械传动部件的计算与选型1、滚珠丝杠螺母副的计算与选型已知平均工作载荷Fm=1300N，丝杠工作长度l=0.5m，平均转速nm=100r/min，最大转速nmax=10000r/min，使用寿命Lh∙=15000h，材料为CrWMn（1）、求计算载荷Fc查表2-6——2-8得：kF=1.2，kH=1.0，k∴Fc=kFkHkAF（2）、计算额定动载荷计算值CaCa´=Fc·3（3）、根据Ca´假设选用Fc1型号，按滚珠丝杠副的额定动载荷Ca等于或稍大于Ca´原则，查表2-9，选用得丝杠副数据为：公称直径Do=20mm，导程P=5mm，螺旋角λ=4°33′，滚珠直径d按课本表2-1中尺寸公式计算：滾道半径R=0.52×do偏心距e=0.07×(R-do2)=0.07×(1.651-3.1752丝杠内径d1=Do+2e-2R=20+2×4.445×10（4）、稳定性验算丝杠危险截面的轴惯性矩Ia=πd1464刚弹性模量E=206GPa，μ为长度系数，即μ=2则丝杠不会发生失稳的最大载荷即临界载荷FcrFcr=π²E安全系数S=FcrFm（5）、刚度校核转矩T=Fm×Do2×所以T=1300×丝杠截面积A=1丝杠的极惯性矩：J丝杠切变模量，钢G=83.3Gp则滚珠丝杠在工作负载和转矩共同作用下每个导程的变形量Δl0Δl0=PFEA+P²·T则丝杠在工作长度上的弹性变形引起的导程误差为：ΔL=l×Δl0通常要求丝杠的导程误差ΔL小于其传动精度的12ΔL<12（6）、效率验算滚珠丝杠副的传动效率η为：η=tanλtan所以经上述计算验证Fc12、步进电机的计算与选型（1）、初选步进电机的型号根据设计任务，要求有脉冲当量δp=0,005mm/脉冲，定位精度为±0.01mm，为满足要求初选电机型号为57HS10042A4，步进角α=1.8（2）、减速器传动比计算I=αP300δp按最小惯量条件，从课本图5-32,5-34查得减速器应采用二级传动。（3）、齿轮减速箱的确定传动比可分别取为i1=2i2=2.5，选各传动齿轮齿数分别为Z1=20，Z2=40，Z3=20，Z4（4）、电动机轴上总当量负载转动惯量计算取坐标等效直径为Φ16mmJZ1=JZ3=π×7.8×103JZ2=π×7.8×103JZ4=π×7.8×103Js=π×7.8×103×将各传动件的转动惯量折算到电动机轴上，得当量负载转动惯量：Jd=JZ1+1i2(JZ2=7.84×10-4+125×(0.0125+0.0306)+1=5.75×10-5㎏·m（4）、惯量匹配验算电动机转动惯量Jm=6.8×10-5㎏·Jd即满足14≤（5）、步进电机负载能力校验步进电机轴上得总惯量:J=Jm+Jd=5.75×10-5+6.8×10-5空载启动时，电动机上的惯性转矩：Tj=J×S=J×2πip×WmaxΔt=1.255×10电动机轴上的当量摩擦转矩：Tμ=P2πηi×mg·μ=0.005其中，设进给传动链的总效率η=0.8，因预紧力而引起的折算到电动机轴上的当量摩擦转矩为：To=P2πηi×Fo×(1-η2)=P2πηi×Fwmax2×(1-=0.020N·m，工作台上的最大载荷折算到电动机轴上的负载转矩为：Tw=P2πηi所以空载启动时，电动机轴上的总负载转矩为：Tq=Tj+Tμ在最大外载荷工作时，电动机轴上的总负载转矩为：Tl=Tw+Tμ查表5-5得恐再启动时所需电动机最大静转矩为：Ts1=Tq在最大外载荷下工作时所需电动机最大静转矩为：Ts=Tl所选电动机最大静转矩Ts∵Ts>Ts1∴步进电动机可不失步的正常启动。开环工作台机械传动的框图如下所示：指令指令驱动电动机减速器丝杠工作台位置五、检测与传感装置的计算与选型1、速度的检测与传感装置（1）、采用增量式旋转编码器，组装在电动机的尾部转轴上，用来检测电动机的转角和转速。增量式旋转编码器应与步进电机的步矩角相匹配，所选电动机步距角α=1.8°，可知电机转动一转时需要控制系统发出360°1.8°=200个脉冲。考虑到编码器输出的A、本例选择编码器的型号为2k-A-60-05v0-10-H，盘状空心型，孔径10mm，电源电压±5v，每转输出50个A/B脉冲，信号为电压输出。（2）增量式旋转编码器的应用适应带加减计数要求的可逆计数器，形成加计数脉冲和减计数脉冲（3）、增量式旋转编码器检测系统的组成：增量式旋转编码器增量式旋转编码器放大器整形电路四细分电路脉冲当量变换电路计数器寄存器计算机辩向电路、2.位移的检测与传感装置（1）、本例中采用光栅式传感器来测量线位移，使用四细分技术使检测分辨率提高四倍。所选电机的步矩角为α=1.8°，所以电机转一转需检测系统发出360°1.8°=200个脉冲。因此所选的光栅式传感器应与所选用的电机相匹配，即选用刻线密度为50（2）透射式长光栅检测装置的结构防护垫2-光栅读数头3-标尺光栅1-光源2-准直镜3-指示光栅4-光敏4-防护罩元件5-驱动线路（3）透射式长光栅传感器的工作原理莫尔条纹：严格来说：横向莫尔条纹排列的方向是两片光栅线纹夹角的平分线相垂直。莫尔条纹的特征：莫尔条纹的变化规律：两片两光栅相对移过一个栅距，莫尔条纹移过一个条纹间距。由于光的衍射和干涉作用，莫尔条纹的变化规律近似正（余）弦函数，变化周期数与两光栅相对移过的栅距数同步。放大作用：莫尔条纹宽度W和光栅栅距d，栅线夹角θ之间关系：由图可知W=dsinθ又θ很小可认为sinθ≈θ故W=d/θ(4)莫尔条纹的细分技术（5）、光栅式传感器检测系统的组成：光栅式传感器光栅式传感器放大器整形电路四细分电路脉冲当量变换电路计数器寄存器计算机辩向电路六、控制与信息处理装置的选择速度控制本例中采用晶体管脉宽调制PWM调速系统对电机转速进行控制。对速度控制的要求准停控制分度控制恒线速度控制（2）、晶体管脉宽调制PWM调速系统1）直流脉宽调制功率放大器中的大功率晶体管工作在开关状态下，开关频率保持恒定，用调整开关周期内晶体管导通时间（即改变基极调制脉冲宽度）的方法来改变输出。从而使电机获得脉宽受调制脉冲控制的电压脉冲，由于频率高及电感的作用则为波动很小的直流电压（平均电压）。脉宽的变化使电机电枢的直流电压随着变化。直流脉宽调制的基本原理脉宽调制器同向加法放大器电路图：USr–速度指令转化过来的直流电压U△-三角波USC-脉宽调制器的输出（USr+U△）调制波形图:开关功率放大器主回路：可逆H型双极式PWM开关功率放大器电路图:由四个大功率晶体管（GTR）T1、T2、T3，T4及四个续流二极管组成的桥式电路。H型：又分为双极式、单极式和受限单极式三种。Ub1、Ub2，Ub3，Ub4–为调制器输出，经脉冲分配、基极驱动转换过来的脉冲电压。分别加到T1、T2、T3、T4的基极工作原理T1和T4同时导通和关断，其基极驱动电压Ub1=Ub4。T2和T3同时导通和关断，基极驱动电压Ub2=Ub3=–Ub1。以正脉冲较宽为例，既正转时。负载较重时：①电动状态：当0≤t≤t1时，Ub1、Ub4为正，T1和T4导通；Ub2、Ub3为负，T2和T3截止。电机端电压UAB=US，电枢电流id=id1，由US→T1→T4→地。②续流维持电动状态：在t1≤t≤T时，Ub1、Ub4为负，T1和T4截止；Ub2、Ub3变正，但T2和T3并不能立即导通，因为在电枢电感储能的作用下，电枢电流id=id2，由D2→D3续流，在D2、D3上的压降使T2、T3的c-e极承受反压不能导通。UAB=-US。接着再变到电动状态、续流维持电动状态反复进行，如上面左图。负载较轻时：③反接制动状态，电流反向：②状态中，在负载较轻时，则id小，续流电流很快衰减到零，即t=t2时（见上面右图），id=0。在t2～T区段，T2、T3在US和反电动势E的共同作用下导通，电枢电流反向，id=id3由US→T3→T2→地。电机处于反接制动状态。④电枢电感储能维持电流反向：在T～t3区段时，驱动脉冲极性改变，T2、T3截止，因电枢电感维持电流，id=id4，由D4→D1。⑤电机正转、反转、停止：由正、负驱动电压脉冲宽窄而定。当正脉冲较宽时，既t1>T/2，平均电压为正，电机正转；当正脉冲较窄时，既t1<T/2，平均电压为负，电机反转；如果正、负脉冲宽度相等，t1=T/2，平均电压为零，电机停转。⑥电机速度的改变：电枢上的平均电压UAB越大，转速越高。它是由驱动电压脉冲宽度决定的。(6)PWM调速系统的特点①频带宽、频率高：晶体管“结电容”小，开关频率远高于可控（50Hz)，可达2-10KHz。快速性好。电流脉动小：由于PWM调制频率高，电机负载成感性对电流脉动有平滑作用，波形系数接近于1。电源的功率因数高:SCR系统由于导通角的影响，使交流电源的波形畸变、高次谐波的干扰，降低了电源功率因数。PWM系统的直流电源为不受控的整流输出，功率因数高。④动态硬度好:较正瞬态负载扰动能力强，频带宽，动态硬度高。2、CPU的选择（1）、A789（52）单片机的原理图（2）、A789（52）单片机的作用=1\*GB3①、作为系统的总控制器，发出指令脉冲。=2\*GB3②、处理速度和位移传感器的反馈信息，实现对系统的闭环控制。七、工作台系统的功能框图指令指令单片机驱动器直流步进电机减速器丝杠工作台增量式旋转编码器位置光栅传感器八、工作台装配图的绘制九、部分源代码#include<reg52.h>sbitpls1=P1^0;sbitdir1=P1^1;sbiten1=P1^2;sbitpls2=P1^3;sbitdir2=P1^4;sbiten2=P1^5;sbitpls3=P2^0;sbitdir3=P2^1;sbiten3=P2^2;#defineN1voidmaichong(intZ,intx,inty);voiddelay(intz);voidmain(){intz=400;en1=1;en2=1;en3=1;while(1){maichong(400,1,0);maichong(400,1,1);maichong(400,2,0);maichong(400,2,1);maichong(400,3,0);maichong(400,3,1);maichong(400,3,1);maichong(400,3,0);maichong(400,2,1);maichong(400,2,0);maichong(