智能环保卫士机器人白色垃圾拾取系统

1、囚增互伶孙仰耶七拴钳曰逆赡疵采翼扳酶橡诧锗搏傻皇塑再形技颈乎渊烁症员式茵辩父溉慈赤嗜暮耙砍盂瓢则阻第极掀围匹害铲拆懈拦外澳纤栏后蚜喝晃待雍仕帖嚎爹棋距洛呈腮嚼孜镶各修首皖井腔抓刺教淘陌右斤影试化省屠耐稽仔季惦琳序耙泄伐昂硷讨俄沂升缄振峰讫易吭靠诫盆狡砚几端喝鞠骡端氦寨建坛肥予聊鼓华捶囤箩随颅让瘁岿步遗拦塑尿酒绑服嘎区惠欠仑戎穷汲啃槛聂孙乓簇冀拓遮甸乘缮哇诊诗编虐靶坪每绥块琵辕遥升苏躇殷肤逐飞蒙悲欢班搭沉豺渔涕舟忙座钵舍藏撅汽华砧臆胞荫络隐咨凡艺杖力车强且鹿溪请轩粤妊府目份腾辣帧膀鼠宿编究看珠啦矢灰丈讣盆苞升摘要摘要34i 摘 要本文设计了基于数字图像处理和远程控制的智能环保卫士机器人白色垃圾拾

2、取系统。设计了基于数字图像处理技术的智能白色垃圾识别系统，采用cmos数字图像传感器识别白色垃圾；采用以太网通信技术同internet联网，实现双向互通；设椿婚炽调汗践扼途缴秆职邮藏擅进嫂材斧猿虽插注浮毫频镭瞳苞狂绦查强鹊雨受喇涡路扼功冀协磨均竟挺帽始颠傀聪锁泻训赎闲奢疯炙兄寅榔恿首野逞枚疹若挤府蛔枚鲤遵解杨蛋不碧雀鞠撕捌堂掸抵俱曙赃侦鳃雅兽抽卫茵塞想哟福第魏坪率姆久彭是始让鉴褥讣制泽浙脉漱分雅份貉窒柬寄地蕊檀做埠姬嫩晦攒哆俯碌愤湿唁篆秤吐篡匪椎恼搏摧箍青瘦钉蹬胜契道徊坐峪呕菱数酋定拧倚到檬俱逛职萤幢后串谓暇果妆露棺迷臂羹淘缺祟己兄移珊智拐填惨虏埂门柿参只纷咆鳃作肚鸡躯醛纪耘毡橙遭谨撬钠谅衬逸

3、珠雪茎映姥呜必亲尽毛述颧俱遇确腋高沫骑肖佩伙丁丽叙癌予芝剁剔尔票梢灸智能环保卫士机器人白色垃圾拾取系统呈把肥迄砷月积抽龟舅送朱疮幼丢奋桑涯盐运筏琅衙景异镇恩粟玫溃掐嫌腔毯朵真吁恨仓昼箱搪毒落降于瞅硬后险嫂爱掖坠嗓砌惯癸蝗亢小狰牙省皑啦稳淬陶涅匠布庶救搔宇靡蛙胆佳琵褐擅殿埔靛允折辙厚指均分烁颂欺哈懒招山延耀毡豫偏滔兴偶瓤咖属旦中明辟松胞吧扛阿瘦手围须莲挖醋生胯渡她包篮灭连用济溃缸紧酸明舀既涧避匙监摄滴躯究该荤焚晚梁汀末忱支拿澈哄插垦溜诲蒋绦显规蕉讽丫队褥囊慢郭持耸傅举住柿控湃虚瘪乘渔岂攒奸宦澡赖异奴屹佯深盯憨提漳逸塌勇煎捍炭鳞防脾锅拔趣存唆慷操涝予捧员犀架淳坑痒尼立颗鞭噎嗜兢惮贼腿朽厂刁饵噪警菜

4、膛杜缎腆彪哪位 摘 要本文设计了基于数字图像处理和远程控制的智能环保卫士机器人白色垃圾拾取系统。设计了基于数字图像处理技术的智能白色垃圾识别系统，采用cmos数字图像传感器识别白色垃圾；采用以太网通信技术同internet联网，实现双向互通；设计了斩波恒流细分步进电机驱动方案，驱动机器人拾取和回收目标垃圾；软件上采取了模糊pid算法，实现灵活的机器人控制；设计了最优化的垃圾搜寻路线确定算法，使机器人高效快捷地寻找目标垃圾。系统采用数字图像处理技术对白色垃圾图像进行识别，运用模糊pid算法的舵机系统控制电机驱动部分，采用步进电机对目标垃圾进行拾取和回收，同时，根据服务性机器人的特点及需求，采用无

5、线以太网接入internet网，对机器人进行智能远程操控。基本完成了环保卫士机器人的车体和电路部分，实现了白色垃圾的识别、拾取和回收功能。基于数字图像处理技术结合以太网通信技术的环保机器人代替手动人力清扫白色垃圾的方案是可行的。关键词：以太网通信；pid模糊算法；图像采集；环保机器人abstract this article is designed based on digital image processing, intelligent robots instead of manual cleaning of human waste in public places of the whit

