2005年电子大赛二等奖悬挂运动控制系统

1、悬挂运动控制系统2005 年电子大赛二等奖文章来源：凌阳科技教育推广中心广西师范大学 黄钦宁李树海莫琼华 发布时间：2006-8-30 11:43:34摘要：本系统采用凌阳16位单片机SPCE061师为控制中心，由直流步进电机、红外收发对管、4*4键盘及中文液晶显示屏构成的悬挂运动控制系统。该系统能自由控制悬挂物体完成自行设定运动、画圆运动、沿黑线运动等，并能正确显示物体到达的坐标位置。关键词：SPCE061库片机中文液晶显示屏逼近画圆算法一、方案的选择与论证1、单片机选择方案一：采用传统的8位89C51单片机作为运动物体的控制中心。51单片机具有价格低廉，使用简单等特点，但其运算速度低，功能

2、单一，RAM RO螳间小等缺点。此题目在确定圆周坐标值时，需要进行大量的浮点数运算，假设采用89C51需要做RAM RO陈扩展其内存空间，其硬件工作量必然大大增多。方案二：采用16位单片机SPCE061师为运动物体白控制中心。SPCE061Al有丰富白资源：RAM ROMS间大、指令周期短、运算速度快、低功耗、低电压、可编程音频处理，易于编写和调试等优点。尤其在复杂的数学运算，其运算速度快，精度高，在控制步进电机时运行速度比一般51单片机快。基于上述分析，拟选择方案二。2、电动机选择方案一：用步进电机实现物体的精确定位和方向控制。步进电机是一种脉冲控制电机，它是一种能将脉冲信号转换为角位移的数

3、模转换器，可广泛用于无需反应控制但要求有精确位置的场合。方案二：采用带旋转编码器控制直流电机，电机运转平稳，精度可以得到保证。但其驱动电路复杂，在短时间内难与实现。在此题中因考虑到控制画笔画图准确性和电路的复杂性，拟选择选用方案一，并采用控制性能高的步进电机来控制运动物体。3、控制物体运动算法方案一：直线插补法。直线插补法是在绘图系统中常用的一种逐点比拟算法。它的原理是：执行机构每走一步，都要和给定轨迹上的坐标值进行一次比拟，看当前位置和轨迹位置的关系，从而确定下一步的进给方向。如果当前位置在给定轨迹的下方，下一步向给定轨迹的上方走，反之那么相反。如果当前位置在给定轨迹的里面，下一步向给定轨迹

4、的外面走，反之那么相反。这样走一步看一步，决定下一步走向，形成逐点比拟,使走线逼近给定轨迹。方案二： 直线简易算法。这种算法是根据计算机图形学中直线的显示方法改变而来，根本原理也是逐点比拟， 执行机构根据当前位置和轨迹位置的关系，从而确定下一步的进给方向，但是数据的处理过程不同。在直线插补法中，一次循环只能确定一个走向X向或Y向，而在直线简易算法中，一次循环可以走两步，这样可以大大提高效率。同时，直线插补法要考虑象限的问题，不同的象限有不同的计算公式，而直线简易算法绕开了象限的问题，可以节省很多代码。结合软件编程的难易和上面的比拟，拟选择选用方案二。4、黑线探测模块方案一：采用红外反射式探测，

5、即用已调的红外线垂直射到板面，经反射后转换为电信号送入单片机处理，这是一种很普遍的应用，但是它存在着缺点：1由于反射距离较短，红外反射功率小，如果板面的纸凹凸不平或白纸外表有杂物，也会使单片机误判。2由于板面的黑线可能是墨水或者胶布，两种虽然都是黑色，但经实际应用发现其反光程度均不同，也会对红外传感器造成一定的干扰。方案二：采用多路阵列式光敏电阻组成的光电探测器。因为光敏电阻探测到黑线时，黑线上方的电阻值发生变化，经过电压比拟器比拟将信号送给单片机处理，从而控制物体做相应的动作。光敏电阻对环境光的识别，要求考虑外界环境光的影响，测试时可能在室内或室外，为了消除外界光照强度的干扰，在每个光敏电阻

