X-Y数控工作台机电系统设计-数控系统总体方案设计

第 1 页 共 25 页1、引言现代科学技术的不断发展，极大地推动了不同学科的交叉与渗透，导致了工程领域的技术革命与改造。在机械工程领域，由于微电子技术和计算机技术的迅速发展及其向机械工业的渗透所形成的机电一体化，使机械工业的技术结构、产品机构、功能与构成、生产方式及管理体系发生了巨大变化，使工业生产由“机械电气化”迈入了“机电一体化”为特征的发展阶段。其中 X-Y 数控工作台及其控制系统就是一个典型的机电一体化系统，而本文所设计的X-Y 数控工作台及其控制系统机电系统设计是一个开环控制系统,其结构简单。实现方便而且能够保证一定的精度。降低成本,是微机控制技术的最简单的应用。它充分的利用了危机的软件硬件功能以实现对机床的控制;使机床的加工范围扩大 ,精度和可靠性进一步得到提高。X-Y 数控工作台机电系统设计是利用 8031 单片机,及 2764,6264 存储器及 8155 芯片等硬件组成,在控制系统的硬件上编写一定的程序以实现一定的加工功能。2、数控系统总体方案设计2.1 设计任务设计一个数控 X-Y 工作台及其控制系统。该工作台可用于铣床上坐标孔的加工和腊摸、塑料、铝合金零件的二维曲线加工，重复定位精度为0.01mm，定位精度为 0.025mm。设计参数如下：负载重量 G=150N；台面尺寸 CBH145mm160mm12mm；底座外形尺寸 C1B1H1 210mm220mm140mm；最大长度 L=388mm； 工作台加工范围 X=55mm，Y=50mm；工作台最大快移速度为 1.5m/min。2.2 总体方案确定（1）系统的运动方式与伺服系统由于工件在移动的过程中没有进行切削，故应用点位控制系统。定位方式采用增量坐标控制。为了简化结构，降低成本，采用步进电机开环伺服系统驱动 X-Y 工作台。（2）计算机系统X-Y 数控工作台机电系统设计是利用 8031 单片机,及 2764,6264 存储器及 8155 芯片等硬件组成,在控制系统的硬件上编写一定的程序以实现一定的加工功能.其基本思想是:通过圆弧或者直线插补程序以实现对零件进行几何加工,每进行一段加工都要产生一定的脉冲以驱动电机正反转,同时通过 8155(1)将相应的加工进刀信息送至刀架库中以实现以之相应的走刀 ,第 2 页 共 25 页电机和刀具的相对运动所以实现了刀具对工件的加工。 本设计采用了与 MCS-51 系列兼容的 AT89S51 单片机控制系统。它的主要特点是集成度高，可靠性好，功能强，速度快，有较高的性价比。控制系统由微机部分、键盘、LED、I/O 接口、光电偶合电路、步进电机、电磁铁功率放大器电路等组成。系统的加工程序和控制命令通过键盘操作实现。LED 显示数控工作台的状态。（3）X-Y 工作台的传动方式为保证一定的传动精度和平稳性，又要求结构紧凑，所以选用丝杠螺母传动副。为提高传动刚度和消除间隙，采用预加负荷的结构。由于工作台的运动载荷不大且要求结构简单，因此采用有预加载荷的圆形滚珠导轨。采用滚珠导轨可减少两个相对运动面的动、静摩擦系数之差，从而提高运动平稳性，减小振动。考虑电机步距角和丝杆导程只能按标准选取，为达到分辨率的要求，需采用齿轮降速传动。图 2-1 系统总体框图3、机械系统设计机械部分设计内容包括：确定系统脉冲当量，运动部件惯性的计算，选择步进电机，传动及导向元件的设计、计算与选择，绘制机械部分装配图等。脉冲当量 p是一个进给指令时工作台的位移量，应小于等于工作台的位置精度，由于定位精度为0.01mm 因此选择脉冲当量为 0.01mm。3.1、工作台外形尺寸及重量估算第 3 页 共 25 页3-1 工作台简图取 X 向导轨支撑钢球的中心距为 145mm,Y 向导轨支撑钢球的中心距为 160mm,设计工作台简图如下:X 向拖板（上拖板）尺寸：长 宽 高 14516050重量：按重量=体积材料比重估算NXW321456017.809Y 向拖板（下拖板）尺寸： 4516N32.上导轨座（连电机）重量： 223(201482158)7.10.107()N夹具及工件重量：约 150N 。X-Y 工作台运动部分的总重量：约 437N。3.2、滚动导轨副的计算与选择根据给定的工作台运动部件的总重量及负载和估算的 和 计算导轨的静安全XWY系数 =C0/P，式中：C0 为导轨的基本静额定载荷 ；工作载荷 P=0.5( +W)； SLf KNZF=1.03.0(一般运行状况)， 3.05.0（运动时受冲击、振动） 。根据计算结果查有关资料初Sf选导轨：因系统受中等冲击,因此取 ，4.0sLfFz4372815第 4 页 共 25 页, ,0.5()OSLXYZCfPFWNPfCYSLOXslZY1054.2634.26397.根据计算额定静载荷初选导轨:、导轨型式：圆形截面滚珠导轨、导轨长度上导轨（X 向）取动导轨长度 10Bl动导轨行程 5支承导轨长度 BLl下导轨（Y 向）50l10Bl1选择导轨的型号：GTA16 、直线滚动轴承的选型上导轨 240()XGN下导轨的 Y37由于本系统负载相对较小，查表后得出 LM10UUOP 型直线滚动轴承的额定动载荷为437N，大于实际动负载；但考虑到经济性等因素最后选择 LM16UUOP 型直线滚动轴承。并采用双排两列 4 个直线滚动轴承来实现滑动平台的支撑。、滚动导轨刚度及预紧方法 当工作台往复移动时，工作台压在两端滚动体上的压力会发生变化，受力大的滚动体变形大，受力小的滚动体变形小。当导轨在位置时，两端滚动体受力相等，工作台保持水平；当导轨移动到位置或时，两端滚动体受力不相等，变形不一致，使工作台倾斜 角，由此造成误差。此外，滚动体支承工作台，若工作台刚度差，则在自重和载荷作用下产生弹第 5 页 共 25 页性变形，会使工作台下凹（有时还可能出现波浪形） ，影响导轨的精度。3.3、滚珠丝杠的设计计算滚珠丝杠的负荷包括铣削力及运动部件的重量所引起的进给抗力。应按铣削时的情况计算。、最大动负载 Q 的计算3HLfP查表得系数 ， ，寿命值1f60nT查表得使用寿命时间 T=15000h，初选丝杠螺距 t=4mm，得丝杠转速min3754.101maxrtV所以 .537606LX 向丝杠牵引力1.4xxPfG当 ()f当 当 量 摩 擦 系 数023.9()NY 向丝杠牵引力=1.414 =1.4140.01437=6.18P当fYN所以最大动负荷X 向 6.2039.1253xQY 向 = 11 6.18=37.60Y 查表，取滚珠丝杠公称直径 ，选用滚珠丝杠螺母副 01dm的型号为 SFK1004，其额定动载荷为 390N，足够用。、滚珠丝杠螺母副几何参数计算表 3-1 滚珠丝杠螺母副几何参数第 6 页 共 25 页名 称 符 号 计算公式和结果公称直径 0d10螺距 t4接触角 5钢球直径 q2螺纹滚道法面半径 R0.1.4qd偏心距 e/sin0.3螺纹滚道螺纹升角 0arc726tg螺杆外径 d.59.qdd螺杆内径 l 08leR螺杆螺杆接触直径 z cos.zq螺母螺纹外径 D2102螺母 螺母内径（外循环） 110.5.qdd见表 3-1。、传动效率计算 7.260.973()()tgt式中： 摩擦角； 丝杠螺纹升角。、刚度验算滚珠丝杠受工作负载 P 引起的导程 的变化量0LEFL01Y 向所受牵引力大，故应用 Y 向参数计算NPQ76.30.4()Lcm2201(/)cm材 料 为 钢2.798340.5FRc第 7 页 共 25 页所以 cmL661 108.5.0.237丝杠因受扭矩而引起的导程变化量 很小，可以忽略。L所以导程总误差 uL8.4018.106查表知 E 级精度的丝杠允许误差 ，故刚度足够。5m、稳定性验算由于丝杠两端采用止推轴承，故不需要稳定性验算。3.4、步进电机的选用、步进电机的步距角 b取系统脉冲当量 ，初选步进电机步距角 。0.1/pmstep1.5b、步进电机启动力矩的计算设步进电机等效负载力矩为 T，负载力为 P，根据能量守恒原理，电机所做的功与负载力做功有如下关系 s式中： 电机转角； 移动部件的相应位移； 机械传动效率。s若取 ，则 ，且 ，所以bpSPGNmuGPTbS236式中： 移动部件负载（N） ；G移动部件重量（N） ； 与重量方向一致的S zP作用在移动部件上的负载力（N） ； 导轨摩擦系数； 步进电机步距角，b（rad） ；T电机轴负载力矩（Nm）本例中，取 （淬火钢滚珠导轨的摩擦系数） ， ， 为丝杠牵引力，0.30.96S第 8 页 共 25 页。考虑到重力影响，Y 向电机负载较大，因此取 =437N，所以NPHs7.24 GY=TNm102.30.96154732.362-若不考虑启动时运动部件惯性的影响，则启动力矩 .qT取安全系数为 0.3，则 Nq63.01322对于工作方式为三相六拍的三相步进电机mTqj 67.8.max、步进电机的最高工作频率 HzVfF2501.601axmax查表选用两个 45BF005-型步进电机。电机的有关参数见表 3-2。表 3-2 步进电机参数主要技术数据 外形尺寸 ()m型 号 步距角最 大 静转 距NcmA最 高 空载 启 动频 率 ()/step相数电压 ()V电流 A外径 长度 轴径重量(N45BF005-15 19.6 3000 3 27 2.5 45 58 4 113.5、确定齿轮传动比因步进电机步距角 ，滚珠丝杠螺距 ，要实现脉冲当量1.5b 4tm，在传动系统中应加一对齿轮降速传动。齿轮传动比0.1/pmstep第 9 页 共 25 页12360.1360.54pbZit选 17Z， 28。 3.6、确定齿轮模数及有关尺寸因传递的扭距较小，取模数 ，齿轮有关尺寸见表 3-3。1m表 3-3 齿轮尺寸3.7、步进电机惯性负载的计算根据等效转动惯量的计算公式，得17 28171914.55 283025.55dm2a1.5f36bm12da17.5第 10 页 共 25 页22103180pd bZJJM式中： 折算到电机轴上的惯性负载（ ） ； 步进电机转轴的转动d 2Kgcm0J惯量（ ） ； 齿轮 的转动惯量（ ） ； 齿轮 的转动惯量（2Kgcm1J 2） ； 滚珠丝杠的转动惯量（ ） ；M移动部件质量（ ） 。3 2ckg对材料为钢的圆柱零件转动惯量可按下式估算 2431078.KgmLDJ式中：D圆柱零件直径（cm） ；L零件长度（cm） 。所以 23431 1026.5. kgcJ 2 98207Km23433 .1. cJ电机轴转动惯量很小，可以忽略，则 23 37.260.9108d 2524.5.18043Kgm因为 ，所以惯性匹配比较符合要求。0.319.27dMJ4、控制系统硬件设计第 11 页 共 25 页X-Y 数控工作台控制系统硬件主要包括 CPU、传动驱动、传感器、人机交互界面。硬件系统设计时，应注意几点：电机运转平稳、响应性能好、造价低、可维护性、人机交互界面可操作性比较好。4.1 CPU 板4.1.1 CPU 的选择随着微电子技术水平的不断提高，单片微型计算机有了飞跃的发展。单片机的型号很多，而目前市场上应用 MCS-51 芯片及其派生的兼容芯片比较多，如目前应用最广的 8 位单片机89C51，价格低廉，而性能优良，功能强大。在一些复杂的系统中就不得不考虑使用 16 位单片机，MCS-96 系列单片机广泛应用于伺服系统，变频调速等各类要求实时处理的控制系统，它具有较强的运算和扩展能力。但是定位合理的单片机可以节约资源，获得较高的性价比。从要设计的系统来看，选用较老的 8051 单片机需要拓展程序存储器和数据存储器，无疑提高了设计价格，而选用高性能的 16 位 MCS-96 又显得过于浪费。生产基于 51 为内核的单片机的厂家有 Intel、ATMEL、Simens，其中在 CMOS 器件生产领域 ATMEL 公司的工艺和封装技术一直处于领先地位。ATMEL 公司的 AT89 系列单片机内含 Flash 存储器，在程序开发过程中可以十分容易的进行程序修改，同时掉电也不影响信息的保存；它和 80C51插座兼容，并且采用静态时钟方式可以节省电能。因此硬件 CPU 选用 AT89S51，AT 表示 ATMEL 公司的产品，9 表示内含 Flash 存储器，S 表示含有串行下载 Flash 存储器。AT89S51 的性能参数为：Flash 存储器容量为 4KB、16 位定时器 2 个、中断源 6 个（看门狗中断、接收发送中断、外部中断 0、外部中断 1、定时器 0 和定时器 1 中断） 、RAM 为128B、 14 位的计数器 WDT、I/O 口共有 32 个。4.1.2 CPU 接口设计CPU 接口部分包括传感器部分、传动驱动部分、人机交互界面三部分。示意图如下所示：第 12 页 共 25 页（行程开关）前向通道传动驱动（电磁铁）（步进电机）人机界面传 感 器 AT89S51（键盘、LED）后向通道图 4-1 CPU 外部接口示意图AT89S51 要完成的任务：（1）将行程开关的状态读入 CPU，通过中断进行处理，它的优先级别最高。（2）通过程序实时控制电机和电磁铁的运行。（3）接受键盘中断指令，并响应指令，将当前行程开关状态和键盘状态反应到 LED 上，实现人机交互作用。由于 AT89S51 只有 P1 口和 P3 口是准双向口，但 P3 口主要以第二功能为主，并且在系统中要用到第二功能的中断口，因此要进行 I/O 扩展。考虑到电路的简便性和可实现性，实际中采用内部自带锁存器的 8155，所以 AT89S51 的 I/O 口线分配如下：（1）P1.0-P1.5 控制 X-Y 两个方向步进电机的 A、B 、C 线圈通电，形成 A-AB-B-BC-C-CA-A 三相六拍正转模式和 A-AC-C-CB-B-BA-A 的反转模式。（2）P1.6 口输出控制电磁铁的吸合。（3）P3.2 和 P3.3 两个中断源中 INT0 优先级最高，它读入行程开关的状态并触发中断；INT1 读入点动、复位、圆弧插补开关的状态而触发中断。（4）P0.0-P0.7 外部 I/O 扩展的数据读取。（5）P2.7 和 P2.6 决定 8155 的 PA、PB、PC 口的地址。第 13 页 共 25 页P1.0-P1.2驱动 1X 步进电机驱动 2Y 步进电机 P1.3-P1.5P1.6驱动 3P3.2外部中断 1P3.3外部中断 2P0.0-P0.7 AD0AD7P2.7 CEP2.6 IO/MPB 口PA 口PC 口AT89S51键盘电磁铁8155图 4-2 AT89S51 控制系统图PB 口接 LED 反映当前运行的 8 个状态：X+禁止、X-禁止、Y+禁止、Y-禁止、手动X+运行、手动 X-运行、手动 Y+运行、手动 Y-运行。PA 口低四位反映触发中断 1 的 4 个行程开关的状态。PC 口低 6 位反映了触发中断 2 的手动 X+运行、手动 X-运行、手动 Y+运行、手动 Y-运行、复位（RST ） 、圆弧插补 6 个开关的状态。4.2 驱动系统设计传动驱动部分包括步进电机的驱动和电磁铁的驱动，步进电机须满足快速急停、定位和退刀时能快速运行、工作时能带动工作台并克服外力（如切削力、摩擦力）并以指令的速度运行。在定位和退刀时电磁铁吸合使绘笔抬起，绘图时能及时释放磁力使笔尖压下。4.2.1 步进电机驱动电路和工作原理步进电机的速度控制比较容易实现，而且不需要反馈电路。设计时的脉冲当量为0.01mm，步进电机每走一步，工作台直线行进 0.01mm。步进电机驱动电路中采用了光电偶合器，它具有较强的抗干扰性，而且具有保护 CPU的作用，当功放电路出现故障时，不会将大的电压加在 CPU 上使其烧坏。第 14 页 共 25 页图 4-3 步进电机驱动电路图该电路中的功放电路是一个单电压功率放大电路，当 A 相得电时，电动机转动一步。电路中与绕组并联的二极管 D 起到续流作用，即在功放管截止是，使储存在绕组中的能量通过二极管形成续流回路泄放，从而保护功放管。与绕组 W 串联的电阻为限流电阻，限制通过绕组的电流不至超过额定值，以免电动机发热厉害被烧坏。由于步进电机采用的是三相六拍的工作方式（三个线圈 A、B、C） ，其正转的通电顺序为：A-AB-B-BC-C-CA-A，其反转的通电顺序为：A-AC-C-CB-B-BA-A。步进时钟A 相波形B 相波形C 相波形图 4-4 三相六拍工作方式时相电压波形（正转）4.2.2 电磁铁驱动电路该驱动电路也采用了光电偶合器，但其功放电路相对简单。其光电偶合部分采用的是达林顿管，因为驱动电磁铁的电流比较大。第 15 页 共 25 页4.2.3 电源设计两电机同时工作再加上控制系统用电，所需电源容量比较大，需要选择大容量电源。此系统中用到的电源电压为 27V、12V 、5V，为了便于管理和电源容量需求，就采用了标准的27V 电源作为基准，通过芯片进行电压转换得到所需的 12V 和 5V 电压。图 4-6 电源转换电路图图 4-5 电磁铁驱动电路第 16 页 共 25 页电路中在转换芯片的前后有两个电容，前面电容起防止自激作用，后面电容起滤波作用。此外，在具体应用的过程中，LM7805 必须加上散热片。4.3 传感器和人机界面由于步进电机不需要反馈电路，但是要注意工作台不能超过最大行程。因此，必须在X、Y 轴的方向各加上两个行程开关。这里行程开关作用有两个：（ 1）防止工作台超过最大行程，使电机损坏（2）可以用与定位。所以这 4 个行程开关就充当了传感器。人机界面设计的准则就是要有良好的人机交互能力，一般要求操作简便，界面简洁明了。此系统中共有 9 个 LED，LED1 灯亮表示 X 轴负方向禁止通行，LED2 灯亮表示 X 轴正方向禁止通行，LED3 灯亮表示 Y 轴负方向禁止通行，LED4 灯亮表示 Y 轴正方向禁止通行，LED5 灯亮表示手动使工作台向 X 轴负方向通行，LED6 灯亮表示手动使工作台向 X 轴正方向通行，LED7 灯亮表示手动使工作台向 Y 轴负方向通行， LED8 灯亮表示手动使工作台向Y 轴正方向通行，LED9 亮表示系统通电运行。界面上的 7 个按扭意义为：按扭 1 是通断电开关，按扭 2 是向 X 轴负方向运行的点动开关，按扭 3 是向 X 轴正方向运行的点动开关，按扭 4 是向 Y 轴负方向运行的点动开关，按扭 5 是向 Y 轴正方向运行的点动开关，按扭 6 是复位开关，按扭 7 是执行绘制圆弧开关。图 4-7 人机界面图4.4 本章小节本章着重介绍了数控工作台控制系统的硬件设计。CPU 板介绍了 CPU 的选择及其外围的接口设计和控制流程；驱动系统介绍了步进电机和电磁铁的驱动电路设计；此外还叙述了第 17 页 共 25 页人机界面各个按扭和 LED 的意义。5、控制系统软件设计5.1 总体方案对于 AT89S51 的程序设计，由于所需实现的功能较简单，采用汇编的形式。编译器采用 Keil 7.02b。该编译器是 51 系列单片机程序设计的常用工具，既可用汇编，也支持 C 语言编译。同时具有完善的调试功能。5.2 主流程图CTL EQU 3FF8HPA EQU 3FF9HPB EQU 3FFAHPC EQU 3FFBHCMD EQU 02HORG 0000HAJMP MAINORG 0003HAJMP INT0IS ；外部中断 0 入口ORG 000BHAJMP TM0IS ；定时器 0 中断入口 ORG 0013HAJMP INT1IS ；外部中断 1 入口ORG 001BHAJMP TM1IS ；定时器 1 中断入口 ORG 0100HAIN：ANL P1，0EFHSETB IT0 ；外中断负跳沿触发SETB IT1MOV A，CTLMOV DPTR，AMOVX DPTR，CM；A 口输入，B 口输出， C 口输入SETB EX0 ；允许外中断 0SETB EX1 ；允许外中断 1SETB PX0SETB PX1 ；设置优先级SETB EA ；开总中断上电复位P1.6=0，吸合电磁铁，绘笔抬起外部中断，8155 初始化开外部中断，开总中断等待中断图 5-1第 18 页 共 25 页LOOP：AJMP LOOP ；等待中断在等待中断的过程中，如果有中断到来，先检查中断 0 的状态，是中断 0 则进入中断 0的中断服务 INT0IS，是中断 1 则进入中断 1 的中断服务 INT1IS。中断服务 0 是由 4 个行程开关触发的，它触发后通过单片机读取 PA 口内容，然后将结果反馈到 PB 口的 LED 上。中断服务 1 有 6 个中断源，这六个中断源分别是手动 X 正方向运行，手动 X 负方向运行，手动 Y 正方向运行，手动 Y 负方向运行，复位和绘制圆弧。5.3 INT0 中断服务流程图INT0IS：PUSH ACCPUSH DPTLPUSH DPTHPUSH PSWMOV A，PAMOV DPTR，AMOVX A，DPTR ；读 PA 口内容 MOV R2，AMOV A，PBMOV DPTR,AMOV DPTR,R2MOV A，R2CPL A ；A 取反ANL A，#03H ；屏蔽高 6 位JZ A，TM2CSETB P1.0SETB P1.1SETB P1.2TM2C： MOV A，R2CPL AANL A，#0CHJZ A，RETINSETB P1.3SETB P1.4SETB P1.5RETIN：POP PSWPOP DPTHPOP DPTL图 5-2第 19 页 共 25 页POP ACCRETI5.4 INT1 中断服务流程图图 5-3INT1IS：CLR EX1 MOV A，DPTR PUSH ACC JNB ACC.4，RSTPUSH PSW JNB ACC.0，X+ENPUSH DPTL JNB ACC.1，X-ENPUSH DPTH JNB ACC.2，Y+EN CLR P1.6 JNB ACC.3，Y-ENMOV A，PC JNB ACC.5，ARC MOV DPTR，A LOOP1：POP DPTHMOVX A，DPTR；读 PC 口内容 POP DPTLMOV R1，A POP PSWANL R1，#0FH POP ACCMOV A，PB SETB EX1MOV DPTR，A RETIMOV A，DPTR；读 PB 口内容第 20 页 共 25 页ANL A，#0FHSWAP AORL A，R1MOV R2，AMOV A，PBMOV DPTR，AMOVX DPTR，R2 ；数据输入 PB 口INC DPTL5.4.1 复位程序流程图 图 5-4DIRX EQU 30HDIRY EQU 31HRST： CLR P1.6RPA： MOV A，PAMOV DPTR，AMOVX A，DPTR ；读 PA 口内容JNB ACC.0，ACC2MOV DIRX，#00H ；表 X 电机反转ACALL XMOTOR0 ；X 电机反转一步ACC2： JNB ACC.2，LOOP0第 21 页 共 25 页MOV DIRY，#00H ；表 Y 电机反转ACALL YMOTOR0 ；Y 电机反转一步AJMP RPALOOP0：AJMP LOOP15.4.2 X 轴电机点动正转程序流程图图 5-5X+EN： CLR P1.6MOV A，PAMOV DPTR， AMOVX A，DPTRJNB ACC.0，LOOP2MOTOR0： MOV DIRX，#01HACALL XMOTOR0MOV A，PCMOV DPTR，AMOV A，DPTRJNB ACC.0，MOTOR0LOOP2： AJMP LOOP1这是 X 轴电机点动正转的程序，其他的 X 轴电机点动反转、 Y 轴电机点动正转、Y 轴电机点动反转依次类推。第 22 页 共 25 页5-6 逐点比较法画圆弧5.4.3 绘制圆弧程序流程图逐点比较法原理：假设所画圆弧在第一象限，圆心坐标为（0，0） ，圆弧上点的坐标为（X，Y） ，圆弧半径为 R，每一点的坐标偏差为 F=X*X+Y*Y-R*R，若 F0，应沿 X 轴负方向走一步，此时 FX=（X-1）*（X-1）+Y*Y-R*R=F-2X+1 ，X=X-1 ；若 F0，应沿 Y 轴正方向走一步，此时 FY=X*X+（Y-1）*（Y-1 ）-R*R=F+2Y+1，Y=Y+1。插补程序见附录。5.4.4 步进电机步进一步程序流程图第 23 页 共 25 页图 5-7 步进电机步进一步程序流程图DEF EQU 12H SJMP LP3MOV DEF，#00H TAB： DB FEHXMOTOR1：JNE DIRX，#01H，XMOTOR0 DB FCHJNE DEF，#05H ，LP2 DB FDHCLR DEF DB F9H LP2： MOV A，DEF DB FBHINC DEF DB FAHLP3： MOV DPTR，#TAB