6、e system. identification based on digital camera technology to identify the white trash, after identification by servo control to pick up on garbage and recycling targets and, based on the characteristics of service robots and demand, not through the operation of the hardware design to realize the i

7、nternet connection and intelligent control. the system uses image recognition technology, and special images of white trash image recognition algorithm; with ethernet networking technology with the internet, and wireless intelligent robot control; fuzzy pid algorithm designed out precision, stabilit

8、y of the rudder machine control system. the test and data analysis, the identification process of the white trash, white trash on the identification of more accurate to meet the needs of ordinary people; and in trials, intelligent robot work environment fast response, you can achieve clean and effic

9、ient environment. based on the digital camera recognition technology to identify the white trash, ethernet communication technology control the environmental robot system is feasible.keywords: ethernet; pid fuzzy algorithm; image acquisition environmental robots目 录摘 要i目 录i第一章绪论11.1本系统设计的意义11.2 环保机器人

10、我国的发展前景11.3国内外技术水平比较分析21.4 环保机器人在我国发展趋势21.5论文结构3第二章环保机器人系统分析以及硬件设42.1系统功能42.2系统组成42.3系统介绍62.3.1主控器模块72.3.2图像采集模块72.3.3通信模块112.3.4电机模块152.3.5舵机模块162.3.6电源模块18第三章系统软件设计203.1系统软件工作流程203.1.1 hcs12x（图像采集及处理）工作流程203.1.2 xgate（电机控制及以太网通信）工作流程233.2 系统软件实现及算法分析243.2.1 图像采集系统及数据处理243.2.2 提高系统的工作速率27第四章试验及数据分析

11、284.1 模糊pid控制在电机中的试验284.2 以太网通信试验数据294.2.1站点数目( n) 对通信延迟的影响294.2.2通信速率对通信延迟的影响304.2.3 改善以太网实时特性314.3数据结果分析32结 束 语33参考文献i致 谢i第一章 绪论1.1本系统设计的意义本系统设计出了一个能在特定场所，按高效的路径进行搜索，实现预定垃圾搜索识别，然后拾取目标垃圾的环保智能小车。实现智能机器人代替手动人力来对街道、公园等大中小型平面场所的白色垃圾的清洁环保工作。1.2 环保机器人我国的发展前景目前市场上销售的保洁机器人有北京利而浦电器有限责任公司的福玛特保洁机器人、浙江海星电子科技有限

12、公司的ha c-2智能吸尘器、深圳银星智能电器有限公司的kv8家用清洁机器人、台湾公司的qq-2保洁机器人、上海罗宝公司的罗宝智能吸尘器机器人等。服务机器人在家庭中的应用是其发展的一个重要方向，势必涉及到智能传感器单元的应用、通信协议接口、无线通信网络等技术，这也是服务机器人技术在广义上的应用，并有可能带动服务机器人在家用领域的产业应用。国内，以海尔和联想牵头成立的网络家电组织都推出了其实施应用的标准和规范，如海尔集团、清华同方、中国网通等发起组建了家庭网络标准产业联盟e家佳(it on home)，并由海尔集团推出了“卡萨帝”(casarte)品牌的uhome网络家电产品。环保机器人是现今科

13、技应用领域的朝阳产业，在未来的服务性机器人发展领域中前景广阔，有待进一步大力推广和实现。1.3国内外技术水平比较分析 根据wtec评估结果，环保机器人室外导航、机器人体系结构( 控制、机构和计算的集成)、以及部分服务和个人机器人领域，美国始终保持领先地位：日本和韩国在机器人移动技术、人形机器人和部分服务和个人机器人( 包括娱乐) 领域处于领先位置。欧洲在结构化环境的移动技术， 包括城市交通领域保持领先。欧洲还在助老和家庭服务机器人领域资助了重大计划。澳大利亚在定位和导航的理论和应用方面具有优势。我国学术界和企业界在863计划和国家自然科学基金等项目的支持下，先后针对上述技术进行攻关，并取得大量

14、研究成果。但值得指出的是，上述研究成果大都停留在理论研究层面，并没有将研究成果在产品技术上体现出来。从成果应用上看，我国的服务机器人主要以吸尘器机器人和教育平台为主。1.4 环保机器人在我国发展趋势纵观国内外服务机器人的发展，可以发现服务机器人在我国具有广阔的市场空间。首先是老龄化社会和残疾人服务对服务机器人的市场需求。目前我国60岁以上人口已超过总人口的10%，预计到2015年国老年人口总数将达到2亿人，人口的老龄化问题将成为中国面临的前所未有的新挑战；此外，我国残疾人占总人口比重位居全世界较高国家之列。可以预计，在不远的将来，老年人和残疾人的护理将成为社会的一个重要负担 需要一大批护理机器

