[发明专利]一种基于栅格地图的服务机器人自主导航方法

说明书

技术领域

本发明属于机器人及导航技术领域，涉及一种基于栅格地图的服务机器人自主导航方法。

背景技术

自主移动机器人是机器人研究领域的一个重要分支，它在军事、民用、科学研究等许多领域得到了广泛应用。近些年来，随着计算机、传感器和网络技术的发展，人们研究的重点也从结构式环境中的固定式机械臂、机械手转向非结构未知环境中的自主移动机器人。传统的机械臂空间环境建模以及示教运动的方法已无法满足自主移动机器人所面对的新任务。自主导航技术是移动机器人研究的核心，是实现自主移动的关键技术，主要包括自主定位、路径规划、跟踪控制等。目前，针对自主移动机器人导航问题已有很多的研究，但是现有的技术仍不够完善。自主定位是移动机器人导航的最基本环节，移动机器人要完成导航任务，就需要实时地知道自身相对于外界环境的位姿，常用的自主定位技术主要包括相对定位技术、绝对定位技术和组合定位技术。

相对定位也称为航迹推算，主要包括测距法和惯性导航法，其优点是不依赖于外部环境信息，可以提供完全的自主性和完备的导航信息，但是里程计、陀螺仪等传感器的误差会引来累积误差。绝对定位是利用外部参照系统，通过测量移动机器人的绝对位置来实现定位，主要包括网络定位、路标定位、地图匹配定位，其优点是定位精度较高，不存在累计误差，但是技术复杂，且成本较高。组合定位是将相对定位和绝对技术结合起来进行定位，通常的做法是利用相对定位进行位姿估计，利用绝对定位对定位结果进行校正。

路径规划是移动机器人跟踪控制的基础，是移动机器人导航中最重要的任务之一。移动机器人路径规划主要可以分为模板匹配路径规划、基于环境模型的路径规划和基于行为的路径规划三种类型。模板匹配路径规划是将机器人当前状态与过去模板库中的事例相比较，寻找出一个最优匹配事例，修正该事例中的路径，从而得到一条新的路径。基于环境模型的路径规划是目前最为成熟的方法，根据掌握信息的完整程度可分为环境信息已知的全局路径规划和环境信息完全未知或部分未知的局部路径规划。基于行为的方法是由BROOKS在他的包容式结构中提出的，将其用于解决移动机器人路径规划问题是一种新的发展趋势。

根据控制目标的不同，移动机器人的跟踪控制问题包括点镇定问题、轨迹跟踪问题、路径跟踪问题。点镇定问题是指设计控制器，使移动机器人从任意的初始状态到达并稳定在任意的终止状态，其目的是获得一个反馈控制律，使移动机器人闭环系统的一个平衡点是渐进稳定的。轨迹跟踪问题是指通过反馈控制，使得机器人从任意初始位置出发，都能够跟随预先设定好的期望轨迹。路径跟踪问题是指移动机器人以给定的速度或加速度，跟随预先设定好的期望路径。

以上三个关键技术是在机器人自主导航过程中必须解决的问题，但是由于服务机器人所处环境的复杂性，目前的一些技术已不能满足要求，因此需要对这些技术进行改进，或者研究新的导航技术。

发明内容

为了解决上述问题，本发明的目的在于针对现有技术的不足，提供一种基于栅格地图的服务机器人自主导航方法。

本发明基于栅格地图的服务机器人自主导航方法，包括自主定位、路径规划、轨迹跟踪，其特征在于：通过2D激光雷达实时地采集机器人所处的环境信息，进行环境特征提取，对采集的信息利用同时定位与地图构建技术进行栅格地图的创建，同时实时地对机器人进行自主定位，并在定位过程中对传感器误差实时地进行校正，在此基础上根据导航任务要求对机器人进行路径规划，然后根据规划的路径进行跟踪控制，使机器人完成导航任务，具体包括以下步骤：

本发明是通过以下技术方案实现的，本发明包括以下步骤：

步骤1：利用编码器采集机器人各轮的转速，利用2D激光雷达采集环境信息，从而得到服务机器人与周围环境的相对距离；

步骤2：同时定位与地图创建

步骤2.1：自主定位

步骤2.1.1：根据编码器反馈的各轮转速和服务机器人结构，建立机器人运动学模型；

步骤2.1.2：根据机器人位姿预测过程是马尔科夫过程，建立机器人位姿预测误差模型；

步骤2.1.3：根据2D激光雷达采集的环境信息，采用随机霍夫变换最小二乘算法提取局部环境直线特征和点特征，建立基于环境特征的观测模型；

步骤2.1.4：根据2D激光雷达原始数据与观测模型的关系，建立机器人观测误差模型；

步骤2.1.5：通过扩展卡尔曼滤波的定位算法进行自主定位。

步骤2.2：地图创建

步骤2.2.1：将局部环境特征通过鲁棒性的预测，从而生成全局环境特征；