一种新型智能清洁机器人测控系统的设计与实现_百度文库
《清扫机器人控制系统的实现与改进》范文

《清扫机器人控制系统的实现与改进》篇一一、引言随着科技的发展和人们对生活品质要求的提高,清扫机器人已经成为现代家庭不可或缺的家电之一。
其高效的清洁能力和便捷的操作方式,大大提升了人们的居住体验。
而清扫机器人的核心部分——控制系统,其实现与改进,对于机器人的性能和使用体验至关重要。
本文将详细探讨清扫机器人控制系统的实现及改进措施。
二、清扫机器人控制系统的实现1. 硬件设计清扫机器人的硬件系统主要包括主板、电机驱动、传感器、电池等部分。
其中,主板是整个系统的核心,负责控制电机的运动和传感器的数据采集。
电机驱动则负责将主板的指令转化为电机的运动,传感器则负责获取环境信息,如障碍物、地面材质等。
电池则为机器人提供动力。
2. 软件设计软件系统是清扫机器人的“大脑”,负责处理传感器数据,控制电机的运动,以及与用户的交互。
软件系统通常包括操作系统、控制算法、路径规划等部分。
(1)操作系统:通常采用嵌入式系统,具有实时性、低功耗等特点。
(2)控制算法:控制算法是清扫机器人的核心,包括电机控制、传感器数据处理等部分。
通过算法,机器人能够根据环境信息,自主决定运动路径和清洁策略。
(3)路径规划:路径规划是清扫机器人实现自动清洁的关键技术。
通过地图构建、路径规划算法等,机器人能够在室内环境中自主导航,完成清洁任务。
三、清扫机器人控制系统的改进1. 优化硬件设计(1)采用更高效的电机和电池,提高机器人的运行效率和续航能力。
(2)增加更多类型的传感器,如红外传感器、激光雷达等,提高机器人对环境的感知能力。
(3)优化主板设计,提高处理速度和稳定性,降低功耗。
2. 优化软件系统(1)改进控制算法:通过优化电机控制和传感器数据处理算法,提高机器人的清洁效率和适应性。
(2)地图构建与路径规划优化:通过改进地图构建算法和路径规划算法,使机器人能够更准确地识别和记忆室内环境,实现更高效的清洁路径规划。
(3)增加人机交互功能:通过引入语音识别、虚拟助手等交互方式,提高用户体验。
智能清洁装置控制系统设计毕业设计论文

毕业设计论文智能清洁装置控制系统设计(系统软件)摘要随着信息技术的不断发展,各种产品的技术含量及复杂程度也越来越高,智能化的概念开始逐渐渗透到各行各业以及我们生活中的方方面面。
本文以智能计算机控制技术为理论基础,设计了一种以MSP430F149单片机为主控制器的智能清洁装置。
该装置能按照一定的行走模式对复杂的空间环境进行清扫,当遇到障碍物时它能启动避障程序绕开障碍物再按照原来的模式进行清扫工作。
如果地面上有台阶,它还能自动启动防摔落程序防止清洁装置被摔坏。
文章主要围绕它的这些功能进行系统设计以及相关功能软件的分析与设计。
在IAR EW430编译环境下编写系统程序,编译成功并下载到硬件系统中。
最终,本设计完成了智能清洁装置预期的功能,达到设计要求。
关键字:智能控制系统;扫地机器人;MSP430;路径规划Intelligent control system designof cleaning device(System software)AbstractWith the development of the information technology, the technological content and complexity of products are becoming better than before. The concept of intelligent gradually began to infiltrate into all walks of life and we all aspects of the life.The paper based on the intelligent control technology, designing a intelligent cleaning device by MSP430F149 MCU which was the master controller of the system. The device can clean complicated space according to establish walking pattern. When faced with obstacles it can start the obstacle avoidance procedures around obstacles. Then according to the original mode of cleaning work.If the ground with a step, it can also automatically start a program to prevent the cleaning device being broken. The paper mainly around which these functions of the system design and function of software analysis and design. The next task is writing system programs in the compiler environment, After successfully compiled and downloaded to the hardware system. Eventually, the design completed intended function of the intelligent cleaning device and reached the design requirement.Key Word:Intelligent control system; Cleaning robot; MSP430; Path planning目录摘要 (II)Abstract (III)1 绪论 (1)1.1 序言 (1)1.2 选题的背景和意义 (1)1.3 智能清洁装置的研究现状 (2)1.4 智能清洁装置研究的关键技术 (3)1.5 本课题研究的主要内容 (4)1.6 本章小结 (4)2 智能清洁装置控制系统结构与总体方案设计 (5)2.1 智能清洁装置结构 (5)2.2 智能清洁装置控制系统总体方案设计 (6)2.2.1 控制器模块 (6)2.2.2 信息采集模块 (7)2.2.3 电机驱动模块 (8)2.2.4 电源模块 (10)2.3 本章小结 (10)3 智能清洁装置控制系统软件设计 (11)3.1系统软件总体设计思路 (11)3.1.1 软件结构 (11)3.1.2 软件实现的总体思想 (12)3.2 各模块程序设计 (14)3.2.1 单片机系统时钟初始化 (14)3.2.2 电机驱动模块程序设计 (15)3.2.3 避障模块程序设计 (16)3.2.4 防摔模块程序设计 (18)3.2.5 主程序模块设计 (19)3.3 中断程序与中断嵌套问题 (20)3.4 本章小结 (21)4 系统调试 (22)4.1 软件调试 (22)4.2 系统软硬件联调 (23)5 结论 (24)致谢 (25)参考文献 (26)附录1 (27)附录2 (37)1绪论1.1 序言顾名思义,智能清洁装置控制系统也被叫做智能清洁机器人。
基于机器人技术的智能家居保洁系统设计