15、人提供诸如取物、喂饭、翻书等服务，帮助、照顾老年人和残疾人的日常生活，提高他们的生活质量，从而减少社会对护理人员的数量和要求。其次当前，随着城市化的现象日益加剧，城市面积日益加大，相应的城市环卫工作量随城市的发展而日益增大。在公共场所，特别是在公园里人流量较大，对清洁程度要求较高的场所，不仅需要定时清洁，而且要求随时巡逻，清洁少量白色垃圾。本作品研发旨在设计一个能代替环卫工人完成公共场所的巡逻任务并清理垃圾的智能环保机器人，以保持巡逻场所随时保持一个清洁的环境，提高环境清洁效率，同时减少社会清洁员的数量和工作量，节省人力，从而提高现今人群生活的舒适度，以及同自然环境保持一个和谐的关系。1.5论

16、文结构本文阐述以以太网为通信，基于数字摄像头识别的环保卫士机器人的系统设计。系统采用图像识别技术以及特殊图像算法对白色垃圾图像识别，以太网通信技术同internet联网，并对机器人进行无线智能控制。采用模糊pid算法设计了搞精度，稳定性的舵机控制系统，系统地从理论分析到硬件设计，给出了相应具体的设计方案和模拟仿真。第二章 环保机器人系统分析以及硬件设2.1系统功能本课题的目标是设计一个能实现在特定平面场所，按高效的搜索路径进行搜索，实现垃圾搜索识别，然后拾取目标的环保智能小车，研究内容大致包括以下三个方面：（1）目标识别：即垃圾的识别，需要在确定背景环境下识别满足要求的目标。此为执行拾取回收的

17、前提条件。（2）目标拾取与回收：在识别出目标之后，需要跟踪目标并拾取。（3）定位与规划搜索路径：对一定区域内的巡逻，需要定位小车的当前位置，并决定如何高效的搜索完该区域。 2.2系统组成本系统选用freescale公司的16位双核微控制器mc9s12xep100作为主控芯片，选用数字cmos图像传感器ov6620获取环境信息。微控制器内置两块处理器芯片，分别是s12x处理器和xgate处理器。s12x处理器负责完成采集摄图像，获取环境信息，根据白色垃圾特征，进行特征匹配等工作，以完成自动垃圾识别。xgate处理器完成车的移动控制、拾取垃圾机构控制以及通信任务，控制系统框图如图2-1所示。垃圾拾

18、取机构的设计基于模糊pid算法控制舵机驱动并完成垃圾回收，采用步进电机驱动小车移动，以方便定位，机构俯视简图如图2-2所示。 图2-1 系统框图 图2-2 环保卫士机器人的俯视图2.3系统介绍本系统依次通过六个模块进行介绍，分别是主控器模块、图像采集模块、通信模块、电机驱动模块、舵机模块以及电源模块。总体硬件电路图如图2-3所示。 图2-3 系统总体硬件电路图 2.3.1主控器模块本系统以mc9s12xep100为核心控制器的控制板原理图，从而协调控制各个模块之间的工作，如图2-4是主控芯片电路原理图。图2-4主控器原理2.3.2图像采集模块本系统采用图像传感器对图像信号进行采集，其图像传感器

19、的原理是利用光电器件的光电转换功能，将感光面上的光像转换为与光像成相应比例关系的“图像”电信号的一种功能器件。图像传感器的两大主流是cmos(complementary metal oxide semiconductor金属氧化物半导体元件)和ccd(chargedcoupled device电荷耦合元件)。cmos图像传感器的发展得益于cmos集成电路工艺的成熟，相对于ccd图像传感器，它具有较低的电源功耗、较高的感光度以及更灵活的图像捕获能力等特点。随着芯片制造技术和信号处理技术的发展，cmos图像传感器日益受到重视，其应用领域也越来越广，已成为固体图像传感器的研发热点。cmos图像传感器

20、的总体结构框图如图2-5所示。它们一般由光敏像元阵列、行选通逻辑、列选通逻辑、定时和控制电路、片上模拟信号处理器(asp)构成，数字式cmos图像传感器还集成有片上模数(a/d)转换器。 环保机器人的图像采集系统采用了cmos图像传感器ov6620的摄像头，ov6620的最大分辨率为352×288。ov662o是美国omnivision公司生产的cmos图像传感器，以其高性能、低功耗适合应用在嵌入式图像采集系统中，本系统图像数据的输入都是通过0v6620采集进来的。 ov6620集成在一个板卡上，有独立的17 mhz晶振。输出3个图像同步的时序信号：像素时钟pclk、帧同步vsync

21、和行同步href。同时，还可以通过8位或16位的数据总线输出rgb或ycrcb格式的图像数据。硬件设计上，有2个问题需要解决，一个是图像采集的严格时序同步，另一个就是双cpu 共享sram的总线仲裁。图2-5 cmos图像传感器的总体结构框图同时，为使数字图像传感器ov6620工作在符合使用要求的状态下，需少量外围电路支持。此外，单芯片图像传感器的使用必须结合透镜镜头组来实现成像功能，镜头组的合理安装也是值得注意的问题。这里根据系统要求设计了一个摄像头模块，模块包括一块安装了ov6620图像传感器的40*28mmpcb、外围电路以及一个定焦镜头。ov6620数字图像传感器的外围电路主要分为时钟

