专利名称：M序列离散式人工路标设置及相关移动机器人定位方法
技术领域：
本发明涉及移动机器人技术领域的路标设置和定位方法，具体是一种基于M序列的离散式路标设置方法以及相关移动机器人定位方法。
背景技术：
移动机器人在工业(如自动化物流和巡检)和民用(如智能车和家庭服务机器人)等领域有广泛应用。自定位技术是移动机器人领域的一项关键技术，其鲁棒性和精确性很大程度上决定了移动机器人系统的工作效率。移动机器人的自定位技术一般分为自然路标定位和人工路标定位两大类。其中自然路标定位方法利用自然环境中的特征进行定位，具有良好的普适性且不需要环境改造。但这类方法方法复杂，鲁棒性不佳，且定位精度往往受到环境的影响。人工路标辅助定位技术，是指将路标设置在机器人工作环境中，通过传感设备对路标进行识别，从而实现机器人的自定位。由于该类方法中，路标特征稳定，系统构成简单，具有较强的鲁棒性，所以被广泛米用。在人工路标辅助定位方法中，路标的识别准确率很大程度上决定了定位方法的鲁棒性和工作效率。同时，在一些条件严苛的复杂室外环境中，各种外界干扰，如电磁干扰、光照变化等，也会对人工路标的识别带来挑战。针对以上问题，近年来国内外研究人员提出了几种解决方案。例如，中国发明专利，公告号CN102419178A，提出利用一种3X3型点阵式主动红外路标帖附与天花板上，并利用机器人载红外广角摄像机识别路标并计算机器人位姿。中国发明专利，公告号CN102735235A，提出一种基于二维码的室内移动机器人定位方法，通过利用图像采集装置获取环境图像，并利用视觉识别方法，识别分布在室内环境中的二维码标签，从而实现机器人定位。中国发明专利，公告号CN1707223A，提出一种基于一维条形码的室内移动机器人定位方法，机器人通过条码扫描装置、译码器、电子地图映射表，实现对一维条形码路标的识别以及机器人定位。上述方法具有路标识别难度高、抗干扰能力弱等缺点，具体分析如下:1.路标识别难度高:当地图较大时，需要使用较多的路标。为了区分所有的路标，使得每个路标全局唯一，当路标特征参数选取范围限定时，较多的路标会导致不同路标之间的特征差异减小。因此，为了准确可靠地区分不同的路标，要求系统具有更高的路标识别能力，如:更小的测量误差、更高的分辨率等等。2.抗干扰能力弱:外界环境的干扰，如光照强度不均、视觉路标污溃等，都可能对路标的识别带来负面影响。而当使用较多路标时，由于路标特征参数差异较小，较小程度的外界干扰就能够造成不同路标间的混淆，导致路标误识别的情况，从而影响定位的准确率。上述缺点限制了路标定位方法在大范围(如工厂和码头的物流搬运等)和复杂环境(室外天气和照明变化等)下的应用。
发明内容
针对现有技术的以上问题，本发明采用具有抗干扰和易识别特点的一种伪随机序列一M序列对路标设置进行建模，提出一种面向移动机器人定位的M序列离散式人工路标设置方法及其相关机器人定位方法。根据本发明的一个方面，提供一种M序列离散式人工路标设置方法，具体为:路标根据其特征不同相互区分，路标特征采用路标本身性质(如:颜色、尺寸、形状等)或路标空间位置关系(如:相邻路标间距);路标特征参数为路标特征的量化表达；路标依次设置在机器人运动路径上，其设置顺序基于M序列，路标的特征参数为其对应的M序列中元素的映射；数个相邻路标构成一个路标组，作为定位基本单元，全部路标设置位置及其路标特征参数构成路标地图，机器人利用路标地图与实测信息的匹配实现定位。优选地，全局路标总数m，路标组内路标个数n，由实际应用条件确定；路标特征参数集合基数q，为满足公式qn ^ m-n+1的最小正整数；生成q元η级M序列，并根据该M序列元素与路标特征参数的映射关系，生成路标设置序列，并依此在机器人运动路径上设置路标。优选地，路标设置方法步骤如下:全局路标总数m，根据路径总长1、预测范围阈值th3确定，满足公式如下:
j1,1
(I)其中，预测范围阈值th3表示，所述定位方法根据机器人运动模型预测机器人位姿情况下，机器人最大允许连续行驶长度。路标组内路标个数n，根据初始盲区范围阈值th4确定，满足公式如下:
权利要求
1.一种M序列离散式人工路标设置方法，其特征在于，具体为:路标根据其特征不同相互区分；路标特征采用路标本身性质或路标空间位置关系；路标特征参数为路标特征的量化表达；路标依次设置在机器人运动路径上，其设置顺序基于M序列，路标特征参数为其对应的M序列中元素的映射；数个相邻路标构成一个路标组，作为定位基本单元，全部路标设置位置及其路标特征参数构成路标地图，机器人利用路标地图与实测信息的匹配实现全局定位。
2.根据权利要求1所述的M序列离散式人工路标设置方法，其特征在于，全局路标总数m，路标组内路标个数n，由实际应用条件确定；路标特征参数集合基数q，为满足公式qn ^ m-n+1的最小正整数；生成q元η级M序列，并根据该M序列元素与路标特征参数的映射关系，生成路标设置序列，并依此在机器人运动路径上设置路标。
3.一种基于权利要求1或2所述M序列离散式人工路标设置方法的相关移动机器人定位方法，其特征在于，包括如下步骤: 步骤1，机器人位姿预测:根据机器人运动模型，计算机器人预测位姿； 步骤2，路标检测判断:机器人利用路标检测传感器进行路标检测，若检测到路标，则进入步骤3，反之，则进入步骤6 ； 步骤3，路标特征参数获取:机器人通过路标检测传感器，获取路标特征参数； 步骤4，实测路标组特征参数更新:根据步骤3获取的路标特征参数，更新实测路标组特征参数，实测路标组特征参数包括数个最近测得的路标的特征参数以及排列顺序； 步骤5，路标组匹配:将实测路标组特征参数与路标地图中各路标组进行匹配，并搜索最佳匹配结果An1和次佳匹配结果fm2，作为路标组匹配可靠性判断的依据； 步骤6，路标组匹配可靠性判断:仅当An1与fm2满足可靠性阈值要求:An1 ≤ thi Π fm2 ≥ th2 其中，为最佳匹配阈值，th2为次佳匹配阈值，则认为路标组匹配成功；反之则认为路标组匹配失败； 步骤7，机器人位姿更新:若路标组匹配成功，则利用路标组匹配结果更新机器人位姿；若路标组匹配失败或未检测到路标，则根据预测位姿更新机器人位姿。
全文摘要
本发明提供一种M序列离散式人工路标设置方法及其相关移动机器人定位方法。路标设置方法，其特征为，路标根据其特征不同相互区分，路标特征采用路标本身性质或路标空间位置关系；路标特征参数为路标特征的量化表达；路标设置顺序基于M序列，路标的特征参数为其对应的M序列中元素的映射。其相关机器人定位方法，其特征为，数个相邻路标构成一个路标组，作为定位基本单元；全部路标的设置位置及其特征参数，构成路标地图；机器人通过路标检测传感器识别路标；并获取实测路标组中各路标特征参数及其排列顺序；进而在路标地图中进行匹配，确定路标组位置；最终更新机器人位姿。本发明具有路标识别难度低、抗干扰能力强的优点。
文档编号G01C15/02GK103196440SQ20131008058
公开日2013年7月10日 申请日期2013年3月13日 优先权日2013年3月13日
发明者陈卫东, 唐恒博, 王景川 申请人:上海交通大学