基于多种传感器的自动导航小车避障的研究
|
摘要
本文使用了超声波传感器和红外开关对自动导航小车周围的环境进行探测,并且利用工控机对超声波传感器所探得的障碍物信息进行处理,最终通过一种改进的模糊神经控制算法来完成障碍物的识别,从而实现了自动导航小车的自主避障。针对自动导航小车行驶中的安全问题,设计了一种近距离障碍物实时检测系统,较好地实现了对自动导航小车周围障碍物的实时测距,并通过人机交互,将信息实时反馈给用户进行适当处理。论文具体内容如下所示:
系统硬件包括超声波测距传感器、工控机和其它连接器件。超声波测距传感器用来探测障碍物,利用红外开关对超声波传感器的测距盲区进行补偿,工控机是系统的数据采集控制站,控制4组超声波测距传感器和红外开关,进行数据的处理,发出控制信号,驱动执行机构,实现障碍物智能判别,使自动导航小车自动避障。
系统软件包括数据采集模块和数据处理模块。数据采集模块用来实现对超声波信号发射的控制,数据输入/输出通道的开闭。数据处理模块用来计算障碍物的距离,判断障碍物方位并发出控制指令。软件使用编程语言VC++来编写。
经联机调试及部分功能的测试,所设计的超声波传感器系统可实现对周围环境里障碍物的探测;障碍物判别系统将能够保障自动导航小车的安全行驶,系统基本达到了设计要求,运行稳定。
另外,设计并制作了语音控制小车系统。该设计以凌阳单片机SPCE061A为核心控制部件,减速直流电机LS17RU419i,电机驱动芯片L298N,红外线光电传感器TCRT5000,反射式红外传感器ST178等为主要元件,智能控制技术为理论基础,论证了该方案的可行性。系统紧紧抓住了凌阳单片机的优点,围绕它设计和编制了语音控制小车软件部分,并应用了凌阳单片机SPCE061A的语音模块。本方案充分利用了凌阳单片机的强大的编程,语音处理,中断以及多功能的输入输出口,并且操作简单,易于修改,经调试达到了预期的目的。
To realize the autonomous obstacle avoidance of the Automatic Guided Vehicle(AGV), a series of methods are presented in this paper, which include circumstance detection around the Automatic Guided Vehicle by ultrasonic sensors, obstacle input data process through computer techniques and pattern recognition of obstacles with a fuzzy-neuro control algorithm.
Aiming at the safety problem of the Automatic Guided Vehicle driving, this thesis studies a real-time short-distance obstacles detecting system, to realize the real-time distance measurement of the obstacles all around of the Automatic Guided Vehicle and feedbacks the information to the users in real time. It mainly involves the following works:
The system hardware is made up of ultrasonic sensors, computer and other junctions. The ultrasonic sensor would be used to detect the environment and the computer is the data collection and control station in the system. The computer was be used to control the 4 couples ultrasonic detect distance sensor, deal with the data, send controlling signals and drive executive mechanism. The system will differentiate obstacle intellective and make the Automatic Guided Vehicle avoid colliding automatic.
The system software includes data collection module and data processing module. The data collection module is used to control sending ultrasonic signal, the opening and closing of I/O passageways. The data processing module is used to calculate the distance of obstacle, differentiate obstacle orientation and chose controlling order. The software was compiled with VC++, which is a special compile language.
Through the analog and test of part function, the ultrasonic detect distance system designed by us has detected the obstacles in the range of design’s require. The differentiate obstacle system would ensure the Automatic Guided Vehicle running safely and achieve the design requirement basically.
Besides,The system of a voice_controled car is described and designed in this paper. We take SPCE061A as the core control portion in this design, and direct-current speed reduction electric motor LS17RU419i, driving chip L298N of electrical motor, Photoelectric transducer of infrared ray TCRT5000, Reflecting infrared sensor ST178 are considered as the main control modules. The intellectual control technology is a theoretical foundation, and the feasibility of the project is given in the thesis. This system fastens the merit having graspedμ’nSP? microcomputer. Around that, design and work out the software system of this voice_controled car, and have fully utilized the pronunciation module of SPCE061A . Thatμ’nSP? microcomputer programming, pronunciation, interruption as well as the multi- purpose’s input and outlet is fully utilized on the scheme, and be easy to operate, be easy to revise. The design has reached expected purpose after the debugging.
系统硬件包括超声波测距传感器、工控机和其它连接器件。超声波测距传感器用来探测障碍物,利用红外开关对超声波传感器的测距盲区进行补偿,工控机是系统的数据采集控制站,控制4组超声波测距传感器和红外开关,进行数据的处理,发出控制信号,驱动执行机构,实现障碍物智能判别,使自动导航小车自动避障。
系统软件包括数据采集模块和数据处理模块。数据采集模块用来实现对超声波信号发射的控制,数据输入/输出通道的开闭。数据处理模块用来计算障碍物的距离,判断障碍物方位并发出控制指令。软件使用编程语言VC++来编写。
经联机调试及部分功能的测试,所设计的超声波传感器系统可实现对周围环境里障碍物的探测;障碍物判别系统将能够保障自动导航小车的安全行驶,系统基本达到了设计要求,运行稳定。
另外,设计并制作了语音控制小车系统。该设计以凌阳单片机SPCE061A为核心控制部件,减速直流电机LS17RU419i,电机驱动芯片L298N,红外线光电传感器TCRT5000,反射式红外传感器ST178等为主要元件,智能控制技术为理论基础,论证了该方案的可行性。系统紧紧抓住了凌阳单片机的优点,围绕它设计和编制了语音控制小车软件部分,并应用了凌阳单片机SPCE061A的语音模块。本方案充分利用了凌阳单片机的强大的编程,语音处理,中断以及多功能的输入输出口,并且操作简单,易于修改,经调试达到了预期的目的。
To realize the autonomous obstacle avoidance of the Automatic Guided Vehicle(AGV), a series of methods are presented in this paper, which include circumstance detection around the Automatic Guided Vehicle by ultrasonic sensors, obstacle input data process through computer techniques and pattern recognition of obstacles with a fuzzy-neuro control algorithm.
Aiming at the safety problem of the Automatic Guided Vehicle driving, this thesis studies a real-time short-distance obstacles detecting system, to realize the real-time distance measurement of the obstacles all around of the Automatic Guided Vehicle and feedbacks the information to the users in real time. It mainly involves the following works:
The system hardware is made up of ultrasonic sensors, computer and other junctions. The ultrasonic sensor would be used to detect the environment and the computer is the data collection and control station in the system. The computer was be used to control the 4 couples ultrasonic detect distance sensor, deal with the data, send controlling signals and drive executive mechanism. The system will differentiate obstacle intellective and make the Automatic Guided Vehicle avoid colliding automatic.
The system software includes data collection module and data processing module. The data collection module is used to control sending ultrasonic signal, the opening and closing of I/O passageways. The data processing module is used to calculate the distance of obstacle, differentiate obstacle orientation and chose controlling order. The software was compiled with VC++, which is a special compile language.
Through the analog and test of part function, the ultrasonic detect distance system designed by us has detected the obstacles in the range of design’s require. The differentiate obstacle system would ensure the Automatic Guided Vehicle running safely and achieve the design requirement basically.
Besides,The system of a voice_controled car is described and designed in this paper. We take SPCE061A as the core control portion in this design, and direct-current speed reduction electric motor LS17RU419i, driving chip L298N of electrical motor, Photoelectric transducer of infrared ray TCRT5000, Reflecting infrared sensor ST178 are considered as the main control modules. The intellectual control technology is a theoretical foundation, and the feasibility of the project is given in the thesis. This system fastens the merit having graspedμ’nSP? microcomputer. Around that, design and work out the software system of this voice_controled car, and have fully utilized the pronunciation module of SPCE061A . Thatμ’nSP? microcomputer programming, pronunciation, interruption as well as the multi- purpose’s input and outlet is fully utilized on the scheme, and be easy to operate, be easy to revise. The design has reached expected purpose after the debugging.
引文
[1] 赖维德. 工业机器人技术. http://www.robotschina.com
[2] 罗志增, 蒋静坪. 机器人感觉与多信息融合[M]. 北京: 机械工业出版社, 2003. 1~10
[3] 李磊,叶涛,谭民等. 移动机器人技术研究现状与未来[J]. 机器人,2002,24 (5):475~480
[4] 蔡自兴. 中国的智能机器人研究[J]. 莆田学院学报,2002,9 (3):36~39
[5] 吴林. 智能机器人主题型号工作的回顾[J]. 机器人技术与应用, 2001. 6~9
[6] 欧青立, 何刻忠等. 室外智能机器人的发展及其关键技术研究[J]. 机器人, 2000, 22(6): 519~526
[7] Chuck Thorpe, Justin Carlson, Dave Duggins, etc. Safe Robot Driving in Cluttered Environments[J]. Proceedings of the 11th International Symposium of Robotics Research.2003, 10(1): 870~875
[8] Loskiewicz-Buczak, Anna, Uhrig, etc. Information fusion by fuzzy set operation and genetic algorithms[J]. Simulation Councils Inc, San Diego, CA, USA, 1995. 52~66
[9] 刘国光. 基于 Rough 集的多传感器融合技术[J]. 计算机测量与控制, 2002, 10(9): 625~627
[10] 李磊, 叶涛, 谭民等. 移动机器人技术研究现状与未来[J]. 机器人, 2002, 24(5): 475~480
[11] 叶涛. 基于传感器信息的移动机器人导航与控制研究[D]: [学位论文]. 北京: 中国科学院研究生院, 2003
[12] Hall Ernest L. Intelligent robot trends for 1998[J]. Proceedings of SPIE-The International Society for Optical Engineering, 1998, v3522: 28~40
[13] 池瑞楠, 胡终须, 胡跃明. 非完整两轮驱动移动机器人的实验研究[J]. 机器人技术与应用, 2001. 36~40
[14] 卢韶芳. 自主式移动机器人分布视觉组合导航基础研究[D]: [学位论文]. 长春: 吉林工业大学, 2002
[15] 王荣本, 李兵, 施述明等. 世界智能车辆研究概述[J]. 公路交通科技, 2001, 18(5): 93~97
[16] 白小波, 王宏玉, 卞瑰石, 张雷, 李凤君, 汪询. AGVS 系统技术应用[J]. 物流技术, 2000(2): 9~12
[17] 储江伟, 王荣本, 郭克友, 顾柏园, 马雷. 基于机器视觉引导的两轮差速转向 AGV控制问题的研究[J]. 机械与电子, 2002(5): 51~55
[18] 陈无畏, 施文武, 王启瑞, 蒋浩丰. 自动引导车跟踪控制的仿真研究[J]. 中国科学技术人学学报, 2003 年第 1 期: 60~66
[19] 吕广明, 薛渊, 陆念力. 自动化仓库控制中心与 AGV 间的无线通讯技术[J]. 起重运输机械, 2005 (4): 46~48
[20] 张家毅. 网络视频监控技术在卷烟厂自动化系统中的集成应用[J]. 设备与仪器, 2005 年第 2 期: 11~13
[21] 黄玉美, 史恩秀, 史文浩, 上官望义, 朱红英. AGV 的混合式导航功能设计[J]. 制造技术与机床, 2004 年第 4 期: 45~47
[22] 陈无畏, 施文武, 王启瑞, 何世娣. 基于动力学模型的自动引导车智能导航控制研究[J]. 农业机械学报, 2003 年 7 月第 34 卷第 4 期: 90~93
[23] AhmadiM, PolotskiV, HurteauR. Path tracking control of tracked vehicles[J]. Proc. Of IEEE Int. Conf. On Robotics and Automation, San Francisco, CA2000: 2938~2943
[24] 关宏, 张智勇, 杨文华, 卯彦, 彭之光. AGV 整体集成系统结构设计[J]. 物流技术, 2004 年第 4 期: 37~38
[25] 张家梁, 宋立博, 李蓓智. 磁制导 AGV 实验装置的研制[J]. 实验室研究与探索, 2005 年 3 月第 24 卷第 3 期: 22~23
[26] Wang, L. Emura, T. Ushiwata, T. Automatic guidance of a vehicle based on DGPS and a 3Dmap[J]. Intelligent Transportation Systems, 2000. Proceedings. 2000 IEEE, Dearborn, MI USA, 131~136
[27] 吴建平, 殷战国, 曹思榕, 李坤垣. 红外反射式传感器在自主式寻迹小车导航中的应用[J]. 中国测试技术, 2004 年 11 月第 30 卷第 6 期: 21~23
[28] 孙亮. AGVS 中避碰问题的研究现状与发展趋势[J]. 物流技术, 2005 年第 3 期: 25~27
[29] Naiqi Wu, MengChu Zhou. AGV routing for conflict resolution in AGV systems[A]. Proceedings of IEEE International Conference on Robotics and Automation[C]. 2003: 1428~1433
[30] Sudha Arora, A K Raina, A K Mittal. Collision Avoidance among AGVs at Junctions[A]. Proceedings of the IEEE Intelligent Vehicles Symposim [C].2000:585~589
[31] 冉文学. AGV 及 AGVS 的安全装置设计[J]. 物流技术与应用, 2000 (1): 32~34
[32] 杨文华, 王勇, 张智勇. 激光导引 AGV 系统结构及其控制[J]. 起重运输机械, 2000(12): 24~26
[33] 冯星华. AGV 及其控制系统研制[J]. 电子机械工程, 2001 年 2 月: 31~33
[34] 王学慧, 柳林. 足球机器人小车总体设计思想及其单片机选型[J]. 机器人技术与应用, 2001,(5): 9~13
[35] 白井良明, 王棣棠译. 机器人工程[M]. 科学出版社, 2001. 97~99
[36] 何希才. 传感器及其应用电路[M]. 北京: 电子工业出版社, 2001. 146~161
[37] M.Yang, H.Wang, K.He.Obstacle Avoidance Using Range Data in Autonomous Navigation of Mobile Robot[J]. WenTd. Proc of the 1999 International Symposiumon Test and Measurement. Xi'an:Int Academic Publishers, 1999, 929~933.
[38] 唐超群. 现代物理测试技术[M]. 华中理工大学出版社, 2001
[39] 中国机械工程学院无损检测分会. 超声波检测[M]. 北京: 机械工业出版社, 2000
[40] 秦旭. 用 LM92 温度传感器补偿的高精度超声波测距仪[J]. 电子产品世界, 2003, www.eepw.com
[41] 王伟, 王敏. 多线程技术在串口通信中的应用及实现[J]. 计算机应用与软件, 2004, 21(2): 47~49
[42] Y.J.Kim, J.H.Kim, D.S.Kwon. Evolutionary Programming-Based Uni-Vector Field Navigation Method for Fast Mobile Robots[J]. IEEE Transactions on Systems Man and Cybernetics, 2001, 31(3): 450~458
[43] T.Huntsberger, P.Ajjimarangsee. Parallel Self-Organizing Feature Maps for Unsupervised Pattern Recognition[J]. Intentional J.General Systems 1990, 16(4): 357~372
[44] T.Kohonen. Self-Organizing Maps[J]. London: Springer, 1997
[45] 侯媛彬等. 凌阳单片机原理及其毕业设计精选[M]. 科技出版社, 2006 年 1 月
[46] 凌阳单片机网站. http://www.sunplus.com, 2007
[47] 21IC 中国电子网. http://www.21ic.com, 2007
[48] 张毅坤等. 单片微型计算机原理及应用[M]. 西安电子科技大学出版社, 2005 年 6 月
[49] 罗亚非等. 凌阳十六位单片机应用基础[M]. 北京航空航天大学出版社, 2007
[50] 薛均义等. 凌阳十六位单片机原理与应用[M]. 北京航空航天大学出版社, 2003
[51] 雷思孝等. 单片机原理及实用技术—凌阳 16 位单片机原理及应用[M]. 西安电子科技大学, 2004
[2] 罗志增, 蒋静坪. 机器人感觉与多信息融合[M]. 北京: 机械工业出版社, 2003. 1~10
[3] 李磊,叶涛,谭民等. 移动机器人技术研究现状与未来[J]. 机器人,2002,24 (5):475~480
[4] 蔡自兴. 中国的智能机器人研究[J]. 莆田学院学报,2002,9 (3):36~39
[5] 吴林. 智能机器人主题型号工作的回顾[J]. 机器人技术与应用, 2001. 6~9
[6] 欧青立, 何刻忠等. 室外智能机器人的发展及其关键技术研究[J]. 机器人, 2000, 22(6): 519~526
[7] Chuck Thorpe, Justin Carlson, Dave Duggins, etc. Safe Robot Driving in Cluttered Environments[J]. Proceedings of the 11th International Symposium of Robotics Research.2003, 10(1): 870~875
[8] Loskiewicz-Buczak, Anna, Uhrig, etc. Information fusion by fuzzy set operation and genetic algorithms[J]. Simulation Councils Inc, San Diego, CA, USA, 1995. 52~66
[9] 刘国光. 基于 Rough 集的多传感器融合技术[J]. 计算机测量与控制, 2002, 10(9): 625~627
[10] 李磊, 叶涛, 谭民等. 移动机器人技术研究现状与未来[J]. 机器人, 2002, 24(5): 475~480
[11] 叶涛. 基于传感器信息的移动机器人导航与控制研究[D]: [学位论文]. 北京: 中国科学院研究生院, 2003
[12] Hall Ernest L. Intelligent robot trends for 1998[J]. Proceedings of SPIE-The International Society for Optical Engineering, 1998, v3522: 28~40
[13] 池瑞楠, 胡终须, 胡跃明. 非完整两轮驱动移动机器人的实验研究[J]. 机器人技术与应用, 2001. 36~40
[14] 卢韶芳. 自主式移动机器人分布视觉组合导航基础研究[D]: [学位论文]. 长春: 吉林工业大学, 2002
[15] 王荣本, 李兵, 施述明等. 世界智能车辆研究概述[J]. 公路交通科技, 2001, 18(5): 93~97
[16] 白小波, 王宏玉, 卞瑰石, 张雷, 李凤君, 汪询. AGVS 系统技术应用[J]. 物流技术, 2000(2): 9~12
[17] 储江伟, 王荣本, 郭克友, 顾柏园, 马雷. 基于机器视觉引导的两轮差速转向 AGV控制问题的研究[J]. 机械与电子, 2002(5): 51~55
[18] 陈无畏, 施文武, 王启瑞, 蒋浩丰. 自动引导车跟踪控制的仿真研究[J]. 中国科学技术人学学报, 2003 年第 1 期: 60~66
[19] 吕广明, 薛渊, 陆念力. 自动化仓库控制中心与 AGV 间的无线通讯技术[J]. 起重运输机械, 2005 (4): 46~48
[20] 张家毅. 网络视频监控技术在卷烟厂自动化系统中的集成应用[J]. 设备与仪器, 2005 年第 2 期: 11~13
[21] 黄玉美, 史恩秀, 史文浩, 上官望义, 朱红英. AGV 的混合式导航功能设计[J]. 制造技术与机床, 2004 年第 4 期: 45~47
[22] 陈无畏, 施文武, 王启瑞, 何世娣. 基于动力学模型的自动引导车智能导航控制研究[J]. 农业机械学报, 2003 年 7 月第 34 卷第 4 期: 90~93
[23] AhmadiM, PolotskiV, HurteauR. Path tracking control of tracked vehicles[J]. Proc. Of IEEE Int. Conf. On Robotics and Automation, San Francisco, CA2000: 2938~2943
[24] 关宏, 张智勇, 杨文华, 卯彦, 彭之光. AGV 整体集成系统结构设计[J]. 物流技术, 2004 年第 4 期: 37~38
[25] 张家梁, 宋立博, 李蓓智. 磁制导 AGV 实验装置的研制[J]. 实验室研究与探索, 2005 年 3 月第 24 卷第 3 期: 22~23
[26] Wang, L. Emura, T. Ushiwata, T. Automatic guidance of a vehicle based on DGPS and a 3Dmap[J]. Intelligent Transportation Systems, 2000. Proceedings. 2000 IEEE, Dearborn, MI USA, 131~136
[27] 吴建平, 殷战国, 曹思榕, 李坤垣. 红外反射式传感器在自主式寻迹小车导航中的应用[J]. 中国测试技术, 2004 年 11 月第 30 卷第 6 期: 21~23
[28] 孙亮. AGVS 中避碰问题的研究现状与发展趋势[J]. 物流技术, 2005 年第 3 期: 25~27
[29] Naiqi Wu, MengChu Zhou. AGV routing for conflict resolution in AGV systems[A]. Proceedings of IEEE International Conference on Robotics and Automation[C]. 2003: 1428~1433
[30] Sudha Arora, A K Raina, A K Mittal. Collision Avoidance among AGVs at Junctions[A]. Proceedings of the IEEE Intelligent Vehicles Symposim [C].2000:585~589
[31] 冉文学. AGV 及 AGVS 的安全装置设计[J]. 物流技术与应用, 2000 (1): 32~34
[32] 杨文华, 王勇, 张智勇. 激光导引 AGV 系统结构及其控制[J]. 起重运输机械, 2000(12): 24~26
[33] 冯星华. AGV 及其控制系统研制[J]. 电子机械工程, 2001 年 2 月: 31~33
[34] 王学慧, 柳林. 足球机器人小车总体设计思想及其单片机选型[J]. 机器人技术与应用, 2001,(5): 9~13
[35] 白井良明, 王棣棠译. 机器人工程[M]. 科学出版社, 2001. 97~99
[36] 何希才. 传感器及其应用电路[M]. 北京: 电子工业出版社, 2001. 146~161
[37] M.Yang, H.Wang, K.He.Obstacle Avoidance Using Range Data in Autonomous Navigation of Mobile Robot[J]. WenTd. Proc of the 1999 International Symposiumon Test and Measurement. Xi'an:Int Academic Publishers, 1999, 929~933.
[38] 唐超群. 现代物理测试技术[M]. 华中理工大学出版社, 2001
[39] 中国机械工程学院无损检测分会. 超声波检测[M]. 北京: 机械工业出版社, 2000
[40] 秦旭. 用 LM92 温度传感器补偿的高精度超声波测距仪[J]. 电子产品世界, 2003, www.eepw.com
[41] 王伟, 王敏. 多线程技术在串口通信中的应用及实现[J]. 计算机应用与软件, 2004, 21(2): 47~49
[42] Y.J.Kim, J.H.Kim, D.S.Kwon. Evolutionary Programming-Based Uni-Vector Field Navigation Method for Fast Mobile Robots[J]. IEEE Transactions on Systems Man and Cybernetics, 2001, 31(3): 450~458
[43] T.Huntsberger, P.Ajjimarangsee. Parallel Self-Organizing Feature Maps for Unsupervised Pattern Recognition[J]. Intentional J.General Systems 1990, 16(4): 357~372
[44] T.Kohonen. Self-Organizing Maps[J]. London: Springer, 1997
[45] 侯媛彬等. 凌阳单片机原理及其毕业设计精选[M]. 科技出版社, 2006 年 1 月
[46] 凌阳单片机网站. http://www.sunplus.com, 2007
[47] 21IC 中国电子网. http://www.21ic.com, 2007
[48] 张毅坤等. 单片微型计算机原理及应用[M]. 西安电子科技大学出版社, 2005 年 6 月
[49] 罗亚非等. 凌阳十六位单片机应用基础[M]. 北京航空航天大学出版社, 2007
[50] 薛均义等. 凌阳十六位单片机原理与应用[M]. 北京航空航天大学出版社, 2003
[51] 雷思孝等. 单片机原理及实用技术—凌阳 16 位单片机原理及应用[M]. 西安电子科技大学, 2004