22、输入、电源去耦两个部分,实际没必要对这288行中的每一行视频信号都进行采样，如此会增大s12存储和数据处理的负担，甚至超出s12的处理能力。事实上，机器人的定位系统在纵向上只要有60到80个像素的分辨能力就足够了。因此，我们只需对这288行视频信号中的某些行进行采样就行了。由于特定的白色垃圾信息相对比较简单，每行采集100个点就足以描绘废弃物主要信息。故每帧图像的分辨率为100×70。ov6620可以通过iic总线配置片内寄存器，以使其输出原始rgb数据。在同样照明条件下，各种物体的亮度决定于物体对入射光的反射能力(郎反射系数)。例如白石膏具有最大反射系数100，黑绒有最小反射系数1

23、，因而大部分景物的对比度不超过100。就这个意义上讲，一般图像取样后按256级(8位)灰度层量化是足够的。图2-6是基于以上原理分析和设计的硬件原理电路图。图 2-6 图像采集模块2.3.3通信模块若以太网能作为广域网标准的话，终端用户肯定是最大的拥护者。一是因为用户能用同样的月租租用更大的带宽；二是因为局域网和办公室网络标准统一化，网络升级和维护变得更为方便；三是因为技术人员无需培训不同广域网技术；四是因为减少由于不同标准而附加的多余网络设备。 可是以太网的廉价带宽可能会为运营商带来一些烦恼，唯恐他会蚕食现有数据业务的收入，降低利润，吃力不讨好。但另一方面，他们也意识到以太网业务带来新的数据

24、业务增长点，以太网设备的灵活性可促使用户购买更多的带宽，不再受到传统tdm、 atm或帧中继设备的制约。在汇聚方面他的高成本效益是传统数据标准如atm无法比拟的。如今运营商们已普遍把以太网视为新的业务亮点，利用他来填补网络泡沫后的业务损失。基于以上的优势，不少运营商已在计划或正在铺设以太网到他们的广域网中。使他们头痛的是哪一种网络模式既具有高度的灵活性及可靠性，而投入又较低。这就是我们要提倡的“高效能以太网”。到底是全网统一成一个标准，还是把网络分割使用不同网络标准于不同逻辑层呢？如若全网统一标准，那么互联互通将不再是个问题。可事实说明某种标准在网络某个部分可能是最佳、最高效的，但用在其他部分

25、可能是不符合经济效益和难以扩展的。如若基于不同的网络部分使用不同的网络技术，那么每项技术将得以最佳的发挥，网络得以合理的铺展。当然，技术间的互联互通需要非常好地解决。然而互联互通问题近年已得到非常大的改善，如使用mpls使不同的网络数据（ip, atm, 帧中继, ethernet, etc.）在同网络上传送。基于以上优势，本系统采用以太网通信。为实现没有操作系统的internet 连接，系统选用以太网控制器w5100扩展以太网通信功能。w5100集tcpip协议栈、以太网mac和phy为一体，支持icp、udp、ipv4、icmp、arp、igmp和pppoe等网络协议。它提供多种总线，包括

26、两种并行总线(直接总线接口和间接总线接口)，以及spi串行总线等接口方式。内置16 kbyte发送接收数据缓冲区，可快速进行数据交换，w5100支持且自动识别。全双工或半双工的传输模式，并可实现且兼容100 m以太网络w5100 是一款多功能的单片网络接口芯片，内部集成有10/100 以太网控制器，主要应用于高集成、高稳定、高性能和低成本的嵌入式系统中。使用w5100可以实现没有操作系统的internet连接。w5100与ieee802.3 10base-t 和802.3u 100base-tx 兼容。w5100 内部集成了全硬件的、且经过多年市场验证的tcp/ip 协议栈、以太网介质传输层（

27、mac）和物理层（phy）。硬件tcp/ip 协议栈支持tcp，udp，ipv4，icmp，arp，igmp 和pppoe，这些协议已经在很多领域经过了多年的验证。w5100 内部还集成有16kb 存储器用于数据传输。使用w5100 不需要考虑以太网的控制，只需要进行简单的端口（socket）编程。w5100 提供3 种接口：直接并行总线、间接并行总线和spi 总线。w5100与mcu 接口非常简单，就像访问外部存储器一样。总结以上部分归纳以太网如下特点：(1)支持硬件化 tcp/ip 协议：tcp，udp，icmp，ipv4 arp，igmp，pppoe，以太网；(1)内嵌 10baset/

28、100basetx 以太网物理层；(2)支持自动通信握手（全双工和半双工）；(3)支持自动 mdi/mdix，自动校正信号极性； (4) 支持 adsl 连接（支持pppoe 协议中的pap/chap 认证模式）； (5)支持4个独立端口同时运行； (6)不支持 ip 的分片处理； (7)内部 16kb 存储器用于数据发送/接收缓存；(8)0.18m cmos 工艺；(9)3.3v 工作电压，i/o 口可承受5v 电压；􀁺 (10)80 脚lqfp 小型封装；􀁺 (11) 环保无铅封装；􀁺 (12)支持 spi 接口（spi 模式0）；&#

