基于模糊控制的移动机器人避障研究
2021-10-21
来源:易榕旅网
2017年第36卷第3期 传感器与微系统(Transducer and Mierosystero Technologies) 51 DOI:10.13873/J.1000-9787(2017)03--0051--04 基于模糊控制的移动机器人避障研究 杨小菊 ,张伟 ,高宏伟。,米海山 (1.中国科学院沈阳自动化研究所机器人学国家重点实验室。辽宁沈阳110016; 2.沈阳理工大学自动化与电气工程学院,辽宁沈阳110168) 摘娄:针对移动机器人在未知环境中的不确定性,利用Matlab构建了多传感器仿真试验移动平台,在 Simulink中搭建移动机器人运动学模型,利用多传感器采集环境中的障碍物信息与目标物的方位角,设计 了具有避障功能的模糊控制算法。通过模糊控制器控制移动机器人的左右轮速度实现机器人的转弯以及 直走,根据机器人实时的角度反馈信息不断修正机器人的位姿以精确避障。仿真实验验证了该方法的可 行性及有效性。 关键词:移动机器人;多传感器;模糊控制;避障 中囱分类号:TP273.4 文献标识码:A 文章编号:1000-9787(2017)03--0051-04 Study on obstacle avoidance of mobile robot based on fuzzy control YANG Xiao-ju ,ZHANG Wei ,GAO Hong.wei ,MI Hai.shan (1.State Key Laboratory of Robotics,Shenyang institute of Autotnation,Chinese Academy of Sciences, shenyang 110016,China;2.College of Automation and Electrical Engineering, Shenyang Ligong University,Shenyang 110168,China) Abstract:Aimed at uncertainty of mobile robot in unknown environment,multi—sensor simulation test mobile platform is constructed with Matlab and the kinematics model for mobile robot is built in Simulink.The obstacle information of environment and azimuth angle of target object are collected by multi-sensor and the fuzzy control algorithm which has the function of obstacle avoidance is designed.Fuzzy controller controls wheel speed of mobile robot to turn around and go straight,according to the angle of real—time feedback information to modify the pose of the robot and then avoid obstacles precisely.The results of simulation experiment verify feasibility and effectiveness of this method. Key words:mobile robot;multi—sensor;fuzzy control;obstacle avoidance 0引 言 移动机器人最基本的智能行为就是避障 J,是机器人 移动机器人通过传感器感知环境和自身状态,对复杂 环境进行自主分析、判断和决策,实现面向目标的自主运 进行决策规划和运动控制等高级智能行为的基础,是在复 杂环境或者未知环境中的完成各种任务的重要保障。因 此,研究实时准确避障也是当前移动机器人技术的难点与 热点。国内外多传感器信息融合的避障常用方法包括Bug 动,从而完成一定作业功能的机器人系统 。传感器采集 的信息是移动机器人感知的唯一来源,也是机器人理解环 境从而执行决策的依据。然而,环境信息往往是未知的。 算法 ]、人工势场法 】、矢量直方图法 、遗传算法 、模 糊控制法 等。Bugz算法中没有考虑机器人的动力学。 人工势场法结构简单,便于低层的实时控制,但是存在局部 最优解的问题,因而可能使机器人在到达目标点之前就停 传统的系统是靠单一传感器完成信号采集,即使使用多种 (多个)传感器也只能提供局部的孤立信息。多传感器的 出现使机器人从多层面,多角度、多方位充分理解环境信 息,为机器人实时做出准确的判断和决策提供了有力的技 术支撑。多传感器信息融合充分利用传感器信息的冗余、 互补性以提高机器人的感知能力与智能水平。 收稿日期:2016-04-21 基金项目:国家自然科学基金青年科学基金资助项目(51505470) 留在局部最优点,即死锁现象。遗传算法运算速度不快,进 化要占据较大的运算时间和存储空间。车体移动时,周围 的环境动态变化,移动机器人作为时变的非线性复杂系统, 52 传感器与微系统 第36卷 很难建立精确的数学模型,采用模糊控制方法能够很好地 解决这类问题 。 本文将模糊控制算法应用于移动机器人避障中,以模 糊控制器控制机器人的速度,通过Matlab仿真验证了此方 法的有效性。 1 移动机器人的系统结构与运动学模型 1.I 移动机器人的系统结构 移动机器人采用差速转向式,利用两后轮的筹速驱动 实现轨迹的控制和姿态的调节,系统结构如图l所示,移动 机器人的控制结构分为_二层结构 ’ :上层为传感器层(超 声波、红外与电子罗盘),完成环境信息的采集;中间为决策 控制层,实现机器人系统的运动控制决策;下层为运动执行 层,由驱动 元组成,完成机器人的转弯和直走等操作。 , ,图1移动机器人的系统结构图 针对机器人在复杂环境中执行避障任务,在移动饥器 一 人本体的左、前、右三个力‘向分别安装两超声波传感器获取 未知环境的障碍物距离信息,红外传感器来弥补超声波测 距的缺陷,用于紧急避障,电子罗盘实时获取机器人与目标 物的方位角..传感器的整体布局如图2昕示,1~6数字表 示机器人本体 的6个超声波编号,l非 2 声波组成机 器人左方障碍物的测距组,3#L3 4妫前方的测距组,5#t- ̄6# 组成右方的测距组。 移动机 人 超J{ 波传感 m 『U 罗盘豢红外传感 图2传感器的布局系统图 1.2移动机器人的运动学模型 『}1移动饥器人的运动学使型“可知,移动机器人 f£ 意时刻都足绕乍体转动 似没移动饥器人只作纯滚动 /f 滑动 图3为移动机器人的运动模型,其中XOY为移动机 器人的全局坐 系 、 移动机器人化姿 叮以表爪为 二] ㈩ 【 =1_)l/- UI 3 畅小葡,等: 于模糊控制的移动机 人避障研究 53 l_-■ ll I} I l ● I f I1 --■-l■ 一 ●l l ㈣ I- I--● 一 ● Ic) (11 l th) l- ■---■图4- —.- .1障碍物的环境分类 -I● 综合学虑各个他感器的信息做出 合理的避障决策 移动饥器人避障的决策取决于障碍物的分布,在Matlab 仿真环境ffI,需要模拟机器人的传感器分布,因此,将机器 人前方视线范围划分为左、前与右方三个区域,以判断障碍 物的l 怵f 、、 5为}1 ,J‘向分 罔 图5 目标方向 为J 使移动机器人 、精确避障, 利剑达H标f 、 、将趟 波 j红外传感器采集的信息进行分组预处 删, 离 息干¨电f罗黼获取的日标角度信息送入模糊控 制器,懊糊舒:法融合fn 境障碍物;然后根据控制规则发出 执f 命令,…运动执i于 实现饥器人的位 捌 ;最后将机 人的,仃瞍 时反馈给控 以精确地完成避障动作、移 动机器人进障 制 构 6所,J 传感 』1、 搽 侈 境 息nq 商l 分组 f』【 心 搜r ! 器 j 趣 处川 伯人 J耍 图6移动机器人避障的模糊控制结构 2.2模糊控制器的设计 此 ,i1:多 埘卡51糊 制进行深入研究,将多传感 采集的 息I f}受作为模糊 制器的输入,随荷传感器维 数的增JJ【】,分削数越多,控制规则就成俯增nf1,从 影响机 器人的 时 此埘传感器信息分组处理,提取最l仃效 n0特fiI!f't 为模糊 【Jn 输入 糊控制 汁为多输入/多输川系统(4输入/2输 …),将移动机 人 180。池 的 力‘、 力‘ 方的j芏j ,{ 波f1I  ̄3'-1t々感 采集的障衅物 !离(Id),FD,RD)以及电 J 艇扶取的l】标力.f 『f】(angle)作为模糊控制器的输入, f{;动机器人的/Jj 轮速度(1eft—V,riglIt—V)作为控 器的输 … 为r减少系统过多的输入 增力I1复杂性,取LD为机器 人 ‘洲:I{=的障碍物最近距离, LD=lllil'l(1,2)..『州理 D为前方的障碍物最近距离,FD=lllin(3,4),RD— arin(5,6) 、 …r模糊分割数‘j模糊控制规川紧密相关,模糊分割 数太多或太少郁将影响机器人的避障性能。考虑剑实验环 境和超声波测距性能,将输入变 LD.FD,RD的模糊语言 变 定义为 近”,“一 ,“远” = ”,“M”,“F'.:,障碍 物论域[0—4.51l1 前、左、有任意方向的趟声波出现洲量 育 时,障碍物的 离以该方向的红外传感器信息作为输 入。Angle的模糊语言变量为l--左”,“曲”,“右”÷= Z”, “Q”,“Y”;,论域为[0,180。] 输出变量left—V与rigllI—V 的值为{--200,一100,0,100,200 一I..NB”,“NS”,“Z”, “zS”,“ZB” 巾于高斯型隶属度 数曲线较为平滑,使系 统仃较好的准确性卡¨简洁性,所以小文的隶幅度函数采川 高斯型 7(a)为左方LD距离n 隶属度 数曲线 理 }ii『方干¨ 方有同样的隶属度曲线 目标角度的隶属度函数 I}I1线平11乍 轮速度求槲度曲线f』f 17(I})干¨(t-)昕示. l 0 毒 O O 1.O 2 0 3 0 4 0 LD距离,m (a)障碍物距离隶黼度 l O 0 5 0 0 20 40 60 80 100 l20 l40 160 1 8O input vai iable“Angle”角度/。 fb)}{标角度隶膪度 1 O 萋 0 5 O 述慢/m/s (c)速度求 度 图7 障碍物距离、目标角度和速度隶属度 为J 形象直观地规察 制效果. 叮以 看模糊控制规 则的i维观洲 , 8昕爪,其中(a)为输入前 距离RD j左办趴离LD,输出letf—V的曲面图,图(b)为输入LD与 Angle,输tl;right—V的[u1【fL『 200 l00 0 (a)/J・轮述艘 (b) i轮速度 图8模糊控制的三维观测图 水文的模糊推理采用Mamdani的Ill'IX—llli T1合成法,反 模糊化采胴叫积『fl心法 。模糊规[J!Jj足模糊控制的核心, 采川l rHEN条件沿占,组成N=3 x3 x3 x5=135条模糊 控制规则 以机器人的右侧具有障碍物为例,巳lJ图4的第 54 传感器与微系统 第36卷 4类障碍物分布所示,可以建立如下6条模糊控制规则:1) IF RD=N AND Angle=Z THEN lefl_V=NB AND right—V= PB;2)IF RD;N AND Angle=Q THEN left—V=PB AND right_V=PB;3)IF RD=N AND Angle=Y THEN left_V=PB AND right_V=NB:4)IF RD;M AND Angle:Z THEN left— V=Z AND fightV=PB;5)IF RD=M AND Angle=Q THEN left V=PB AND right_V=PB;6)IF RD=M AND Angle=Y THEN left_V=PS AND rightV=PS; 3移动机器人避障实验 首先在Matlab的in文件中设定机器人的起始位置、目 标位置和随机分布的障碍物。先计算机器人与目标物的角 度Angle,在设定测距范围内,计算障碍物与机器人的角度 并逐一与目标角度比较,当障碍物角度大于Angle时,则认 为障碍物在机器人的左方,等于Angle则可以确定障碍物 在机器人的前方,小于An e就认为障碍物在机器人的右 方。然后分别在左方、前方与右方区域计算离机器人最近 的距离作为左、前和右方的障碍距离。鉴于Simulink具有 直观、方便高效等特点,利用Simulink的模块搭建移动机器 人运动模型并建立模糊控制器。将In文件中实时计算的障 碍物距离和机器人与目标物体的角度信息送人Simulink的 模糊控制器,控制器输出机器人的左右轮速度,基于机器人 的运动学原理转换成当前的位置坐标。即用sim函数将m 文件与Siniulink建立连接,并配置好仿真时间,使ITI文件与 Simulink实时通信。Simulink的运动学模型图9所示。 图9 Simulink的运动学模型 经过多次仿真,不断调整各个模块的参数,最后将仿真 数据整理并执行画图功能,得到移动机器人的避障仿真结 果如图lO所示。 姜 褪 距离/m 图1O机器人避障仿真结果 4结论 本文基于模糊控制算法实现移动机器人的避障任务, 仿真实验结果表明,模糊控制算法解决非线性系统的优势。 在简单的环境中,移动机器人可以灵活、准确避开障碍物, 到达目标点,满足机器人避障需求。但是,在障碍物形状不 规则且分布复杂时,机器人容易靠近障碍物,造成避障失 败。因此,还需进一步改进避障算法,下一步将考虑将多种 算法集成 ” 使用并在移动平台上进行实物验证,比如将神 经网络与模糊控制结合,充分利用各自的优点,使机器人做 出更灵活、更优越的规划。 参考文献: [1]倪小雷, 佳俊.自主移动机器人混合式体系结构的设计与 实现[J].计算机测量与控制,2006,14(11):1526--1528. [2] Mahler R.Random sets:Uniifcation and computation for informa— tion fusi0n——A retrospective assessment[C]//The 7th Interna— tional Conft,rence on Information Fusion,Stockholm,Sweden: Swedish Defenee Research Agency,2004:1-20. [3]Lumelsky V,Skewis T.Incorporating rnage sensing in the robot navigation function[J].IEEE Transactions on Systems,Man,and Cybernetics,1990,20(5):1058--1068. 『4 1 Koren Y.Borenstein J.Potential field methods and their inherent limitations for mobile robot navigation[C]∥IEEE Conference on Robotics and Automation,California,1991:1398--1404. [5] Borenstein J,Koren Y.The vector field histogram-fast obstacle avoidance for mobile robots『J].IEEE Transactions on Robotics and Automation,1991(7):278-288. [6] 孙树栋,林茂.基于遗传算法的多移动机器人协调路径规 划[J].自动化学报,2000,26(5):672--676. [7] Malhotra R,Sarkar A.Development of a fuzzy logic based mobile robot for dynamic obstacle avoidance and goal acquisition in an unstructured environment[C]∥Proceedings of the 2005 IEEE/ ASME International Conference on Advanced Intelligent Mecha- tronics Monterey,California,USA,2005:1198--1203. [8] 赵晓光,戴炬,赵经纶.ROV模糊控制导航方法[J].信息与 控制,2002(1):55--58. [9] Araujo R,Almeida A T D.Learning sensor—based navigation of a real mobile robot in unknown worlds[J].IEEE Transactions on Systems Man and Cybernetics,Part B:Cybernetics A Publication of the IEEE Systems Man and Cybernetics Society,1999,29(2): 164-178. [1O]师黎,陈铁军,李晓媛,等.智能控制理论及应用[M].北 京:清华大学出版社,2009:34-67. [11]席爱民.模糊控制技术[M].西安:西安电子科技大学出版 社.2008. [12]黄漫国,樊尚春,郑德智,等.多传感器数据融合技术研究进 展[J].传感器与微系统,2010,29(3):5—8. 作者简介: 杨小菊(1989一),女,硕士研究生,主要研究方向为移动机器 人的多传感器信息融合方法。 张伟(1979一),通讯作者,博士,副研究员,从事故障诊断、 机器人等方面的研究工作,E—mail:zhangwei@sia.cn。