基于机器人技术的智能家居保洁系统设计智能家居保洁系统设计:在现代社会,智能家居技术越来越受到人们的关注和追捧。
随着科技的不断发展和进步,机器人技术在智能家居中的应用变得越来越广泛。
基于机器人技术的智能家居保洁系统设计旨在提供一种方便、高效且智能的家居清洁解决方案。
一、智能家居保洁系统的设计思路(1)智能家居保洁系统的核心利用机器人技术,实现自动化清洁任务。
首先,智能家居保洁系统需要一个可靠、稳定且智能化的机器人平台。
该平台应具备自主移动、环境感知、路径规划、智能清洁等功能。
通过使用先进的感知技术如机器视觉、激光雷达等,机器人能够自主感知和识别需要清洁的区域。
路径规划算法可以帮助机器人规划最佳的清洁路线,从而提高清洁任务的效率。
(2)智能家居保洁系统需要集成智能家居控制中心。
为了实现集成化管理,智能家居保洁系统需要与智能家居控制中心进行连接和集成。
通过与智能家居控制中心的互动,用户可以通过手机、平板电脑等终端设备远程监控和操作智能家居保洁系统。
这样,用户可以随时随地掌握家居清洁的情况,并进行相应的调整和控制。
(3)智能家居保洁系统需要多种清洁模式和功能的支持。
为了满足不同用户的需求,智能家居保洁系统应支持多种清洁模式和功能。
例如,可以提供全自动清洁模式、定点清洁模式、定时清洁模式等,以适应不同家居环境和用户需求。
此外,系统还应支持多种功能,如地板清洁、窗户清洁、家具清洁等,以提供全面的家居保洁服务。
二、智能家居保洁系统的关键技术(1)机器人导航与路径规划技术机器人导航与路径规划技术是智能家居保洁系统的关键技术之一。
通过使用激光雷达等传感器,机器人能够感知周围环境并构建地图。
路径规划算法可以根据地图信息和清洁任务需求,制定最佳的清洁路线,从而提高清洁任务的效率。
(2)机器视觉和物体识别技术机器视觉和物体识别技术可以帮助机器人感知和识别需要清洁的区域和物体。
通过使用摄像头和图像处理算法,机器人可以自主辨别出墙角、家具和地板等需要清洁的位置,从而实现智能化的清洁任务。
《清扫机器人控制系统的实现与改进》范文