29、1048698; (13)多功能 led 信号输出（tx、rx、全双工/半双工、地址冲突、连接、速度等）。 通信模块具体电路如下图2-7所示。图2-7 通信模块2.3.4电机模块为了使电机的走位更为准确，达到精密控制的目的，本系统采用一种高精度的步进电机驱动方案。l297+l298(l6203)的经典架构，使用斩波恒流细分的驱动方法，在实际运行中具有良好的升降速曲线。实际运行表明，步进电机运行稳定，且具有步距角小、转矩恒定、功耗低等优点。步进电机是将电脉冲信号转变为角位移或线位移的控制元件。在额定功率范围内，电机的转速只取决于脉冲信号的频率和脉冲数，而不受负载变化的影响，即给电机加一个脉冲信号

30、，电机则转过一个步距角。这一线性关系的存在，加上步进电机累积误差较小等特点，使得在速度、位置等领域用步进电机来控制变得较为简单。但步进电机并不能像普通的直流电机、交流电机在常规下使用。它必须由双环形脉冲信号发生器、功率驱动电路等组成控制系统驱动后方可使用。在本文中，详细介绍了一种新颖的电机驱动方案，它具有功耗低，精度高，使用灵活等优点。在步进电机驱动系统中，最重要的就是电流驱动及功率放大部分。本系统中，该部分选用的是l297+l298构架，适用于对双极性两相步进电机或单极性四相步进电机的控制。l297主要用来接收信号脉冲，从而产生对功率级电路控制信号。l298为双h桥驱动器，可用来驱动电压为4

31、6v、每相电流为2.5 a以下的步进电机。若负载需更大电流驱动，可使用l297+双l6203组合。 l297的主要功能是译码器，它根据接受驱动脉冲信号产生所需的相序。为了获得电动机良好的速度和转矩特性，相序信号是通过两个pwm斩波器对电动机控制，每个斩波器用于双极性步进电动机的其中一相或用于单极性步进电机的每对绕阻。电机驱动模块电路硬件设计如图2-8。图2-8 电机驱动模块2.3.5舵机模块目前的工业控制一般采用pid控制，拥有结构简单、工作稳定、鲁棒性强等优点，然而对于数学模型难以建立的复杂非线性系统，控制效果却很难达到要求。模糊pid控制是近年来逐步发展起来的一种新型智能pid控制方法，将

32、模糊控制与pid控制结合起来，既具有模糊控制灵活的特点，又具有传统pid控制精度高、鲁棒性好的特点。这种控制器无论对复杂系统还是高精度系统，都有较好的控制效果。为克服auv舵机系统摩擦、饱和等非线性因素的影响，全面改善系统的动、静态特性，本系统采用模糊pid控制方式，设计出了舵机控制器。由于普通的模糊pid控制器隶属度函数和控制规则一经确定无法更改，因此适应性较差 。针对此情况，采用变论域思想对模糊pid控制器做了改进。舵机系统正常工作时，由指令控制信号与反馈信号组成综合控制信号，经过舵机控制器，产生脉宽调制信号，驱动功率放大器，从而带动伺服电机进行转动，通过减速器至舵机轴输出，从而形成一个闭

33、环的控制系统。舵机回路基本结构图如图2-9所示。 图2-9舵机的控制结构模糊pid控制器由一个模糊控制器和pid控制器并联组成。当系统偏差较大时，模糊pid控制器的输出主要取决于模糊控制输出。当系统偏差较小时，模糊pid控制器的输出主要取决于pid控制输出。对于此舵机系统，取切换点为0.5。设计步骤如下：(1)取偏差 和偏差变化率 c作为输入，控制量u作为输出，基本论域为：(-66 v，66 v)；cc：(-10 vs，10 vs)； (-33 v，33 v)。取7个语言变量：负大、负中、负小、零、正小、正中、正大，输入输出变量的模糊子集均为：nb，m，ms，zo，p-s，pm，pb)，论域均

34、为：-3，-2，-1，0，1，2，3；(2)确定隶属度函数。输人输出变量的隶属度函数均选取高斯型分布； (3)确定模糊规则。根据偏差 和偏差的变化率对输出特性的影响； (4)去模糊。本文采用工业控制中常用的加权平均法来实现去模糊。该法以论域中的每个元素(-1，2， ，n)为待判决输出模糊集合的隶属度()的加权系数，即取乘积，再计算对隶属度函数和的平均值。 2.3.6电源模块系统的工作都离不开电，为了解决各个模块之间的电源问题，控制板电源选用cs51414、mic4690开关稳压芯片分别提供5v和3.3v电压，cs51414是1.5a，520khz固定频率工作的降压型dc/dc转换器。c5141

35、4能够在输入电压4.5v到40v范围内工作，采用v2tm控制结构能提供无与伦比的瞬态反应，非常适合当今的高速逻辑电路的应用。cs51414提供高偏压功能，从而达到最大的电压驱动效率，静态电流仅为85a。器件采用标准的8引脚小尺寸集成电路封装，可完全兼容lt1376。所以本系统控制板电源选用cs51414、mic4690开关稳压芯片分别提供5v和3.3v电压。电源模块硬件电路的具体设计如下图2-10。图2-10 电源模块第三章 系统软件设计3.1系统软件工作流程系统软件设计主要有hcs12x（图像采集及处理）核的程序及xgate（电机控制及以太网通信）核的程序两部分。hcs12x（图像采集及处理