6、旁边加了一个高亮度发光二极管，这样每个光敏电阻的环境一样，即使在黑暗的条件下也可以正常工作。测试结果说明使用这种方法就可以消除外界光的干扰。基于上面的讨论，选用了抗干扰能力强的方案二。5、显示方案方案一：采用LED数码管显示器。LED数码管亮度高，醒目，但是其电路复杂，占用资源较多，显示信息量较小。方案二：采用汉字LCD夜晶显示器。LCDW明显的优点：微功耗、尺寸小，超薄轻巧、显示信息量大、字迹清晰、美观、视觉舒适；可以用中文进行菜单显示，使整个控制系统更加人性化。基于上面的比拟分析和现有的LCD导件，拟选用方案二。二、系统的具体设计与实现1、系统的总体设计方案如图1所示采用凌阳16位SPCE

7、061障片机作为运动物体的控制中心，进行数学计算、对光电传感器送来的信号进行处理来控制运动物体的运行方向、计算运行物体的坐标位置、LC殴据显示、键盘控制等LCD夜晶* LCD显示4*4键盘图i系统原理图2、系统硬件设计与计算(1)电机驱动电路的设计与实现图2电机驱动电路具体电路如图2,该电路采用L298驱动芯片，L298驱动芯片是性能优越的小型直流电机驱动芯片之一。它可被用来驱动两个直流电机或者是一个步进电机。在4-46V的电压下，可以提供2A的驱动电流。L298还有过热自动关断功能，并有反应电流检测功能，符合电机驱动的需要由于采用的是步进电机，所以对电机的驱动必须是采用脉冲控制本作品中的控制

8、系统采用5V电源，电机驱动L298的电源也使用5V。基于稳定性考虑，我们运用了TLP521光耦集成块，将主控制局部电源与电机驱动部分的电源隔离开来，这样减少电机对主控制电路的干扰。(2)黑线探测设计与实现利用该模块探测板面黑线的原理是：光线照射到板面并反射，由于黑线和白纸的反射系数不同，黑线上方的电阻值发生变化，经过电压比器比拟将信号送给单片机处理。电路示意图如图3:步进电机6M单H机1,3为光敏电阻黑色引导线2,4为光敏电阻图3黑线探测示意图本电路如图3利用光敏电阻在不同的光照的条件下电阻变化的原理。根据第几路的光敏检测到黑线来控制步进电机的转向。将光敏电阻分为前、后、左和右四个方向，设计为

9、+字形。采用一组两个探测头，当出现一个探测头的误判时，可以通过软件禁止物体跑出轨迹。当探测头1检测到黑线时，物体左走，同时禁止物体右转防止跑出黑线，直到中间的探测头2或探测头4再次检测到黑线证明物体已经回到黑线上才向前走， 这样就可以保证物体不会跑出黑线。在试验时采用的电路如图4由于在正常状态下每个光敏电阻感光量相同，通过调节电位器，使得电压比拟器输出为零，当内侧(黑线两侧 )的光敏电阻进入黑色引导带时，感光量大大改变，电压比拟器翻转电压为高电平。将电平变化送到单片机控制物体的调整方向。用这种方法即使板面受到不同程度的光照射，比拟器正向输入端和反向输入端的变化值相等，比拟器输出端不变。只有黑色

10、引导线进入内侧一组光敏电阻区域才能引起感光量大大改变，比拟器才翻转，这种方法抗干扰能力强。(3)红外线无线控制台电路的设计采用红外线无线通信可以对运动物体进行远程控制并传输物体的坐标位置到远处的控制台显示。发射电路如图5示，由NE555勾成无稳多谐振荡器，其振荡频率由电阻W1 R1和C3决定，通过调节W1可以改变振荡频率，使输出频率为38KHz T作为单片机的串口输出端，当T为高电平时，T1截止，T2、T3没有振荡频率。当T为低电平，T1导通，这样38KHz就可以对T出来的信号进行调制；调制后的信号经过T2、T3后级电流放大去控制红外线发射管。红外线的接收电路直接采用彩色电视机的一体化接收头，

