逐点比较插补原理的实现

目 录1设计任务及要求12方案比较及认证23设计原理43.1硬件原理43.2硬件原理54软件系统94.1软件思想94.2流程图94.3源程序95调试记录及结果分析105.1界面设置105.2调试记录105.3结果分析116心得体会137 参考资料14附录15武汉理工大学计算机控制技术课程设计说明书1设计任务及要求设计一个计算机控制步进电机系统，该系统利用PC机的并口输出控制信号，其信号驱动后控制X、Y两个方向的三相步进电机转动，利用逐点比较法插补绘制出如下曲线。课程设计的主要任务: 1设计硬件系统，画出电路原理框图；2定义步进电机转动的控制字；3推导出用逐点比较法插补绘制出下面曲线的算法；4编写算法控制程序，参数由键盘输入，显示器同时显示曲线；5. 撰写设计说明书。课程设计说明书应包括：设计任务及要求；方案比较及认证；系统滤波原理、硬件原理，电路图，采用器件的功能说明；软件思想，流程，源程序；调试记录及结果分析；参考资料；附录：芯片资料，程序清单；总结。2方案比较及认证本次课程设计内容为设计一个计算机控制步进电机系统，该系统利用PC机的并口输出控制信号，其信号驱动后控制X、Y两个方向的三相步进电机转动，利用逐点比较法插补绘制出第一象限逆圆弧。数字程序控制主要应用于机床的自动控制，如用于铣床、车床、加工中心、以及线切割等的自动控制中。采用数字程序控制的机床叫数控机床，它能加工形状复杂的零件、加工精度高、生产效率高、便于改变加工零件品种等优点，是实现机床自动化的一个重要发展方向。本次课程设计采用逐点比较法插补原理以及作为数字程序控制系统输出装置的步进电机控制技术进行第一象限圆弧插补。第一象限圆弧如图2-1所示。图2-1 第一象限逆圆弧针对以上设计要求，采用步进电机插补原理进行逐步逼近插补。硬件方面，步进电机是机电控制中一种常用的执行机构，它的用途是将电脉冲转化为角位移，通俗地说：当步进驱动器接收到一个脉冲信号，它就驱动步进电机按设定的方向转动一个固定的角度（及步进角）。通过控制脉冲个数即可以控制角位移量，从而达到准确定位的目的；同时通过控制脉冲频率来控制电机转动的速度和加速度，从而达到调速的目的。逐点比较法是以阶梯折线来逼近直线或圆弧等曲线，它与规定的加工直线或圆弧之间的最大误差为一个脉冲当量，因此只要把脉冲当量（每走一步的距离即步长）取得足够小，就可以达到精度的要求。以下为课程设计要求插补的第一象限逆圆弧。图3-3为第一象限逆圆弧。软件方面，运用Visual Basic 6.0应用软件，首先制作相应的界面，进行参数设置，其次，在界面中设置相应的command1，存放相应程序，画出x轴和y轴的以及相应的箭头作出正方向，并且执行相应起点和终点的参数，定出圆心，画出相应的四分之一圆弧。作出圆弧后，通过相应的计算分析得出圆弧插补计算的五个步骤，即偏差判断、坐标进给、偏差计算、坐标计算、终点判断。软件调试及其结果分析，其中包括界面设置，调试记录以及结果分析三个方面，对软件程序进行调试和完善，实现步进电机插补原理。3硬件设计原理3.1硬件原理步进电机通对计算机进行控制，进而进行数模转换，由伺服电机驱动电路驱动伺服电机，带动工作台进行逐步比较插补，逐步逼近给定轨迹。流程如图3.1所示。图3-1 开环数字程序控制计算机D/A步进电机工作台步进电机驱动电路随着计算机技术的发展，开环数字程序控制得到了广泛的应用，如各类数控机床、线切割机低速小型数字绘图仪等，它们都是利用开环数字程序控制原理实现控制的设备。其结构亦如图3-1所示。这种结构没有反馈检测元件，工作台由步进电机驱动。步进电机接收驱动电路发来的指令作相应的运动，把刀具移动到与指令脉冲相当的位置，至于刀具是否到达了指令脉冲规定的位置，它不作任何检查，因此这种控制的可靠性和精度基本上由步进电机和传动装置来决定。图3-2为两台三相步进电机控制接口示意图，选定由PA0、PA1、PA2通过驱动电路来控制x轴步进电机，由PB0、PB1、PB2通过驱动电路来控制y轴步进电机，并假定数据输出为“1”时，相应的绕组通电；数据输出为“0”时，相应绕组断电。微型计算机8255PA0PA1PA2PB0PB1PB2驱 动电 路驱 动电 路X轴步进电机Y轴步进电机图3-2 两台三相步进电机控制接口示意图步进电机是机电控制中一种常用的执行机构，它的用途是将电脉冲转化为角位移，通俗地说：当步进驱动器接收到一个脉冲信号，它就驱动步进电机按设定的方向转动一个固定的角度（及步进角）。通过控制脉冲个数即可以控制角位移量，从而达到准确定位的目的；同时通过控制脉冲频率来控制电机转动的速度和加速度，从而达到调速的目的。以下为步进电机三相六拍工作方式，其输出字表如表3-1。 表3-1 步进电机三相六拍工作方式输出字表x轴步进电机输出字表Y轴步进电机输出字表存储地址标号PA口输出字存储地址标号PB口输出字ADX10000000101HADY10000000101HADX20000001103HADY20000001103HADX30000001002HADY30000001103HADX40000011006HADY40000011006HADX50000010004HADY50000010004HADX60000010105HADY60000010105H3.2硬件原理本次课程设计内容为设计一个计算机控制步进电机系统，该系统利用PC机的并口输出控制信号，其信号驱动后控制X、Y两个方向的三相步进电机转动，利用逐点比较法插补绘制出第一象限逆圆弧。、逐点比较法是以阶梯折线来逼近直线或圆弧等曲线，它与规定的加工直线或圆弧之间的最大误差为一个脉冲当量，因此只要把脉冲当量（每走一步的距离即步长）取得足够小，就可以达到精度的要求。以下为课程设计要求插补的第一象限逆圆弧。图3-3为第一象限逆圆弧。M(Xm,Ym)A(Xo,Yo)B(Xe,Ye)图3-3 第一象限逆圆弧以下就以第一象限为例进行分析。（1） 偏差计算公式设要加工逆圆弧AB，圆心在原点，起点坐标A(x0,Y0),终点坐标(xe,Ye),半径R。瞬时加工点M(xm,Ym)，它距圆心Rm，则可用R与Rm来反映偏差。由图3-2可知:由此定义偏差公式为：若Fm0，M点在圆弧上；若Fm0，M点在圆弧外；若Fm0，M点在圆弧内。第一象限逆圆弧的插补原理是：从圆弧起点出发，若Fm>0，沿-X方向走一步，并计算新偏差；当Fm<0时，沿+Y方向走一步,并计算新偏差。如此一步一步计算与进给，并在到达终点时停止计算。但以上Fm计算式比较复杂，可以考虑用递推公式： 当Fm0时，Xm+1Xm-1 Ym+1Ym Fm+1Fm-2Xm+1当Fm0时，Xm+1Xm Ym+1Ym+1 Fm+1Fm+2Ym+1（2）终点判断方法 设置Nx,NY两个计数器，初值设为|Xe-Xo|,|Ye-Yo|在不同的坐标轴进给时对应的计数器减一，两个计数器均减到零时，到达终点。 用一个计数器NxY ，初值设为Nx+NY,无论在哪个坐标轴进给，Nxy 计数器减一，计数器减到零时，到达终点。(3) 插补计算过程圆弧插补计算比直线插补计算过程要多一个环节，即要计算加工瞬时坐标。故圆弧插补计算为五个步骤即偏差判断、坐标进给、偏差计算、坐标计算、终点判断。通过以上的分析计算，可以得出以下四个象限的顺圆弧（SR）和逆圆弧（NR）的圆弧插补计算公式和进给方向。其插补进算公式及其进给方向如表3-1所示。表3-2 圆弧插补计算公式和进给方向偏 差圆弧种类进给方向偏差计算坐标计算Fm0SR1、NR2-YFm+1Fm-2Ym+1Xm+1XmYm+1Ym-1SR3、NR4+YNR1、SR4-xFm+1Fm-2Xm+1Xm+1Xm-1Ym+1YmNR3、SR2+xFm<0SR1、NR4+xFm+1Fm+2Xm+1Xm+1Xm+1Ym+1YmSR3、NR2-xNR1、SR2+YFm+1Fm+2Ym+1Xm+1XmYm+1Ym+1NR3、SR4-Y由于本次课程设计的设计要求为第一象限逆圆弧，以逆圆弧为例分析，通过以上计算结果分析，通过绘图，的出相应四个象限圆弧插补的对称关系。以下为四个象限圆弧插补的对称关系，当Fm大于等于零或者小于零时，分别对应的偏差判别，偏差计算，进给方向，坐标计算等等。以下为根据表3-2得出的相应四个象限的插补对应关系，从图中可以推出其对应的具体进给方向，如图3-4所示。Fm0Fm0Fm0Fm0Fm<0Fm<0Fm<0Fm<0YX图3-4 四个象限逆圆弧插补的对称关系4软件系统4.1软件思想本次课程设计采用VB软件进行编程与界面制作，软件的设计制作包括如下几方面：1. 坐标的取值与计算，即设计中所插补的圆弧所位于象限的确定。2. 圆心所在坐标的确定。3. 圆弧半径的选择。4. 通过所选半径及其圆心，确定圆弧起点坐标与终点坐标的选择。5. 逐步逼近，圆弧插补的实现。4.2流程图开 始偏差判别Fm0为了逼近圆弧，向+y方向进给一步为了逼近圆弧，向-x方向进给一步终点判断Nxy=0NYYN 结 束4.3源程序如附录所示5调试记录及结果分析5.1界面设置运用Visual Basic 6.0应用软件，制作如下界面。其中参数设置包括：半径q的设置，起点坐标设置（起点x轴y轴参数），终点坐标设置（终点x轴y轴参数）。另外，先不要设置“作图”执行程序，其中存放其相关程序。相应参数输入界面设置如图5-1所示。图5-1 参数输入界面设置5.2调试记录通过Visual Basic 6.0应用软件界面设置及其相应的程序编辑， 通过执行程序，在相应picture区域定出原点坐标，作出相应坐标轴以及坐标轴的x轴和y轴的方向，进而作出相应圆弧（同时定义原点的坐标），实现以上步骤之后，通过程序控制，通过插补原理实现完整的插补过程，逐步逼近圆弧。以下为实际运行中的步进电机圆弧插补，通过调试得出以下结果。图5-2为相应调试结果。图5-2 步进电机插补过程调试结果5.3结果分析通过以上界面设置，通过相应参数输入，首先输入相应半径参数q，其次进行起点坐标输入，包括起点x轴坐标输入及其y轴坐标输入，进而进行重点坐标输入，其中包括重点x轴坐标输入及其y轴坐标输入。进而进行作图命令，步进电机插补过程如右图picture所示。以上图5-2所示步进电机插补过程调试，圆心坐定为（1 ，1），参数输入相应参数输入为q=5，相应计算所得四分之一圆弧起点坐标为（6 ，1），相应终点坐标为（1 ，6），点击“ 作图”按钮，在picture中实现圆心为（1 ，1），起点坐标为（6 ，1），终点坐标为（1 ，6）的圆弧插补。根据步进电机插补原理，偏差判别是为：该圆弧为第一象限圆弧，第一象限圆弧插补Fm判别式，有如下关系：1.当Fm0时，Xm+1Xm-1 Ym+1Ym Fm+1Fm-2Xm+12.当Fm0时，Xm+1Xm Ym+1Ym+1 Fm+1Fm+2Ym+1由起点及其终点，可得终点判断Nxy=10，另外令圆心（1 ，1）为新建坐标系原点，可得一下圆弧插补过程，如表5-1所示。表5-1 圆弧插补计算过程步数偏差判别坐标进给坐标计算偏差计算终点判断起点X05,Y00F00Nxy101Fo0-xX1x0-14,Y10F1F0-2X0+1-9Nxy92F1-90+yX24,Y2Y1+11F2F1+2Y1+1-6Nxy83F2-60+yX34,Y3Y2+12F3F2+2Y2+1-3Nxy74F3-30+yX44,Y4Y3+13F4F3+2Y3+10Nxy65F40-xX5x4-13,Y53F5F4-2X4+1-7Nxy56F5-70+yX63,Y6Y5+14F6F5+2Y5+10Nxy47F60-xX7X6-12,Y74F7F6-2X6+1-5Nxy38F7-50+yX82,Y8Y7+15F8F7+2Y7+14Nxy29F820-xX9X8-11,Y95F9F8-2X8+11Nxy110F910-xX10X7-10,Y105F10F9-2X9+10Nxy0根据以上圆弧插补过程，实现完整的圆弧插补过程。6心得体会微机控制原理技术是一门很有趣的课程，任何一个计算机系统都是一个复杂的整体，学习危机控制原理是要涉及到整体的每一部分。通过讨论其控制原理时又要涉及到各部件之间控制的工作原理，不仅较深入理解计算机控制的工作原理。所以，在循序渐进的课堂教学过程中，我总是处于“学会了一些新知识，弄清了一些原来保留的问题，又出现了一些新问题”的循环中，直到课程结束时，才把保留的问题基本搞清楚。学习该门课程知识时，其思维方法也和其它课程不同，该课程偏重于工程思维，具体地说，在了解了微机基本原理的同时，必须学会各种控制技术的应用，其创造性劳动在于如何用计算机的有关技术实现计算机的控制，设计实用的电路和系统，再配上相应的应用程序，完成各种控制应用项目。这次课程设计并不是很难，主要的困难来自对程序的处理和界面的设计。功夫不负有心人，经过宿舍想死类型题目的四个人的合作和努力，最后对实验的原理有了更清晰的认识。虽然设计中并的功能并不是十分完善，但是就系统功能来说，基本完成了课程设计要求。但是通过平时课程的学习，又通过本次课程设计对它的再一次认真努力学习和操作，巩固了该门课程的知识和应用，对我们以后的学习也会有帮助的。本次还遇到一个困难，便是对于VB使用的不熟悉。对于VB的应用，仅仅限于高中一年的简单学习，这次课程设计中对于步进电机的软件仿真，VB中的很多不懂的地方，通过看书学习和向同学请教，实现了步进电机的软件设计。本次课程设计的过程中，对于VB的再一次重温和理解，相信对于今后的学习也有很大的帮助。总之，这次课程设计对于我们有很大的帮助，通过课程设计，我更加深入地理解了，微机控制原理课程上讲到的各种控制技术， 本次设计尤其深入了对步进电机插补原理的理解，熟悉了VB程序的编写过程和运行过程，最后还提高了自己的动手能力。感谢老师的悉心指导。7 参考资料1郑学坚，周斌 微型计算机原理与应用 清华大学出版社2于海生 微型计算机控制技术 清华大学出版社3沈美明，温冬婵 IBM-PC汇编语言程序设计 清华大学出版社 4何立民 单片机应用系统设计 北京航空航天大学出版社5姚燕南，薛钧义 微型计算机原理 西安电子科技大学出版社6沙占友等 新编实用数字化测量技术 国防工业出版社7宋春荣等 通用集成电路手册 山东科技出版社附录：附件一程序清单Option ExplicitPublic q As DoublePublic flag As IntegerPublic xa As IntegerPublic ya As IntegerPublic xb As IntegerPublic yb As IntegerPublic fm As IntegerPublic n As IntegerPublic x As DoublePublic y As DoublePublic sx As DoublePublic sy As DoubleDim c As IntegerPublic Function max(a, b)If a > b Thenmax = aElsemax = bEnd IfEnd FunctionPrivate Sub Command1_Click()Picture1.Refreshq = Val(Text1.Text)xa = Val(Text2.Text)ya = Val(Text3.Text)xb = Val(Text4.Text)yb = Val(Text5.Text) Picture1.Scale (-1, 10)-(10, -1) '定义坐标轴的大小Picture1.Line (0, 0)-(0, 10)Picture1.Line (10, 0)-(0, 0)Picture1.Line (10, 0)-(9.5, 0.5) '画出坐标系X.Y方向的箭头Picture1.Line (10, 0)-(9.5, -0.5)Picture1.Line (0, 10)-(0.5, 9.5)Picture1.Line (0, 10)-(-0.5, 9.5)Picture1.Circle (1, 1), q, vbRed, 0, 3.141592 / 2 n = 2 * q fm = 0 x = xa - 1 y = ya - 1Picture1.CurrentX = xa Picture1.CurrentY = ya Do If fm >= 0 Then Picture1.Line -Step(-1, 0) fm = fm - 2 * x + 1 x = x - 1 n = n - 1 Else Picture1.Line -Step(0, 1) fm = fm + 2 * y + 1 y = y + 1 n = n - 1 End If Loop While (n > 0)End Sub17