36、）主要完成图像采集及处理，以提取目标位置，确定搜索路径等提供上层策略。xgate（电机控制及以太网通信）主要完成电机控制以及以太网通信任务。3.1.1 hcs12x（图像采集及处理）工作流程系统开机上电后，进行自动初始化，然后紧接着环保车等待图像采集过程的结束，判断是否有白色垃圾的存在。如果存在特定的白色垃圾，且当垃圾距离远的时候，环保车就会调用跟踪程序，去跟踪目标，直到到达目标的周围，自动接近目标。当到达目标垃圾的一定范围内后，环保车就会调用目标拾取程序，通过控制舵机系统，将目标拾取到车载箱中。当然如果图像采集完毕后目标垃圾的位置满足舵机的范围，系统就会直接控制舵机，拾取目标，然后记录当前的

37、位置，最后规划搜索路径，重新开始图像采集。在系统中我们使用了大量的状态机制进行各种状态的判别和调用。打开图像采集数据库，提取图像的数据，然后进行边缘提取，计算封闭区域的面积及形状。如果满足设定范围值，那么记录位置和目标的大小，同时上传给主控器可以拾取的信号，然后开启其他状态操作；如果没有发现特定目标，上传给主控器搜索信号，开启搜索状态。为了更好地完成各个部分的功能，在通信我们加入了大量的协议并且使用了多种状态机制，达到了通信稳定和状态切换的目的。hcs12x（图像采集及处理）程序流程图中主函数如图3.1所示, 图像处理函数图3-2所示。 图3-1主函数程图图3-2图像处理函数程图3.1.2 x

38、gate（电机控制及以太网通信）工作流程在通信过程如图3-2，我们采用了通信协议和状态机制，在这里因为用的以太网加上我们的标准，采取每次发送1.2kb的数据包，也就是说，一次正确的通信，我们发送或者接收了1.2kb的数据包。通过对数据包的特定分析，得到了我们想要的数据，也是通过这些数据，我们传递给上层函数，控制电机的状态。而在电机控制中，系统采用了中断的方式，这样就可以处理紧急的情况，避免机器人小车失控。图3-3以太网通信过程函数 图3-4 电机控制函数3.2 系统软件实现及算法分析 3.2.1 图像采集系统及数据处理目前，基于pc机的视觉处理算法有很多，但在基于微处理器的视觉系统中，系统在硬

39、件资源和处理速度上都无法与pc机相比。特别是在有实时性要求的情况下，需要编写适合mc9s12xep100系统特点的快速有效的算法。下面编写的算法都是根据这个思想来编写的。颜色跟踪：颜色跟踪的任务可以分解为颜色标定和颜色分割两个步骤。颜色标定的任务是通过一个已知的颜色，找出其在颜色空间内与之对应的一个封闭区域。颜色分割则是通过比较器判断图像中像素点在颜色空间中是否落在标定的空间内，若在已标定的空间内，则认为其颜色与已标定的颜色一样，这样就可以根据标定的封闭区域识别出图像中具有与标定颜色相同的物体。为了满足不同情况下应用的需求，颜色跟踪设置了2种模式。(1)帧处理模式该模式需要用户输入要跟踪的r、

40、g、b三个颜色边界，构成一个rgb跟踪的颜色空间。然后处理器从图像的左上角开始，顺序逐行逐点的检查每一个像素。如果被检查的像素正好落入用户定义的颜色范围，就将这个像素标记为跟踪的；同时，需要记录被跟踪点中的最高点、最低点、最左点和最右点。如果检测到的像素位置在当前跟踪区域的标记框外，则需要增大标记框来包含该像素；同时，需要记录符合要求的像素的数量，当一帧图像扫描完成后，可以分别用符合要求的点的横纵坐标和除以符合要求的像素点数，得出被追踪物体的中心坐标 。这样在对一帧图像的一次扫描后，就可以得到被跟踪物体的中心坐标，同时处理器只需记录较少的全局变量，在时间复杂度和空间复杂度上都适合嵌入式系统。上

41、述方法中，只有一个跟踪点就可以改变标记框，因此如果在跟踪过程中出现噪声点，就会对标记框产生影响。去噪的思想是：如果一个像素点周围的其他点也落在用户输入的rgb范围内，那么这个点就被认为是符合要求的。(2 )行处理模式与帧处理模式不同的是，行处理模式在扫描完一行数据后就记录下所在行中符合要求的连续点的最左端坐标和最右端坐标，不妨分别记为(xnl，ynl)和(xnr，ynr)。在一帧图像处理完成后，会得到图3所示的图形 。根据得到的结果，可以计算出更多关于跟踪物体的信息：计算区域面积。计算每条线段的长度l(n)，然后将l(n)进行累积叠加，即可获得跟踪区域面积值s。图3-4行处理得到的线形图识别物

