发明名称 移动机器人的多脉冲神经网络控制器导航控制方法
摘要 一种移动机器人的多脉冲神经网络控制器导航控制方法,属于移动机器人目标点趋近自主导航控制器技术领域,用于移动机器人的导航控制。其技术方案是:本发明包括目标点趋近控制器、沿墙行走控制器、避障行为控制器,控制器中采用了脉冲神经网络,在神经网络中同时融入时空信息。本方法在不同条件下设定各控制器权值,并根据不同控制器的权值顺序作为控制器激活与否的判别顺序,通过控制器激活及转换条件的使用,实现各控制器之间的相互转换。本发明通过神经网络的在线训练,实现机器人的在线自主学,与先前的基于模块化的控制器相比,控制策略简便易行,通过各控制器之间的转换,更加有效、高精度地控制移动机器人实现目标点趋近导航控制任务。
申请公布号 CN103984342A 申请公布日期 2014.08.13
申请号 CN201310716892.0 申请日期 2013.12.23
申请人 王秀青 发明人 王秀青;侯增广;谭民;潘世英
分类号 G05D1/02(2006.01)I 主分类号 G05D1/02(2006.01)I
代理机构 石家庄冀科专利商标事务所有限公司 13108 代理人 陈长庚
主权项 一种移动机器人的多脉冲神经网络控制器导航控制方法,其特征在于:它包括目标点趋近控制器、沿墙行走控制器、避障行为控制器,沿墙行走控制器和避障行为控制器中采用了脉冲神经网络,在神经网络中同时融入时空信息,导航控制方法包括以下步骤:步骤A:初始化各控制器,及相关阈值参数:<img file="dest_path_434217dest_path_image001.GIF" wi="41" he="37" />为判断周边障碍物考虑与否的阈值,<img file="dest_path_232409dest_path_image002.GIF" wi="43" he="37" />为机器人中心距目标点的距离,<img file="dest_path_572255dest_path_image003.GIF" wi="61" he="46" />为机器人是否到达目标点阈值,当机器人中心距目标点的距离<img file="dest_path_image008.GIF" wi="14" he="17" />机器人到达目标点阈值,即<img file="dest_path_31235dest_path_image005.GIF" wi="125" he="48" />,认为机器人到达目标点,<img file="dest_path_519985dest_path_image006.GIF" wi="44" he="37" />为移动机器人运动方向是否偏离给定方向阈值;步骤B:计算<img file="dest_path_178368dest_path_image007.GIF" wi="138" he="40" />为移动机器人当前运动方向和机器人中心点(<i>x<sub>r</sub>; y<sub>r</sub></i>)与目标点(<i>x<sub>t</sub>; y<sub>t</sub></i>)连线之间的夹角,<img file="dest_path_701754dest_path_image008.GIF" wi="41" he="34" />为移动机器人中心点(<i>x</i>,<i>y</i>)与与目标点(<i>x<sub>t</sub>; y<sub>t</sub></i>)连线与笛卡儿坐标系中横坐标轴正向之间的夹角,<img file="dest_path_397177dest_path_image009.GIF" wi="22" he="24" />为移动机器人位姿角;<img file="dest_path_638803dest_path_image010.GIF" wi="20" he="25" />的计算如下(1)(2)式所示:<img file="dest_path_586030dest_path_image011.GIF" wi="563" he="230" />步骤C:采集距离传感器测量信息;步骤D:判断机器人当前位置是否到达目标点,即是否<img file="dest_path_re-963922dest_path_image012.GIF" wi="126" he="43" />如果机器人当前位置到达目标点,即<img file="dest_path_re-95826dest_path_image012.GIF" wi="126" he="43" />,转入步骤L,机器人停止运动,否则进入步骤E;步骤E: 如果机器人当前位置未到达目标点,即<img file="364910dest_path_dest_path_image014.GIF" wi="162" he="64" />,进入权值设置控制器,设定各控制器权值,权值从大到小的顺序决定着判断各控制器是否激活的顺序;步骤F: 若机器人当前位置未到达目标点,即当<img file="282051dest_path_90676dest_path_image014.GIF" wi="162" he="64" />,并且移动机器人前半周距离传感器的测量值中的最小值<img file="dest_path_re-57332dest_path_image013.GIF" wi="252" he="52" />时,目标点趋近控制器值最大,判断是否满足目标点趋近控制器条件,满足则先进入目标点趋近控制器,即转入步骤K;否则转入步骤G;步骤G: 当移动机器人正前半周距离传感器的测量值中的最小值&lt;机器人与目标点之间的距离,即<img file="dest_path_re-94558dest_path_image014.GIF" wi="282" he="49" />时,根据各控制器权值大小的顺序判断各控制器激活的条件是否满足;先判断是否满足沿墙行走控制器激活条件,满足则进入I;不满足,判断是否满足避障行为控制器激活条件,满足则转入步骤J,仍旧不满足避障行为控制器激活条件,则转入步骤H;步骤H: 判断是否满足目标点趋近控制器激活条件,满足则转入步骤K;步骤I: 根据沿墙行走控制器控制策略控制机器人逆时针或顺时针沿墙行走<img file="dest_path_image032.GIF" wi="21" he="20" />时间,行走<img file="222716dest_path_image032.GIF" wi="21" he="20" />时间后,重复步骤B;步骤J: 根据避障行为控制器控制策略控制机器人进行避障行走<img file="396209dest_path_image032.GIF" wi="21" he="20" />时间,行走<img file="282256dest_path_image032.GIF" wi="21" he="20" />时间后,重复步骤B;步骤K: 进入目标点趋近控制器,按目标点趋近进行机器人控制; 步骤L:机器人到达目标点,机器人停止运动。
地址 050000 河北省石家庄市裕华区东岗路尚东绿洲小区10#-1-501