11、到达预期效果。(4)语音播放电路通过SPY0030功率放大器，驱动喇叭，完成对物体运行时间的语音播放(图6)图6语音播放电路(5)显示模块采用汉字液晶显示屏作为显示模块，同时使用4*4键盘操作，以菜单形式进行显示。显示设定位置值、当前位置值。a a VUCVUCDIGCMGDIGCMGT一图5红外无线控制台原理图PHOHEJACKPHOHEJACK三、系统软件设计及数学运算(1)系统主程序流程框图(图7)像盘扫描力人额值走自行役定的运靠自行S定的运动塔报行走史间是否走翼拢居设定坐标与拉翼笠福人原点里标显示画型糅假设报行走时用显示国量生标图7主程序流程图(2)物体位置控制局部图8物体位置示意图1

12、、坐标点参数的计算将画笔所在的位置设定为整个物体的位置。如图8设定物体位置的初值坐标为(X,Y)L1二/(ll/(ll O OZ ZZ)Z) * * U U 1 10-I)+0-I)+ ( (1 11515= =Y)Y) * * (1(11 1L2=设电机A的步进为a cm,电机B的步进为b cm,物体高度为h cm。如图8为物体在画板某一位置，那么有：。00-扪昭二0+2尸解彳#X轴点位置和h为电 + 碟-+2，1。-15那么Y轴点位置Y=115-h控制物体从一点到另一点的实现就是当X、Y条件，求电机的步进过程。由图8解得：(X+15)?+(115-)丁 (+4110-(/+15)2+(H5

13、-X)3= (Z2+i)2解得河+桥 +(115-疗1 5人初晨西丽m声-2cm由此，利用软件实现以上算法来分别控制两个步进电机的步进a, b,这样就可以向控制系统输入起点坐标和终点坐标让物体在画板置任意行走。因此物体 可以由自行设定的两点坐标走直线。也可以将曲线分为多点坐标，采用直线逼近法走曲线。2、多边形逼近画圆实现画圆算法一个正多边形，当其边数n足够大，即每边所对的圆心角 口足够小时，就非常接近一个圆。这样，画圆的问题就变成画多边形、画直线的问题了，只要确定n和 m 角的大小，多边形顶点的坐标位置，就可以绕开烦琐的象限问题，直接利用上面的画线的简易算法来实现画圆。1)、n和角的大小确实定

14、在用正多边形逼近一个圆时，假设多边形的各个顶点落在圆周外侧，而各边中点落在圆周内侧，并假设它们偏离圆周的绝对误差均为e,如图9所示，只要e V0.5,那么边线与弧线的差异就可以忽略。图9中，R为圆半径，正多边形的边数n与每边所对圆心角9的关系为n=2 /A根据图2-2-2的几何关系，不难得到(R+e) - (R+e) cos(ZV /2)=2 e(1)一般 1 远小于1弧度，cos( A * /2) =1- ( 3 )2/8,故上式可简化为:(R+e ) ( ) 2/8=2 e (2)由式1和式2解得:图9 9正名边拒逼近同示意图当圆心为m,n时，将圆分成360份，假设物体走到第i份时，以圆心

15、为原点，物体的坐标X,Y计算为Y二丹+rsm8求得物体的坐标位置后在利用以上坐标点参数的计算得出来的结果控制物体在两点坐标间走直线。多边形的边数n的值越大，画出来的圆精度就越高。2、多边形逼近法画圆流程框图在上面的讨论中，知道了多边形的边数n的值和多边形顶点坐标的推导方法，这样可以利用画直线的简易算法用线段来完成圆。以圆心在X1,Y1,在X1-R,Y1,顺时针方向画圆流程图如下列图10n=0.5加正/E+l(3)假设取6 2.5久i的角度5=i180物体的位置Jf=w+rcos5起点二0.5加图1010多边形遑近法圆图流程图由于在直线的简易算法处理过程中，起点为坐标X1-R,Y1。所以在多边行

16、逼近中，每画一条直线，都要把坐标平移把起点xi和yi放到起点，再调用直线简易算法。这种方法简单易行，在直线简易算法的根底上经过简单的数学计算处理，屡次画线就可以实现画圆，相比拟圆弧插补法，多边形逼近法程序代码少，可以大大节省内存空间；程序流程简单，容易编写调试；运行速度也相对圆弧插补法有较大提高3、软件编程软件编程彳用凌阳unSP IDE 1.8.4平台，该平台集程序的编辑、编译、链接、调试和仿真等功能为一体，可以使用C语言和汇编语言混合编程，编译效率高，在线调试方便。具体程序略四、实际测试(1)测试设备模拟行使路线：示意图见试题(E题)卷尺：精度0.01m秒表：精度0.01s坐标纸采用喷塑坐

17、标纸(调试中易于擦洗无用的画笔轨迹)(2)走自行运动实际测量结果第一次走实际测量结果：到达目的坐标,运动轨迹与预期轨迹之间的最大偏差1.7cm,运行时间为124秒。第二次走实际测量结果：离达目的坐标1.3 cm ,运动轨迹与预期轨迹之间的最大偏差1.4cm,运行时间为131秒。第三次走实际测量结果：离达目的坐标1.1 cm ,运动轨迹与预期轨迹之间的最大偏差1.3cm,运行时间为147秒。第四次走实际测量结果：离达目的坐标1.5 cm ,运动轨迹与预期轨迹之间的最大偏差1.1cm,运行时间为118秒。第五次走实际测量结果：离达目的坐标0.8 cm ,运动轨迹与预期轨迹之间的最大偏差1.3cm,

18、运行时间为138秒。第六次走实际测量结果：离达目的坐标1.4 cm ,运动轨迹与预期轨迹之间的最大偏差1.9cm,运行时间为128秒。六次运行物体离达目的坐标最大误差为1.5 cm ,运动轨迹与预期轨迹之间的最大偏差1.9cm。 平均运行时间约为130秒。到达了预期的效果。(3)画圆实际测量结果画圆测试结果如下表第一次画圆以(40,50)为圆心，对圆周进行8个点采样。圆上的坐标物体实际坐标(15,50)(17,50)(22,68)(23.8,69.7)(40.75)(40,74)(58,68)(56.5,66)(65,50)(64,50.4)(58,32)(59.3,31)(40,25)(40

19、,24.2)(22,32)(23.4,32.7)最大误差为1.8cm,运行时间为225秒，画笔曲线接近圆第二次画圆以40,50为圆心，对圆周进行8个点采样圆上的坐标物体实际坐标(15,50)(15.5,50.6 )(22,68)(21.9,69.4)(40,75)(40.5,74)(58,68)(58.3,66.7)(65,50)(64.8,50.2)(58,32)(59.1,34.2)(40,25)(40.6,24.5)(22,32)(23.5,32.4)最大误差为2.2cm,运行时间为224秒画，画笔曲线接近圆第三次画圆以40,50为圆心，对圆周进行8个点采样圆上的坐标物体实际坐标(15.

20、50)(15,50.6 )(22,68)(22.2,69.4)(40,75)(38.5,74.1)(58,68)(56.6,66.7)(65,50)(65.8,51.7)(58,32)(59.3,31.1)(40,25)(39.6,24.5)(22,32)(22.5,32.7)最大误差为1.7cm,运行时间为221秒，画笔曲线接近圆三次画圆，运动轨迹与预期轨迹之间的最大偏差2.2cm,平均运行时间约为224秒，到达了预期的效果。(4)走黑线实际测量结果第一次走黑线走完连续线段，运动轨迹与预期轨迹之间的偏差第二次走黑线走完连续线段，运动轨迹与预期轨迹之间的偏差第三次走黑线走完连续线段，运动轨迹与

21、预期轨迹之间的偏差第四次走黑线走完连续线段，运动轨迹与预期轨迹之间的偏差时间为95秒，第一个间断线段运行时间为45秒时间为97秒，第一个间断线段运行时间为54秒第七次走黑线走完连续线段，运动轨迹与预期轨迹之间的偏差1.4cm。走过第二个断点，走断续线段运动轨迹与预期轨迹之间的偏差1.5cm,连续线段运行时间为92秒，两个间断线段运行时间共为96秒。1.8cm,连续线段运行时间为95秒。2.3cm,连续线段运行时间为98秒。1.6cm,连续线段运行时间为101秒。0.9cm,连续线段运行时间为94秒。第五次走黑线走完连续线段，运动轨迹与预期轨迹之间的偏差2.2cm。走过第一个断点,走断续线段运动轨迹与预期轨迹之间的偏差2.5cm,连续线段运行第六次走黑线走完连续线段，运动轨迹与预期轨迹之间