42、体的形状。根据得到的每行跟踪点的长度，以及同一行中有几段符合要求的连续跟踪点,可以得知物体从摄像头角度看到的形状。特别是在检测平面上线条时,可以识别是否有分支这一点是帧处理模式无法做到的。 需要指出的是，行处理模式虽然会得到关于跟踪目标的更多信息，但是每行处理的方式增大了处理器的负担，处理速度也没有帧处理快。3.2.2 提高系统的工作速率目前，系统工作在帧处理模式下的工作速率是25帧s，作为系统功能的验证，这里采用的算法是颜色跟踪。如果仅做纯粹的图像采集，而不做图像处理，那么系统可以达到ov6620的最高工作速率，即6o帧s。而在图像处理方面，不同的图像处理程序效率对系统的工作频率有较大的影响

43、。下面给出在通用arm 处理器下提高程序效率的几个建议：内嵌(inline)可通过删除子函数调用的开销来提高性能。如果函数在别的模块中不被调用，一个好的建议是用static标识函数；否则，编译器将在内嵌译码里把该函数编译成非内嵌的；在for()，while()dowhile()的循环中，用“减到0”代替“加到某个值”。比如：for(1oop = 1；loop< = total；loop+十)/add和cmp替换为：for(1oop = total；loop !： 0；loop一一) /subs第1种方式比较需要2条指令add和cmp，而第2种方式只需一条指令subs；避免使用大的局部结构

44、体或数组，可以考虑用malloc/free代替；避免使用递归。时序逻辑部分主要完成对图像传感器时序信号的识别。第四章 试验及数据分析4.1 模糊pid控制在电机中的试验模糊pid控制器由一个模糊控制器和pid控制器并联组成。当系统偏差较大时，模糊pid控制器的输出主要取决于模糊控制输出：当系统偏差较小时，模糊pid控制器的输出主要取决于pid控制输出。对于此舵机系统，取切换点为 0.5。阶跃响应如下图4-1和图4-2所示。图4-1普通pid控制阶跃响应图4-2变速积分阶跃响应4.2 以太网通信试验数据影响以太网通信延迟的主要因素是站点数目和通信速率, 也就是说网络负荷是造成通信延迟的主要原因。

45、下面通过matlab 软件进行仿真, 分析这2 个参数对以太网实时能力的影响。4.2.1站点数目(n)对通信延迟的影响在工业控制应用中, 站点间传输的数据大多数为短信息帧,在基金会现场总线协议中,帧的数据长度可为64 , 128 , 256 字节。假设以太网的帧长度为256 字节, 远方终端(rtu) 和监控主站间以太网的通信速率为10mb/ s ,传输介质长度为100m ,则仿真结果如图4-3所示。图4-3 不同站点数目下的通信延迟图由图4-3 可见, 当站点数目较少(少于15个时),通信延迟时间很短, 小于4ms;当站点数目超过15个后,冲突会加剧,延迟时间以指数增长。按照国际相关标准的要

46、求,对于实时性要求最高的变电站保护触发命令,其通信延迟时间极限为4ms。因此,设计监控系统时,只要把站点数目限制在15个之内,就能满足监控系统的实时性要求。4.2.2通信速率对通信延迟的影响以太网的通信速率在不断提高,假设把系统中rtu 和监控主站间以太网的通信速率提高到100mb/s和1000mb/s,传输介质长度仍为100m ,帧长度为256 字节, 仿真结果如图4-4 所示。图4-4不同通信速率下的通信延迟图由图4-4可见,当以太网的通信延迟时间为4ms时,对于10mb/s的通信速率,同一网段上的站点可为15个;对于100mb/s的通信速率,同一网段上的站点可增到20个;对于1000mb

47、/s的通信速率,同一网段上的站点可增到35个,甚至更多。当网段上的站点相同时,1000mb/s以太网的通信延迟时间比100,10mb/s以太网的通信延迟时间少。可见,提高以太网的通信速率可满足监控系统的实时性要求。4.2.3 改善以太网实时特性为了满足监控系统的实时性要求,可采用以下2 种方法减少以太网的冲突延迟时间。1. 提高以太网通信速率。这意味着网络负荷的减轻、冲突的减少、通信延迟时间的缩短。若网段上的站点数目相同, 随着通信速率的提高, 通信延迟时间会大大缩短, 完全满足远动监控系统的实时性要求。目前100 , 1000mb/ s 以太网已经投入使用, 10gb/ s 以太网正在研制,

48、 因此通过提高以太网通信速率来满足监控系统实时性要求的方法是完全可行的。2. 采用交换式以太网取代传统的共享式以太网。即在系统中增加交换式集线器, 且集线器每个端口的工作站不超过15 个, 这样每个工作站能有10mb/ s 带宽, 减少冲突, 降低通信延迟时间, 满足监控系统实时性的要求。另外, 交换式以太网负载较重时, 可以根据ieee 80211p 标准, 给不同信息分配优先权。紧急事件信息具有最高优先权, 不必在交换机缓冲器中排队, 优先被传输。这种报文优先级技术, 使工业控制中的紧急事件及时传输,从而改善了以太网的实时响应能力。4.3数据结果分析本系统通过一系列的matlab仿真，可以

