




版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
1、悬挂运动控制系统毕业论文悬挂运动控制系统【摘要】 本系统采用凌阳16位单片机SPCE061A作为控制中心,由直流步进电 机、红外收发对管、4*4键盘及中文液晶显示屏构成的悬挂运动控制系统。该系 统能自由控制悬挂物体完成自行设定运动、画圆运动、沿黑线运动等,并能正确显示物体到达的坐标位置。【关键词】SP CE061单片机 中文液晶显示屏 逼近画圆算法A Con trol System For Suspension Moveme ntAbstract This design uses SPCE061Aas the control core to build a sus pension moveme
2、 nt con trol system which con sists of a DC ste p motor, infrared emitting tube, 4X4 keyboard and an LCDdisplay screen for Chinese characters. The system can control the suspended objects to complete the moveme nts set by itself, such as draw ing the circles, moving along the black lines and doing o
3、ther moveme nts. It also can dis play the correct locati on of the coord in ate where the object reaches.Key words: SPCE061ASingle chip , Chinese characters LCD , Closing Algorithm for circle draw ing、方案的选择与论证1、单片机选择方案一:采用传统的8位89C51单片机作为运动物体的控制中心。51单片 机具有价格低廉,使用简单等特点,但其运算速度低,功能单一,RAM RO临间小等缺点。本题目在确定
4、圆周坐标值时,需要进行大量的浮点数运算,若采用 89C51需要做RAM ROM来扩展其内存空间,其硬件工作量必然大大增多。方案二:采用16位单片机SPCE061作为运动物体的控制中心。SPCE061具 有丰富的资源:RAM ROM空间大、指令周期短、运算速度快、低功耗、低电压、 可编程音频处理,易于编写和调试等优点。尤其在复杂的数学运算,其运算速度51单片机快。快,精度高,在控制步进电机时运行速度比一般基于上述分析,拟选择方案二。2、电动机选择步进电机是一种脉冲,可广泛用于无需方案一:用步进电机实现物体的精确定位和方向控制。 控制电机,它是一种能将脉冲信号转换为角位移的数模转换器, 反馈控制但
5、要求有精确位置的场合。精度可以得到保方案二:采用带旋转编码器控制直流电机,电机运转平稳, 证。但其驱动电路复杂,在短时间内难与实现。在本题中因考虑到控制画笔画图准确性和电路的复杂性,拟选择选用方案 一,并采用控制性能高的步进电机来控制运动物体。3、控制物体运动算法方案一:直线插补法。直线插补法是在绘图系统中常用的一种逐点比较算法。 它的原理是:执行机构每走一步,都要和给定轨迹上的坐标值进行一次比较, 看 当前位置和轨迹位置的关系,从而确定下一步的进给方向。如果当前位置在给定 轨迹的下方,下一步向给定轨迹的上方走, 反之则相反。如果当前位置在给定轨 迹的里面,下一步向给定轨迹的外面走,反之则相反
6、。这样走一步看一步,决定 下一步走向,形成“逐点比较”,使走线逼近给定轨迹。方案二:直线简易算法。这种算法是根据计算机图形学中直线的显示方法改 变而来,基本原理也是“逐点比较”,执行机构根据当前位置和轨迹位置的关系, 从而确定下一步的进给方向,但是数据的处理过程不同。在直线插补法中,一次循环只能确定一个走向(X向或丫向),而在直线简易算法中,一次循环可以走 两步,这样可以大大提高效率。同时,直线插补法要考虑象限的问题,不同的象 限有不同的计算公式,而直线简易算法绕开了象限的问题,可以节省很多代码。结合软件编程的难易和上面的比较,拟选择选用方案二。4、黑线探测模块方案一:采用红外反射式探测,即用
7、已调的红外线垂直射到板面,经反射后 转换为电信号送入单片机处理,这是一种很普遍的应用,但是它存在着缺点:(1) 由于反射距离较短,红外反射功率小,如果板面的纸凹凸不平或白纸表面有杂物, 也会使单片机误判。(2)由于板面的黑线可能是墨水或者胶布, 两种虽然都是黑 色,但经实际应用发现其反光程度均不同,也会对红外传感器造成一定的干扰。方案二:采用多路阵列式光敏电阻组成的光电探测器。因为光敏电阻探测到 黑线时,黑线上方的电阻值发生变化,经过电压比较器比较将信号送给单片机处 理,从而控制物体做相应的动作。 光敏电阻对环境光的识别,要求考虑外界环境 光的影响,测试时可能在室内或室外,为了消除外界光照强度
8、的干扰,在每个光 敏电阻旁边加了一个高亮度发光二极管, 这样每个光敏电阻的环境一样,即使在 黑暗的条件下也可以正常工作。测试结果表明使用这种方法就可以消除外界光的 干扰。基于上面的讨论,选用了抗干扰能力强的方案二。5、显示方案方案一:采用LED数码管显示器。LED数码管亮度高,醒目,但是其电路复 杂,占用资源较多,显示信息量较小。方案二:采用汉字LCD液晶显示器。LCD有明显的优点:微功耗、尺寸小,超薄轻巧、显示信息量大、字迹清晰、美观、视觉舒适;可以用中文LCD液晶进行菜单显示,使整个控制系统更加人性化。基于上面的比较分析和现有的 LCD器件,拟选用方案二。、系统的具体设计与实现1、系统的总
9、体设计方案如图1所示采用凌阳16位SPCE061/单片机作为运动物体的控制中心,进行 数学计算、对光电传感器送来的信号进行处理来控制运动物体的运行方向、 计算 运行物体的坐标位置、LCD数据显示、键盘控制等。直流步进迫机驱动*画闘b4陵阳 SPCE061A单片机*LCD显示凰点刮设定点运动fc *走黑线输入縫值44*4进盘图1系统原理图2、系统硬件设计与计算(1) 电机驱动电路的设计与实现具体电路如图2,该电路采用L298驱动芯片,L298驱动芯片是性能优越的 小型直流电机驱动芯片之一。它可被用来驱动两个直流电机或者是一个步进电 机。在4 46V的电压下,可以提供2A的驱动电流。L298还有过
10、热自动关断 功能,并有反馈电流检测功能,符合电机驱动的需要。由于采用的是步进电机,所以对电机的驱动必须是采用脉冲控制。本作品中的控制系统采用 5V电源,电机驱动L298的电源也使用5V。基于 稳定性考虑,我们运用了 TLP 521光耦集成块,将主控制部分电源与电机驱动部 分的电源隔离开来,这样减少电机对主控制电路的干扰。(2) 黑线探测设计与实现利用该模块探测板面黑线的原理是:光线照射到板面并反射,由于黑线和白 纸的反射系数不同,黑线上方的电阻值发生变化,经过电压比器比较将信号送给 单片机处理。电路示意图如图 3:单片机/I电压比较器电压比较器单片机/4i00321,3为光敏电阻黑色引导线2,
11、4为光敏电阻图3黑线探测示意图本电路(如图3)利用光敏电阻在不同的光照的条件下电阻变化的原理。根据第几路的光敏检测到黑线来控制步进电机的转向。将光敏电阻分为前、后、左和右四个方向,设计为 +字形。采用一组两个探测头,当出现一个探测头的 误判时,可以通过软件禁止物体跑出轨迹。当探测头1检测到黑线时,物体左走, 同时禁止物体右转防止跑出黑线,直到中间的探测头2或探测头4再次检测到黑 线证明物体已经回到黑线上才向前走, 这样就可以保证物体不会跑出黑线。 在试 验时采用的电路如图4。图4黑线探测原理图由于在正常状态下每个光敏电阻感光量相同,通过调节电位器,使得电压比 较器输出为零,当内侧(黑线两侧)的
12、光敏电阻进入黑色引导带时,感光量大大 改变,电压比较器翻转电压为高电平。将电平变化送到单片机控制物体的调整方 向。用这种方法即使板面受到不同程度的光照射,比较器正向输入端和反向输入 端的变化值相等,比较器输出端不变。只有黑色引导线进入内侧一组光敏电阻区 域才能引起感光量大大改变,比较器才翻转,这种方法抗干扰能力强。(3) 红外线无线控制台电路的设计采用红外线无线通信可以对运动物体进行远程控制并传输物体的坐标位置 到远处的控制台显示。发射电路如图 5示,由NE555构成无稳多谐振荡器,其振 荡频率由电阻 W1 R1和C3决定,通过调节 W1可以改变振荡频率,使输出频率 为38KHZ T作为单片机
13、的串口输出端,当T为高电平时,T1截止,T2、T3没有 振荡频率。当T为低电平,T1导通,这样38KHz就可以对T出来的信号进行调 制;调制后的信号经过T2、T3后级电流放大去控制红外线发射管。红外线的接收电路直接采用彩色电视机的一体化接收头,达到预期效果。图5 红外无线控制台原理图(4) 语音播放电路通过SPY0030功率放大器,驱动喇叭,完成对物体运行时间的语音播放(图6)(5) 显示模块同时使用4*4键盘操作,以菜单形式进采用汉字液晶显示屏作为显示模块, 行显示。显示设定位置值、当前位置值。三、系统软件设计及数学运算(1)系统主程序流程框图(图7)(2)物体位置控制部分1、坐标点参数的计
14、算将画笔所在的位置设定为整个物体的位置。如图8设定物体位置的初值坐标为(X,Y)L1= jfx*X+(115-Y)*(115-Y)L2=/(110-2) *tllO-XJ + ( 115-7)*(115-73设电机A 的步进为a cm,电机B的步进为b cm,物体高度为h cm。 如图8为物体在画板某一位置,则有:X2 + h2 =(a +L1)2 (100-X)2 卄2 =(b + L2)2解得X轴点位置和h为X =(a + L1)2-(b+L2)2+1102仏 0,5h = J(L1 +a)2 -X2则丫轴点位置Y=115-h控制物体从一点到另一点的实现就是当 X、Y已知条件,求电机的步进
15、过程。 由图8解得:(X +15)2 +(115-Y)2 =(L1 +a)2 110-(X +15)2 +(115-Y)2 =(L2+b)2解得a =p(X +15)2+(115 -Y)2-L1( cm)b = J110 -(X +15)2 +(115 -Y)2 -L2(cm)由此,利用软件实现以上算法来分别控制两个步进电机的步进 a,b,这样 就可以向控制系统输入起点坐标和终点坐标让物体在画板置任意行走。 因此物体 可以由自行设定的两点坐标走直线。 也可以将曲线分为多点坐标,采用直线逼近 法走曲线。2、多边形逼近画圆实现画圆算法一个正多边形,当其边数n足够大,即每边所对的圆心角日足够小时,就
16、 非常接近一个圆。这样,画圆的问题就变成画多边形、画直线的问题了,只要确定n和0角的大小,多边形顶点的坐标位置,就可以绕开烦琐的象限问题,直接 利用上面的画线的简易算法来实现画圆。1)、n和Q角的大小的确定在用正多边形逼近一个圆时,假设多边形的各个顶点落在圆周外侧,而各边中点落在圆周内侧,并假设它们偏离圆周的绝对误差均为,如图9所示,只要 0.5,贝灿线与弧线的差别就可以忽略。图 9中,R为圆半径,正多边 形的边数n与每边所对圆心角 9的关系为n=2n / e(1)nA2.5 冗 JR图9正多边形逼近圆示意图cos( /2)(2)根据图2-2-2的几何关系,不难得到(R+ ) - ( R+ )
17、 cos( &/2)=2 一般0远小于1弧度,(R+ )( 0) 2/8=2n=0.5 冗 JR/ +10.5冗寸R/ 若取& 0.5,代入式(3)可得由式1和式2解得:当圆心为(m,n )时,将圆分成360份,假设物体走到第i份时,以圆心为原点, 物体的坐标(X,Y)计算为i的角度宀180物体的位置 X =m+ rcoSY = n +r s i n求得物体的坐标位置后在利用以上坐标点参数的计算得出来的结果控制物体在 两点坐标间走直线。多边形的边数 n的值越大,画出来的圆精度就越高。2)、多边形逼近法画圆流程框图在上面的讨论中,知道了多边形的边数n的值和多边形顶点坐标的推导方法,这样可以利用画
18、直线的简易算法用线段来完成圆。以圆心在(X1,Y1 ),起点在(X1-R,Y1),顺时针方向画圆流程图如下图10。图10多边形逼近法画圆流程图由于在直线的简易算法处理过程中,起点为坐标( X1-R,Y1、。所以在多边 行逼近中,每画一条直线,都要把坐标平移把起点 Xi和yi放到起点,再调用直 线简易算法。这种方法简单易行,在直线简易算法的基础上经过简单的数学计算处理,多 次画线就可以实现画圆,相比较圆弧插补法, 多边形逼近法程序代码少,可以大 大节省内存空间;程序流程简单,容易编写调试;运行速度也相对圆弧插补法有 较大提高。3)、软件编程软件编程使用凌阳unSP IDE 1.8.4平台,该平台
19、集程序的编辑、编译、链 接、调试和仿真等功能为一体,可以使用 C语言和汇编语言混合编程,编译效 率咼,在线调试方便。具体程序略。3、实际测试(1)测试设备模拟行使路线:示意图见试题(E题)卷尺:精度0.01m秒表:精度0.01s坐标纸采用喷塑坐标纸(调试中易于擦洗无用的画笔轨迹)(2)走自行运动实际测量结果第一次走实际测量结果:到达目的坐标, 差1.7cm,运行时间为124秒。第二次走实际测量结果:离达目的坐标 最大偏差1.4cm,运行时间为131秒。第三次走实际测量结果:离达目的坐标 最大偏差1.3cm,运行时间为147秒。第四次走实际测量结果:离达目的坐标 最大偏差1.1cm,运行时间为1
20、18秒。第五次走实际测量结果:离达目的坐标 最大偏差1.3cm,运行时间为138秒。第六次走实际测量结果:离达目的坐标 最大偏差1.9cm,运行时间为128秒。运动轨迹与预期轨迹之间的最大偏1.3cm,1.1cm,1.5cm,0.8cm,1.4cm,运动轨迹与预期轨迹之间的运动轨迹与预期轨迹之间的运动轨迹与预期轨迹之间的运动轨迹与预期轨迹之间的运动轨迹与预期轨迹之间的1.5cm.六次运行物体离达目的坐标最大误差为最大偏差1.9cm。平均运行时间约为130秒。达到了预期的效果。运动轨迹与预期轨迹之间的(3)画圆实际测量结果画圆测试结果如下表第一次画圆以(40,50)为圆心,对圆周进行8个点采样圆
21、上的坐标物体实际坐标(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,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)
22、(59.1,34.2)(40,25)(40.6,24.5)(22,32)(23.5,32.4)最大误差为2.2cm,运行时间为224秒画,画笔曲线接近圆。第三次画圆以(40,50)为圆心,对圆周进行8个点采样圆上的坐标物体实际坐标(15,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秒,画笔曲线接近圆。三次画圆,运动轨迹与预期轨迹
23、之间的最大偏差2.2c m,平均运行时间约为224秒,达到了预期的效果。(4) 走黑线实际测量结果运动轨迹与预期轨迹之间的偏差1.8cm,连续运动轨迹与预期轨迹之间的偏差2.3c m,连续运动轨迹与预期轨迹之间的偏差1.6cm,连续运动轨迹与预期轨迹之间的偏差0.9c m,连续运动轨迹与预期轨迹之间的偏差2.2cm。走过第一次走黑线走完连续线段, 线段运行时间为95秒。第二次走黑线走完连续线段, 线段运行时间为98秒。第三次走黑线走完连续线段, 线段运行时间为101秒。第四次走黑线走完连续线段, 线段运行时间为94秒。第五次走黑线走完连续线段,第一个断点,走断续线段运动轨迹与预期轨迹之间的偏差
24、2.5cm,时间为95秒,第一个间断线段运行时间为 45秒。第六次走黑线走完连续线段,运动轨迹与预期轨迹之间的偏差 第一个断点,走 断续线段运动轨迹与预期轨迹之间的偏差2.1cm,时间为97秒,第一个间断线段运行时间为 54秒。第七次走黑线走完连续线段,运动轨迹与预期轨迹之间的偏差 第二个断点,走 断续线段运动轨迹与预期轨迹之间的偏差1.5cm,时间为92秒,两个间断线段运行时间共为 96秒。第八次走黑线走完连续线段,运动轨迹与预期轨迹之间的偏差 第二个断点,走断续线段运动轨迹与预期轨迹之间的偏差1.9cm,时间为96秒,两个间断线段运行时间共为102秒。连续线段运行1.5cm。走过连续线段运行1.4c m。走过连续线段运行1.2c m。走过连续线段运行八次运行物体运动轨迹与预期轨迹之间的最大偏差2.5cm,连续线段平均运行时间约为95秒,间断线段平均运行时间约为 98秒,达到了预期的效果。(5) 其他附加功能1
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 私下存款协议书
- 工地铝模劳务协议书
- 建筑穿线清包协议书
- 小区户外合同协议书
- 工地车辆承包协议书
- 市政施工占地协议书
- 淘宝平台协议书
- 珠宝合作协议书
- 小区门禁管理协议书
- 种子销售协议书
- 2024年中国家具电商行业市场竞争格局及投资方向研究报告(智研咨询)
- 导数(30题)-2024年考前15天高考数学冲刺大题训练(新高考)含答案
- 高层建筑一栋一册消防安全档案
- 创造性思维与创新方法智慧树知到期末考试答案章节答案2024年大连理工大学
- 外科围手术期营养支持疗法
- 广东省深圳市南山区2023-2024学年四年级下学期期末科学试题
- 2024年江苏省高考化学试卷(含答案)
- 2024年安徽省初中(八年级)学业水平考试初二会考地理试卷真题
- 小学二年级数学100以内三数加减混合运算综合测验试题大全附答案
- 中国特色社会主义期中测试题-2023-2024学年中职高教版
- 学习康复科常见物理治疗法课件
评论
0/150
提交评论