《清扫机器人控制系统的实现与改进》篇一一、引言随着科技的飞速发展,智能家居逐渐成为人们生活的必需品。
其中,清扫机器人作为智能家居的重要组成部分,其控制系统的实现与改进对于提升用户体验和产品性能至关重要。
本文将详细介绍清扫机器人控制系统的实现过程及后续的改进措施。
二、清扫机器人控制系统实现1. 硬件设计清扫机器人硬件主要包括主控芯片、电机驱动模块、传感器模块(如红外传感器、超声波传感器等)、电池及充电模块等。
主控芯片负责控制机器人的整体运行,电机驱动模块驱动机器人移动,传感器模块用于感知环境信息,电池及充电模块为机器人提供动力。
2. 软件设计软件设计主要包括操作系统、算法及控制策略。
操作系统负责管理机器人硬件资源,算法包括路径规划、避障、电量管理等,控制策略则是将算法与硬件结合起来,实现对机器人的有效控制。
3. 系统集成系统集成是将硬件和软件进行整合的过程,确保各个模块之间的协调工作。
在集成过程中,需要进行多次调试和优化,以保证机器人的稳定性和性能。
三、清扫机器人控制系统改进措施1. 优化路径规划算法路径规划是清扫机器人的核心算法之一。
通过优化路径规划算法,可以提高机器人的清扫效率,减少重复和遗漏。
例如,可以采用改进的遗传算法或蚁群算法等智能算法,实现更高效的路径规划。
2. 增强传感器性能传感器是机器人感知环境的重要工具。
通过增强传感器性能,可以提高机器人的环境感知能力,从而更好地适应各种复杂环境。
例如,可以引入更高精度的激光雷达或红外传感器等。
3. 引入人工智能技术引入人工智能技术,如深度学习和机器学习等,可以使机器人具备更强的自主学习和决策能力。
例如,通过训练神经网络模型,使机器人能够识别和区分不同类型的垃圾,并自动调整清扫策略。
4. 优化用户体验界面用户体验界面是用户与机器人进行交互的窗口。
通过优化用户体验界面,可以提高用户的使用体验和满意度。
例如,可以增加语音交互功能、实时显示清扫进度和电量等信息。
智能清洁机器人设计

智能清洁机器人设计第一篇:智能清洁机器人设计传感器应用——智能清洁机器人设计成员及分工:指导老师:徐晓冬智能清洁机器人设计测控技术与仪器(2)班 CK Star 摘要:智能清洁机器人是内置智能芯片,能自动识别判断家庭环境,计算行走路径,自动清扫地面上的灰尘,自动清理毛发和碎物,低电压自动返回充电。
智能清洁机器人具有智能计算机系统、自动螺旋导航系统和传感器感应头。
可以对房间做出测量,自动清洁房间的每个角落、记录您的理想设置,避让墙壁、楼梯等障碍物,即使您把放到桌子上面它也不会掉下来。
随机配备的虚拟墙发射器可有效地阻止它进入您不想让它进入的地方。
适用范围:家庭,办公室,电脑房,可以有效清扫各种木地板、水泥地板、瓷砖地板以及短毛地毯。
采用全新智能控制系统,自动清扫,自动回充,智能分析,路径规划,智能防撞,以及遥控的功能,最终实现卫生清洁、空气净化加湿的效果。
关键词:传感器清洁机器人智能控制单片机系统目录一、背景及意义 (3)二、国内外研究现状 (3)三、总体功能 (4)四、工作主流程图 (5)五、各模块设计 (6)1、传感部分........................................................................................6 1)超声波传感器............................................................................6 2)红外测距传感器........................................................................7 3)接触式传感器............................................................................7 4)红外光电传感器 (7)2、控制部分 (8)3、驱动部分 (8)4、全方位移动机构 (9)5、吸尘及处理部分 (9)6、垃圾收集过程流程图 (11)7、电源部分 (11)六、性能参数 (12)七、结论与展望......................................................................................13 参考文献.. (14)一、背景及意义随着人们生活水平的提高,健康、舒适的家居环境越来越被更多的人所关注。
基于机器人的智能保洁服务系统设计