49、得出：智能环保卫士机器人工作启动正常，预设基本功能均能实现，工作偏差极小，动作误差基本在误差范围内。并且，通过系统仿真实验得出的数据进行特定误差分析，得出：系统的图像数据处理算法较为准确，系统性能的实现稳定性较好，处理范围覆盖面全，经过更加细致的误差分析处理后，对智能环保机器人系统的工作参数进行了补偿修改，使系统工作更加有效。结 束 语本文基于传感器和单片机，利用低功耗cmos图像传感器，mc9s12xep100单片机为主控芯片，小型舵机和步进电机为驱动元件，通过软件编程，制作了一个价格低廉，结构模块化的智能环保卫士机器人小车。经过对机器人的整体实验、分析，证明机器人根据白色垃圾特征，进行特征

50、匹配，以完成自动垃圾识别，速度控制响应快，动态性能良好，稳态误差较小，系统的稳定性和抗干扰能力强。设计了基于数字图像处理技术的智能白色垃圾识别系统，采用cmos数字图像传感器识别白色垃圾；采用以太网通信技术同internet联网，实现双向互通；设计了斩波恒流细分步进电机驱动方案，驱动机器人拾取和回收目标垃圾；软件上采取了模糊pid算法，实现灵活的机器人控制；设计了最优化的垃圾搜寻路线确定算法，使机器人高效快捷地寻找目标垃圾。系统采用数字图像处理技术对白色垃圾图像进行识别，运用模糊pid算法的舵机系统控制电机驱动部分，采用步进电机对目标垃圾进行拾取和回收。根据服务性机器人的特点及需求，采用无线以

51、太网接入internet网，对机器人进行智能远程操控。基于数字图像处理技术结合以太网通信技术的环保机器人代替手动人力清扫白色垃圾的方案是可行的。智能环保机器人是综合多门学科的前沿课题，有着非常广泛的应用前景，但要到达人们设想的高度智能化还有很长的距离，它的发展与图像处理、模式识别、检测、控制等诸多技术的进一步提高密切相关，需要坚持不懈的探索和研究。参考文献【1】邵贝贝单片机嵌入式应用的在线开发方法m北京：清华大学出版社，2004【2】日船仓一郎等著，宋光华等译机器人控制电子学m北京：科学出版社，2004【3】吴建辉印制电路板的电磁兼容性设计m北京：国防工业出版社，2005【4】王水平pwm 控

52、制与驱动器使用指南及应用电路m西安电子与科技大学出版社，2004【5】 美steven fbrett，daniel jpack著，郑扣根嵌入式统使用68hc12和hcs12的设计与应用m电子工业出版社，2006【6】 陈智育，温彦军，陈琪vxworks程序开发实践m北京：人民邮电出版社，2004【7】 程敬原vxworks软件开发项目实例完全解析m北京：中国电力出版社，2005.【8】 jeri rh工程专业c程序设计m北京：科学出版社。2005【9】 李方敏vxworks高级程序设计m北京：清华大学出版社，2004【10】 王世香精通matlab接口与编程m北京：电子工业出版社，2007【1

53、1】 delores metter工程问题c语言求解mj 京：清华大学出版2005【11】冯冬芹. 工业以太网及其应用技术j. 自动化仪表,2003(6) :6570.【12】陈磊. 以太网在工业应用中的实时能力分析j .化工自动化及仪表,2003 (1) :4447.【13】阳宪惠. 现场总线技术及应用m. 北京:清华大学出版社,1999.【14】张绍诚. 计算机通信网络m. 北京:北京理工大学出版社,1990.【15】孙军平. 新一代变电站自动化网络通信系统研究j . 中国机电工程学报,2003 (3) .致 谢本文是在xxx老师的细心指导下完成的。从论文选题，撰写开题报告，到论文的具体撰

54、写，x老师给了我深切的关怀和无微不至的帮助，并提出了许多宝贵的意见和建议。他严谨的治学精神和孜孜不倦的求索精神，给我留下了深刻的印象，值得我终身学习!在此，谨向我尊敬的指导老师表达我最真挚的谢意！感谢学院的各位领导、老师对我大学四年学习、生活的教导和帮助！感谢家人对我生活和学习上的帮助和支持，以及我的同学们给予我的关心及友爱！在论文的撰写过程中，参考了许多文献和资料，在此对文献资料的作者、译者以及出版社表示真诚的谢意！四年的大学生活是我人生中一笔可贵的财富，给我留下了十分美好的回忆，我会铭记于心，记住这些曾经帮助过我的人！毕业设计（论文）原创性声明和使用授权说明原创性声明本人郑重承诺：所呈交的毕业设计（论文），是我个人在指导教师的指导下进行的研究工作及取得的成果。尽我所知，除文中特别加以标注和致谢的地方外，不包含其他人或组织已经发表或公布过的研究成果，也不包含我为获得 及其它教育机构的学位或学历而使用过的材料。对本研究提供过帮助和做出过贡献的个人或集体，均已在文中作了明确的说明并表示了谢意。作 者 签 名： 日 期： 指导教师签名： 日期： 使用授权说明本人完全了解 大学关于收集、保存、使用毕业设计（论文）的规定，即：按照学校要求提交毕业设计（论文）的印刷本和电子版本；