毕业设计打印样式终稿XX530.doc

毕业设计打印样式终稿XX530 长春大学人参加工温度控制系统设计I装订线线阵CCD机器人路径识别系统设计【摘要】本设计以Freescale16位单片机MC9S12XS128作为系统控制处理器，MC9S12XS128有16路A/D转换，精度最高可设置为10位，有8路8位PWM，并可两两并联为16位精度PWM,采用基于CCD摄像头获取图像信息。 通过软件算法提取路径，识别当前所处位置，控制电机速度，通过光电编码器实时获取机器人速度，形成速度闭环控制。 采用PID方式对舵机转向进行控制。 调试过程中应用2401无线模块与上位机辅助。 机器人将通过特定算法分析出前方的路况，并根据路况的不同而为机器人分配以不同的速度，完成机器人路径识别的系统。 类似的机器人可用于设备检测装置，以自主和遥控的方式，代替人对室外设备进行巡测，以便及时发现设备的内部热缺陷、外部机械或电气问题如异物、损伤、发热、漏油等等，给人员提供诊断设备运行中的事故隐患和故障先兆的有关数据。 主要实现机器人动力驱动，根据系统路径规划和遥控指令实现车体的运动控制，包括速度、位置控制。 适用于复杂的工业环境、设备监测；可实现全天候不间断的远程监控；采用红外热像监测技术，实现远距离、非接触的设备诊断。 机器人控制器的标准化和网络化，以及基于PC机网络式控制器已成为研究热点。 编程技术除进一步提高在线编程的可操作性之外，离线编程的实用化将成为研究重点。 多传感系统为进一步提高机器人的智能和适应性，多种传感器的使用是其问题解决的关键。 其研究热点在于有效可行的多传感器融合算法，特别是在非线性及非平稳、非正态分布的情形下的多传感器融合算法。 另一问题就是传感系统的实用化。 机器人遥控及监控技术，机器人半自主和自主技术，多机器人和操作者之间的协调控制，通过网络建立大范围内的机器人遥控系统，在有时延的情况下，建立预先显示进行遥控等。 机器人向人们展示的是一门集机、电计算机材料传感器控制技术于一体的综合技术也是一个国家科技水平的标志。 研制机器人的最初目的是为了帮助人们摆脱繁重劳动或简单的重复劳动，以及替代人到有辐射等危险环境中进行作业，因此机器人最早在汽车制造业和核工业领域得以应用。 随着机器人技术的不断发展，工业领域的焊接、喷漆、搬运、装配、铸造等场合，己经开始大量使用机器人。 另外在军事、海洋探测、航天、医疗、农业、林业甚到服务娱乐行业，也都开始使用机器人1。 1.2国内外发展现状机器人技术的发展，他可以说是一个科学技术发展共同的一个综合结果，同时为社会经济发展产生一个重大影响的一门科学技术。 随着我国经济的快速发展，我国工业机器人的市场将不断扩大，这一点无容置疑。 这也从另一个侧面说面了为什么世界各大机器人公司纷纷登陆中国市场。 市场有了，但多是国外的，拥有了自主知识产权的机器人还很少，这一点要引起我们的高度重视2。 在我国，工业机器人市场份额大部分被国外工业机器人企业占据着。 在国际强手面前，国内的工业机器人企业面临着相当大的竞争压力。 如今我国正从一个“制造大国”向“制造强国”迈进，中国制造业面临着与国际接轨、参与国际分工的巨大挑战，对我国工业自动化的提高迫在眉睫，政府务必会加大对机器人的资金投入和政策支持，一方面国家要对国产工业机器人给予更多的扶持；另一方面也望企业使用国产机器人给国产工业机器人行业一个机会。 由于国产工业机器人的功能已经与国外相当，长春大学人参加工温度控制系统设计共13页第2页装订线只要有批量，一定能够造就一个或几个中国品牌的工业机器人。 今后人类社会对机器人的依赖是将越来越大。 随着科技的发展，当今军事武器的发展来看，机器人的运用已到非常成熟阶段。 关系到国防，太空、经济、所以国家非常重视机器人行业的发展。 总之机器人是引领未来的高科技的产品，发展空间巨大。 长春大学人参加工温度控制系统设计共13页第3页装订线第2章硬件系统设计2.1硬件整体系统框图电路硬件设计以Freescale16位单片机MC9S12XS128作为系统控制处理器，系统包括电源管理模块，路径识别，舵机控制模块，电机驱动模块，无线通信模块等。 系统结构框图如图2.1所示:图2.1机器人路径识别系统硬件系统框图以Freescale16位单片机MC9S12XS128作为系统控制处理器，采用CCD摄像头作为传感器获取路径信息，CCD摄像头按一定分辨率，以隔行扫描的方式采样图像上的点，当扫到某点时，通过图像传感芯片将该点图像灰度转换成与会对称对应关系的电压值，将此电压值通过视频信号输出。 由于MC9S12XS128的AD采集速度有限，采用LM1881视频信号分离芯片进行分离提取，LM1881视频信号分离芯片可以从摄像头信号中提取信号的时序信息，如行同步脉，场同步脉冲，奇、偶场信息以供单片机I/O口作控制之用，提取路径，识别当前所处位置，由单片机控制电机速度，通过光电编码器实时获取机器人速度，形成速度闭环控制，采用PID方式对舵机转向进行控制。 调试过程中应用2401无线模块与上位机辅助。 长春大学人参加工温度控制系统设计共13页第4页装订线2.2核心控制Freescale MC9S12XS128B微控制器Freescale MC9S12XS128系列MCU是以高速CPU12内核为基础的微控列，简称S12系列。 典型的HC12总线频率为8MHz，而典型的S12总线频率为25MHz。 HC12与S12指令完全兼容，故统称为HCS12系列微控制器。 MC9S12XS128B有16路AD转换，精度最高可设置为10位；有8路8位PWM并可两两级联为16位精度PWM，特别适合用于控制多电机系统。 它的串行通信端口也非常丰富，有2路SCI，2路SPI此外还有IIC，CAN总线，增强型捕捉定时器等端口，并且采用了引角复用功能，使得这些功能引角也可设置为普通的I/O端口使用。 此外它内部还集成了完整的模糊逻辑指令，可大大简化我们的程序设计。 在单片模式下，A口、B口和部分E口都可以用作通用I/O接口，如果所有接口工作在通用I/O方式下，那么I/O口将达到63个。 这些双重功能的I/O口本身及控制逻辑完全集成在MCU内部，其体积、功耗、可靠性、应用简单方便程度都与用户自行扩充的I/O口有着重要区别7。 2.2.1MCU最小系统MCU运行程序所必需的最小系统包括电源电路，复位电路，晶振电路，PLL电路。 而单片机的电源电路在下面介绍了，这里就不再介绍。 单片机的复位电路由一个键盘，两个电阻，一个电容构成。 复位电路如下图2.3图2.3单片机外部复位电路外部复位是指MCU的RESET引脚上外加一个低电压使得MCU强制复位。 本设计复位电路是MC34064电平监视器，当电源电压低4.65V，其输出将保持低电平。 这样在上电阶段，靠MCU内部POR建立初始状态，靠MC34064保证电源电压达到4.65V当电源电压跌落或掉电过程中，MC34064可以保证MCU及时复位。 通过按钮将RESET引脚拉低超过一定时间就可以实现手动复位。 对于简单的非在线应用系统，可以不考虑上电速度和掉电问题，这时只保留一个上拉电阻和复位按钮即可。 手动复位电路在系统调试时非常有用当做成目标系统后，可以将其略去。 长春大学人参加工温度控制系统设计共13页第5页装订线单片机正常工作晶振电路由16MHZ晶振及两个电容，一个电感构成，如图2.4所示，其作用是为系统提供基本的时钟信号，通常一个系统共用一个晶振便于各部分保持同步，晶振提供的时钟频率越高，单片机的运行速度就越快。 长春大学人参加工温度控制系统设计共13页第6页装订线第3章系统软件设计本设计控制软件采用大赛提供的CodeWarrior软件此外，厂家提供的编程环境支持C语言和汇编语言的程序设计，以及C语言与汇编语言的混合编程，大大方便了用户的程序设计，提高了系统开发效率。 本设计程序代码使用C语言编写。 其使用界面如图3.1所示长春大学人参加工温度控制系统设计共13页第7页装订线开始结束采集完成？关闭定时器中断初始化行指针和黑线存储位置指针设定首行检测相对左边界值和点计数初值黑线中心检测完成？设定检测绝对左右边界值读一个图像点计数器加1点计数器值大于绝对右边界？是黑点？黑点计数器加1记录黑线右边界位置黑点计数器大于1？指向下一个点黑点计数器大于0？计算黑线中线位置并存储黑线中心位置存储指针加1，黑点计数器清0，行指针加1设定检测相对左右边界值，点计数器初值黑线中心位置存储#SFF黑线中心位置存储指针加1，行指针加1YNYNYY NY记录黑线左边界位置NYNN图3.4黑线中心检测流程长春大学人参加工温度控制系统设计共13页第8页装订线3.3转向舵机控制对于舵机的控制，我们采用开环控制，由于舵机的控制精度高，一个PWM占空比对应一个角度，因此开环控制的效果较好。 我们采用的是PD控制，因为这样可以让舵机的控制速度更快，输入黑线位置和黑线位置的变化率，通过分段比例控制输出相应的PWM值。 因为机器人处于弯道和直道的转向模型不同，统一的比例带过大会导致机器人振荡，过小导致最大控制量偏小，机器人转向不足一的比例带过大会导致机器人振荡，过小导致最大控制量偏小，机器人转向不足过弯时冲出路径。 使用分段比例控制既方便又可以解决以上两种问题。 3.4速度控制对于速度的控制，我们采用闭环控制，控制量由TLE6209给出，而速度反馈量由编码器测得。 编码器输出的脉冲输入到PA10，通过定时器申请中断，间隔一定时间读取PA10的值，由于是一定时间内的脉冲数，所以可以看成是电机速度。 给定量是根据当前传感器的检测到黑线的位置给出的，我们选择了模糊推理给定，该模糊控制器是一个两输入，一输出。 输入黑线位置和黑线位置的变化率，通过模糊推理输出一个当前所需的速度量。 在通过一个增量式PID调节器使电机的实际速度尽可能快的接近给定速度。 3.4.1模糊控制设定速度因为机器人识别的路径是的，弯道的分布情况也不能确定，机器人可能频繁的进出弯道，不停的调整速度来适应不同轨迹。 这样就难以建立精确的数学模型，且机器人对动态性能要求较高，考虑到该款单片机有一套特色指令模糊控制指令，执行时间只有几十us级（时钟频率为25M），不会影响决策周期，且简单易行，而模糊控制具有处理不明确信号的能力，故最终选定采用模糊控制设定速度 (1)模糊输入输出量的选取机器人模糊控制器采用二维模糊控制器，输入变量E、E分别选为黑线位置distance及其变化率diff，输出变量U选为机器人的速度设定值Vi_Ref。 表3.1模糊规则表E ENB NS Z PS PB NBNB NSPS PBPS ZNSZPB ZNS PBPSPBPS NSNB (4)模糊推理及解模糊化在模糊推理过程中，选用了REV指令。 MC9S12XS128单片机中规定各个前件之间只进行模糊与运算，而如果几个规则的逻辑后件影响到同一个模糊输出，它们之长春大学人参加工温度控制系统设计共13页第9页装订线间隐含模糊或运算。 即使用MINMAX法进行模糊推理。 反模糊化采用重心法（COG法）。 WAV是解模糊的核心指令，它与EDIV指令配合完成模糊输出到控制输出的变换。 3.4.2PID参数的整定试凑法是通过闭环试验，观察系统响应曲线，根据各控制参数对系统响应的大致影响，反复试凑参数，以达到满意的响应，最后确定PID控制参数。 试凑不是盲目的，而是在控制理论指导下进行的。 在控制理论中已获得如下定性知识比例调节（P）作用是按比例反应系统的偏差，系统一旦出现了偏差，比例调节立即产生调节作用用以减少偏差。 比例作用大，可以加快调节，减少误差，但是过大的比例，使系统的稳定性下降，甚至造成系统的不稳定。 积分调节（I）作用是使系统消除稳态误差，提高无差度。 因为有误差，积分调节就进行，直至无差，积分调节停止，积分调节输出一常值。 积分作用的强弱取决与积分时间常数Ti，Ti越小，积分作用就越强。 反之Ti大则积分作用弱，加入积分调节可使系统稳定性下降，动态响应变慢。 积分作用常与另两种调节规律结合，组成PI调节器或PID调节器。 长春大学人参加工温度控制系统设计共13页第10页装订线结论本文基于飞思卡尔公司的16位微处理器MC9S12XS128为控制核心，设计了采线阵CCD摄像头来识别路径的机器人系统。 实现了机器人能在白色的场地上，沿着任意给定的黑色引导线按照给定的速度行驶。 具体工作如下 （1）硬件部分采用模块化设计，主要由电源的管理单元，路径识别单元，速度检测模块、舵机控制单元和直流驱动电机控制单元组成。 （2）软件部分的模块设计主要包括单片机初始化模块，实时路径检测模块，舵机控制模块，驱动电机控制模块，中断速度采集模块，速度控制模块等。 （3）控制算法分为舵机控制和速度的控制，舵机控制通过输出的PWM信号进行开环控制，速度控制采用模糊控制进行速度的设定，采用PID控制调节速度。 通过模糊控制器和PID控制的调节，机器人动态性能良好，适应性强，整体控制效果良好。 采用分段比例控制和BANG-BANG控制之后，能够更合理更平滑地过弯，加减速性能也获得了一定提高。 由于时间的限制，仍有许多地方需要完善。 如考虑对舵机转向加上反馈信号进行闭环控制，使得舵机的转向更为准确；采用MOS管驱动电机，获得更好的加速性能；让记忆算法更加的安全可靠。 长春大学人参加工温度控制系统设计共13页第11页装订线致谢本课题在选题及研究过程中得到老师的悉心