基于机器人的智能保洁服务系统设计随着人们生活水平的提高,对环境卫生的要求也越来越高。
传统的保洁方式已经难以满足现代人的需求,因此机器人智能保洁系统应运而生。
本文将就此话题展开探讨。
一、引言机器人保洁已经成为了未来的主流趋势。
它不仅可以提高工作效率,还可以减少人力成本和提高清洁质量。
因此,建立机器人保洁系统已经是时代的需要。
在本文中,我们将介绍机器人保洁系统的设计和实现。
二、机器人保洁系统机器人保洁系统是一种基于机器人技术的创新型保洁系统。
它可以代替人工进行保洁工作,使我们的生活更加便捷。
机器人保洁系统具有以下基本特点:1. 高度智能化:机器人保洁系统具有较高的智能化程度,它可以根据环境的情况进行巡逻和清洁,并自动避开障碍物。
2. 综合性:机器人保洁系统不仅可以进行地面的保洁工作,还可以进行天花板、墙壁等高空部位的清洁工作。
3. 高效性:机器人保洁系统可以高效地完成保洁任务,从而提高了保洁效率和减少了人力成本。
三、机器人保洁系统设计原理机器人保洁系统的设计原理主要分为以下几个方面:1. 传感器技术:机器人保洁系统采用了多种传感器技术,如激光、红外线等,以便于系统自动控制、监测防止碰撞和避开障碍物2. 嵌入式系统:机器人保洁系统采用了嵌入式系统,具有较高的控制精度,可以更精确地对机器人进行控制,从而提高了保洁效率。
3. 机器视觉技术:机器人保洁系统还采用了机器视觉技术,通过机器视觉算法,以识别保洁环境中存在的污物。
4. 高精度传动系统:机器人保洁系统采用了高精度传动系统,可以更加准确地进行定位和操作,保证了机器人的运行稳定性。
四、机器人保洁系统的实现机器人保洁系统的实现主要包含以下几个方面:1. 机器人硬件平台的设计:机器人的硬件平台包括电机、传感器、控制器等组成部分。
在设计机器人硬件平台时,需要根据具体的保洁任务要求进行设计,从而保证机器人的稳定性、灵活性和安全性。
2. 机器人软件平台的设计:机器人软件平台需要涉及机器人的控制、定位、导航、传感器数据处理等方面。
《清扫机器人控制系统的实现与改进》范文

《清扫机器人控制系统的实现与改进》篇一一、引言随着科技的飞速发展,智能家居逐渐成为现代家庭生活的重要组成部分。
其中,清扫机器人作为智能家居的代表之一,以其高效、便捷的特点赢得了消费者的广泛喜爱。
然而,清扫机器人的性能与效率很大程度上取决于其控制系统的设计与实现。
本文将探讨清扫机器人控制系统的实现过程及其后续的改进策略。
二、清扫机器人控制系统的实现1. 硬件设计清扫机器人的硬件部分主要包括主控芯片、电机驱动模块、传感器模块(如红外传感器、超声波传感器等)以及电源模块等。
主控芯片是整个系统的核心,负责处理传感器数据、控制电机驱动等任务。
电机驱动模块则负责驱动清扫机器人的电机,使其能够按照预设的路径进行移动。
传感器模块则用于感知周围环境,帮助机器人进行路径规划与避障。
2. 软件设计软件部分主要包括操作系统、算法以及用户界面等。
操作系统负责管理硬件资源,提供稳定的运行环境。
算法则是控制系统的核心,包括路径规划、避障算法、清扫模式等。
用户界面则用于接收用户的操作指令,并将操作指令转化为机器人的行动指令。
3. 控制系统实现在硬件与软件设计的基础上,通过编程实现控制系统的各项功能。
首先,通过传感器数据感知周围环境,然后根据路径规划算法计算出最优的移动路径。
接着,通过电机驱动模块控制机器人的移动,同时根据避障算法避开障碍物。
最后,通过用户界面接收用户的操作指令,并转化为机器人的行动指令。
三、清扫机器人控制系统的改进策略1. 优化算法针对清扫机器人的路径规划与避障算法进行优化,提高机器人的工作效率与清扫效果。
例如,采用更加先进的路径规划算法,使机器人能够更快地找到最优路径;或者改进避障算法,提高机器人在复杂环境下的避障能力。
2. 增加智能功能通过增加更多的传感器和智能识别技术,使清扫机器人具备更多的智能功能。
例如,增加摄像头和图像识别技术,使机器人能够识别不同类型的垃圾并进行分类清扫;或者增加语音识别功能,使机器人能够根据用户的语音指令进行操作。
《清扫机器人控制系统的实现与改进》范文

《清扫机器人控制系统的实现与改进》篇一一、引言随着科技的飞速发展,智能家居已成为现代家庭生活的重要组成部分。
其中,清扫机器人作为智能家居的代表之一,其控制系统是实现其高效、智能工作的核心。
本文将详细介绍清扫机器人控制系统的实现过程及其后续的改进措施。
二、清扫机器人控制系统实现1. 硬件设计清扫机器人控制系统硬件主要包括机器人主体、电池、电机驱动、传感器等部分。
其中,机器人主体采用先进的机械结构设计,以实现高效的清扫效果;电池为机器人提供持续的动力支持;电机驱动则负责驱动机器人行进;传感器则用于实现机器人的避障、定位等功能。
2. 软件设计软件设计是清扫机器人控制系统的核心。
通过编写控制算法,实现对机器人的导航、路径规划、避障等功能。
同时,软件还需与用户界面进行交互,以便用户能够方便地控制机器人。
在软件实现过程中,我们采用了模块化设计思想,将系统分为传感器数据处理、电机控制、路径规划等模块。
每个模块独立负责特定的功能,使得系统更加稳定、易于维护。
三、控制系统改进措施1. 优化算法针对清扫机器人在工作过程中可能出现的路径规划不合理、避障能力不足等问题,我们通过优化算法来提高机器人的工作效率和安全性。
例如,采用更先进的路径规划算法,使机器人能够更高效地完成清扫任务;通过改进避障算法,提高机器人在复杂环境中的避障能力。
2. 增强传感器性能传感器是清扫机器人实现避障、定位等功能的关键部件。
为了提高机器人的性能,我们计划对传感器进行升级,采用更先进的传感器技术,提高其精度和稳定性。
此外,我们还将对传感器数据进行实时处理和分析,以便机器人能够更好地适应各种环境。
3. 引入人工智能技术为了进一步提高清扫机器人的智能化程度,我们将引入人工智能技术。
通过机器学习算法,使机器人能够自主学习和优化清扫策略;通过语音识别技术,实现用户与机器人的自然交互;通过图像识别技术,使机器人能够识别地面上的障碍物和污渍程度,以便更好地完成清扫任务。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
0 引言移动机构是清洁机器人的主体,决定了清洁机器人的运动空间,一般采用轮式结构。
传感器系统一般采用超声波传感器、红外光电传感器、接触传感器等构成多传感器系统。
随着近年来控制技术、传感技术以及移动机器人技术等技术的迅速发展,智能清洁机器人控制系统的研究和开发已具备了坚实的基础和良好的发展前景。
吸尘系统在原理上与传统立式吸尘器相同,主要是在结构设计上更多考虑结构尺寸、集成度以及一些辅助机构的合理布置和利用,以此来提高能源利用率和工作效率。
本文主要研究智能清洁机器人测控系统的设计与实现,最终目标是通过软硬件的合理设计,使智能清洁机器人能够自动避开障碍物,实现一般家居环境下的自主清洁工作。
1 测控系统组成及功能智能清洁机器人测控系统主要包括控制器核心系统、传感器系统和驱动系统等。
其原理如图1所示。
基于清洁机器人自身体积尽可能小的原则,本设计将控制器核心系统、传感器系统、行走驱动及相关电路集成在一块电路板上。
为防止干扰,通过光电隔离器件将各模块在电气上隔离开来。
利用超声波传感器、红外反射式传感器和接触传感器组成多传感器系统,检测信号经调理电路处理后送控制器;采用8位单片机SST89E554RC作为控制器,控制器对传感器信号加以判断,根据判断结果,选定相应的控制策略,并控制语音系统发出相应的报警信号;在相应的控制策略下,通过专用驱动器驱动直流电机,带动驱动轮,两轮独立驱动,实现避障功能;同时,控制器控制小型双风机真空吸尘系统对经过的地面进行必要的清扫。
图1 系统原理该新型智能清洁机器人实验平台如图2所示,该平台为圆形结构,两轮独立驱动,具备完整的吸尘系统和电源系统等功能模块。
最终将在该平台上对本文所介绍的测控系统的性能进行实验验证。
图2 智能清洁机器人实验平台2 测控系统硬件设计2.1 CPU控制模块CPU采用美国SST公司制造的8位单片机SST89E554RC。
器件使用与8051完全相同的指令集,并与标准的8051器件管脚对管脚兼容。
片内拥有1 kB字节RAM空间,3个16位定时计数器,4个8位I/O端口,拥有可编程计数阵列(PCA,可提供5路256级PWM调速,可通过全双工增强型串口实现人机通讯。
依据SST89E554RC单片机的引脚特性,在实际设计中,各电机驱动信号由单片机P1口输出,左右驱动电机占用P1.1~P1.6共6个端口(其中 P1.3和P1.6作为PWM调速信号输出端口使用,吸尘风机和起尘电机分别占用P1.0和P1.7口;红外反射式传感器和接触传感器检测信号分别送给 P2口的P2.0~P2.7共8个端口;超声波接收器信号经调理后送人外部中断INT1(P3.3口;2个触摸式选择屏的触摸信号经处理后分别送给 P3.4口和P3.5口。
2.2 驱动模块直流电机所需的驱动电压、驱动电流均比较大,因此采用双H桥高电压大电流驱动芯片L298N作为电机驱动芯片。
L298N是推挽式功率放大专用集成电路器件,直流驱动电流总和可达4A,其内部具有2个完全相同的PWM功率放大回路,拥有PWM调速功能。
在控制电路中,考虑到单片机会受到驱动部分的干扰,因此采用了光电藕合器TLP521,把控制部分和驱动部分在电气上隔离开来。
采用8个1N5822高速大电流肖特基二极管组成续流保护电路,消除电机在起停、制动及换向时产生的反电势。
系统工作时,单片机P1口输出的控制信号经过驱动器芯片74HC245和光电拥合器之后输入电机驱动芯片L298N,控制电机动作。
当需要调速时,只需改变PWM波(本设计中由单片机P1.3和P1.6端口产生的占空比即可,理论上可以实现256级调速。
2.3 障碍物检测模块2.3.1 超声波检浏部分超声波是一种一定频率范围的声波,频率为40kHz的超声波信号在空气中的传播效率最佳。
本文选用中心频率40kHz,测距范围在5m以内的普通超声波传感器。
传感器发射探头和接收探头安装在机器人正前方,系统工作时,通过汇编程序由P3.7口产生精确的40kHz发射脉冲,每隔25ms发射一组脉冲,每组的脉冲个数取6~10个,以保证发射波具备良好的传播性和反射性。
发射波遇到障碍物反射回来,被接收器接收,转变成电信号脉冲,对该信号进行放大、滤波、比较和整形等处理后送入单片机外部中断口INT1,触发单片机外部中断,进入中断处理程序,获取从发射波发出到收到反射波时的时间间隔即测距时间,由此即可根据超声波测距原理计算出障碍物的距离。
主程序中设定机器人行走过程中距离障碍物的最小距离,当被测距离小于最小距离时,控制器向驱动系统发出避障指令,避开障碍物。
本设计中利用软件延时去除串扰带来的误操作,即在发射波发出一段时间后,再打开外部中断,避免发射波不经反射就直接被接收器接收而引起假中断。
2.3.2 红外反射式传感器检测模块该模块用于主动探测机器人周边障碍物和地面落差。
选用JY043W型红外反射式传感器,该型传感器调理电路简单,安装调试方便,每一路的检测距离可以达到 7cm,满足本文设计的需要。
该部分由6路检测单元组成,其中在机器人左前方和右前方各安装2路,配合超声波传感器实现周边障碍物的检测。
另2路分别安装在机器人前端左下方和右下方,探头距离地面4cm,用于检测地面是否有台阶等落差,防止机器人跌落。
红外反射式传感器具体工作过程为,发现障碍物时,发射管发出红外信号遇到障碍物反射回来,接收管接收到反射信号后导通,则信号处理电路的输出端变为低电平,该低电平直接送入控制器P2的一个端口,当控制器检测到这个端口的低电平变化时则表明该方位发现障碍物。
2.3.3 接触传感器检刚模块接触传感器具有检测范围大、信号无需调理、占用控制器资源少等一系列优点。
本文选择小型接触开关作为接触传感器,安装在机器人前端的缓冲器上,作用在于通过轻微的碰撞接触,检测那些未能被超声波传感器和红外反射式传感器检测到杆状或微小障碍物,如座椅腿等。
3 测控系统软件设计3.1 传感器信息处理当各路传感器检测到障碍物时,控制器必须获得障碍物的准确信息后,才能发出正确的避障指令。
为了获得有效信息,程序代码中为每一路检测信息都设定一个标志位,主程序不断检测各个标志位的值的有效性,以此作为障碍物方位信息。
对于不同的传感器,其信息判断标志位有效值也可能不同。
在本文所提到的3种传感器中,超声波传感器的信号处理程序最为复杂,其流程如图3所示。
图3 超声波传感器信号处理程序流程3.2 驱动控制驱动控制模块是智能清洁机器人自主行为的执行机构。
根据传感器信息判断当前环境状态,对不同的障碍物信息,控制器将调用不同的避障策略,策略与驱动控制的动作组合指令相对应,通过左右驱动电机动作的有效协作,实现机器人前进、后退、转弯等自主动作。
单部电机的控制信号与电机动作之间的关系如表1所示,其中 P1.1和P1.2为电机方向控制信号端口,P1.3为PWM波调速端口,需要减速时只需要降低PWM波的占空比即可,理论上可以实现256级调速。
表1 控制信号与电机动作关系3.3 避障算法描述根据模糊控制思想并结合实际行走试验设计避障算法。
以传感器系统9路传感器的检测距离和障碍物所在的方位为模糊控制输入量,以驱动轮的前进、旋转和后退动作为模糊控制输出量。
超声波传感器检测最小距离设定为15cm,距离远;红外传感器检测距离为7cm,距离适中;接触传感器是在发生碰撞后才能检测到障碍物,因此检测距离最近。
据此设距离信号(记作:D的模糊语言集合为:D={近,中,远}设定其相应的语言变量,记作:ND=近,MD=中,LD=远以各路传感器在机器人上的安装位置作为障碍物所在方位(记作:A。
超声波传感器安装在正前方,在其左右两边依次是接触传感器、下方红外传感器和周边红外传感器。
则设方位信号的模糊语言集合为:A={最左,较左,左,左下,中,右下,右,较右,最右}设定其相应的语言变量,记作:BL=最左,ML=较左,L=左,LD=左下,M=中,R=右,RD=右下,MR=较右,BR=最右设机器人驱动轮的动作集合为:{右转,稍微右转,后退,减速,前进,稍微左转,左转}设定其相应的语言变量,记作:TR=右转,TRL=稍微右转,GB=后退,SD=减速,GA=前进,TLL=稍微左转,TL=左转对于清洁机器人来说,在避障的同时,还要能够对清洁区域进行遍历。
在保证避障和遍历的前提下,为了减少控制器的计算量并避免程序复杂化,本文采用逐一查询方式获得模糊控制量之一障碍物方位,根据障碍物方位即可获得另一输入量即机器人与障碍物间的距离。
容易理解,采用逐一查询方法意味着控制器获得的障碍物信息来自于最先被传感器系统检测到的障碍物,而且控制器将根据最先获得的障碍物信息来调用相应的避障策略。
因此,当有2个或2个以上方位有障碍物时,执行避障策略时机器人有可能与障碍物发生碰撞。
试验发现,只有当左边的最左、较左方位和右边的最右、较右方位都有一个或2个发现障碍物时,才有可能导致机器人与障碍物发生碰撞。
为了避免这种情况发生,将机器人左右两边都发现障碍物的情况也作为一个障碍物方位变量,不论机器人左右2边是同时发现一个还是2个障碍物,都仅设其模糊语言为左右,设定相应的语言变量为LR。
根据有利于避碰的原则,将障碍物方位信息的查询顺序确定为:LD,RD,LR,M,BL,BR,ML,MR,L,R(左下,右下,左右,中,最左,最右,较左,较右,左,右从机器人有效避障并保证尽量少的重复先前行走轨迹的角度出发,当确定了障碍物的方位和机器人离障碍物的距离后,我们希望模糊控制的输出量不仅仅是机器人动作集合中某一种动作,而是集合里某几种动作的合理组合。
因此,针对不同方位的障碍物信息,对机器人左右驱动轮动作集合的7种动作 (TR,TRL,GB,SD,GA,TLL,TL进行合理组合,即得到相应的合成输出量,记作Fi(i=1,2,3…。
根据前述方法,最终可归纳出 10种控制规则,即避障策略,如表2所示。
表2 控制规则表按照障碍物方位信息的查询顺序,其形式是:if(Ai and Dthen Fii=1,2,3 (10)按照此种方法,在不影响机器人有效避障和相关功能的情况下,有效避障的控制规则大大减少,使避障算法简单化。
4 实验结果在智能清洁机器人实验平台上对整个测控系统进行测试。
实验在一间约10m2的房间中进行,在房间中随机摆放几件日常物品作为障碍物,将通过智能清洁机器人的行走实验,对本文所述的智能清洁机器人测控系统的软硬件性能进行验证。
实验中,智能清洁机器人始终保持直线行走,遇到障碍物时,根据障碍物信息选择合适的避障策略避开障碍物,然后继续保持直线行走,直到遇到下一个障碍物。
实验结果表明,该测控系统工作可靠,避障算法有效可行,智能清洁机器人能够自动回避障碍物,可以在无人情况下自主工作,能够实现家居环境下的智能化清扫。