一种低速商用机器人、定位导航方法及定位导航系统技术方案

本发明专利技术公开了一种低速商用机器人、定位导航方法及定位导航系统，方法包括以下步骤：激光slam导航：相对于机器人通过激光雷达构建地图时所设原点的坐标信息；差分GPS导航：通过差分GPS导航机器人相对应的坐标信息；视觉slam导航；结合激光雷达与双目视觉传感器，融合距离信息与旋转角度信息，获得路标信息；定位机器人的初始位置，根据路标信息，构建特征地图，实现导航。本发明专利技术相比惯导/GPS/电磁罗盘组合导航方法定位更加稳定，定位精度更高。而且本发明专利技术通过激光slam、差分GPS和视觉slam三者进行融合得到的优化数据进行导航相比单一传感器获取的数据进行导航，移动机器人的定位精度和稳定性都更高，使得移动机器人运行更加平稳，极少偏离正常轨迹。

A Low Speed Commercial Robot, Location and Navigation Method and Location and Navigation System

【技术实现步骤摘要】
一种低速商用机器人、定位导航方法及定位导航系统
本专利技术属于智能科技
，具体涉及一种低速商用机器人、定位导航方法及定位导航系统。
技术介绍
现有机器人的导航系统有多种实现方式，例如现有多数机器人导航系统采用GPS、电磁罗盘和惯导进行数据融合实现导航(刘锦涛.惯导/GPS/电磁罗盘组合导航方法研究[D].哈尔滨工业大学,2008.)，该技术的基本原理是采用电磁罗盘提供车身姿态，依靠GPS提供机器人定位，当GPS数据丢失时采用惯性导航系统预知车身姿态。该技术存在一定的不足：首先，采用GPS进行定位，其受天气和位置的影响较大，当遇到天气不佳的时候或当见不到天空的时候，GPS的定位会受到极大的影响；其次，采用惯性导航系统预知车身姿态，由于导航信息经过积分而产生，定位误差随时间而增大，在GPS持续信号不理想情况下，无法实现可靠定位；再者，电磁罗盘容易收到周围磁场影响，导致无法提供可靠的航向姿态。移动机器人在未知环境中实现自主导航的前提是同步定位与地图构建，目前大多移动机器人采用激光雷达与单目视觉相融合的SLAM进行导航(庄严,王伟,王珂.移动机器人基于激光测距和单目视觉的室内同步定位与地图构建[J].自动化学报,2005,31(6):925－933.)。该技术用于全自主移动机器人在部分结构化室内环境下的导航运动中，基于激光和视觉传感器模型的不同，加权最小二乘拟合方法和非局部最大抑制算法被分别用于提取二维水平环境特征和垂直物体边缘，实现导航。该技术存在的问题和不足：将所处环境中的某些相关特征进行联合形成有意义的环境地标，虽然有效减少数据的不确定性，但其计算量大实时性差。文献：罗元,傅有力,程铁凤.基于改进Rao-Blackwellized粒子滤波器的同步定位与地图构建[J].控制理论与应用,2015,32(2):267－272.)中用于移动机器人的导航，在计算提议分布时将机器人里程计信息和激光传感器采集的距离信息进行融合，实现导航。该技术存在的问题和不足：采用了在计算提议分布时将里程计信息与激光采集的距离信息进行融合，验证了其可以有效减少所需粒子数并降低了预测阶段机器人位姿的不确定性，但由于激光数据比较单一其实验效果仍然不佳。由上述可知，现有机器人的导航系统存在稳定性以及定位精度较差等诸多不足。
技术实现思路
为了解决上述问题，本专利技术提供了一种低速商用机器人定位导航方法，解决导航系统存在稳定性以及定位精度较差的问题。本专利技术的技术方案为：一种低速商用机器人定位导航方法，包括以下步骤：(1)激光slam导航：相对于机器人通过激光雷达构建地图时所设原点的坐标信息；(2)差分GPS导航：通过差分GPS导航机器人相对应的坐标信息；(3)视觉slam导航：通过双目视觉传感器获取两幅不同视角的图像，并通过ORB算法从两幅图像中寻找特征点，匹配并得到旋转角度，将匹配得到的旋转角度与里程计角度融合；(4)结合激光雷达与双目视觉传感器，融合距离信息与旋转角度信息，获得路标信息；(5)定位机器人的初始位置，根据路标信息，构建特征地图，实现导航。本专利技术主要通过三个不同的导航方式进行融合达到冗余的效果，其中三个不同的导航方式包括：激光slam导航、差分GPS导航、视觉slam导航。其中差分GPS的作用是提供移动机器人相对应地坐标信息；视觉slam导航是用ORB算法从双目视觉传感器中获得的两幅不同视角的图像中寻找特征点，匹配并得到旋转角度，将得到的匹配角度与里程计角度融合，使其更加接近实际角度，结合激光雷达与双目视觉传感器，分别融合距离信息与旋转角度信息，定位移动机器人的初始位置，根据激光雷达与双目视觉传感器获得的路标信息，构建特征地图，最终实现导航。激光slam的定位信息是相对于移动机器人通过激光构建地图时所设原点的坐标信息，视觉slam的定位信息也是相对于移动机器人通过双目摄像机构建地图时所设原点的坐标信息。激光雷达、差分GPS、双目摄像头三种传感器融合提供的冗余信息能够构建可靠性更高、更精确的环境地图，能够有效提高移动机器人SLAM的鲁棒性。本专利技术中三种不同导航方式的起点选取同一个原点，其中得到定位信息的尺度也是绝对的；那么在三种导航方式的坐标系原点相同的情况下，只需要考虑角度问题，就可以把三者数据匹配在同一位置：其中GPS坐标系是绝对的，且自身定位信息带了方向；而slam坐标系是相对的，且IMU提供的角度也是相对，但由于GPS坐标系统的绝对性，可以通过旋转slam坐标系，使得该坐标系得到的当前定位和GPS定位一致；相类似地，双目摄像头的坐标系也是相对的，通过旋转矩阵，可以有效地把三者定位匹配到同一个参考点；通过激光雷达、差分GPS、双目摄像头三种传感器不同的信号强度来改变阈值，最终输出融合后的高精度的定位信息。从统计学的角度看，SLAM是一个滤波问题，也就是根据系统的初始状态和从0时刻到t时刻的观测信息与控制信息(里程计的度数)估计系统的当前状态。在SLAM中，系统的状态由机器人的位姿r和地图信息m组成(包含各特征标志的位置信息)。假设系统的运动模型和观测模型是带高斯噪声的线性模型，系统的状态服从高斯分布，那SLAM可以采用卡尔曼滤波器来实现。基于卡尔曼滤波器的SLAM包括系统状态预测和更新两步，同时还需要进行地图信息的管理。具体地：卡尔曼滤波的核心是预测加测量反馈更新预测：在该步骤中，卡尔曼滤波器根据初始值预测新值，然后根据系统中存在的各种过程噪声预测我们预测中的不确定性/误差/方差。在自动驾驶过程中，可以通过采用我们车辆前方移动的汽车的简单示例来理解噪音。本专利技术中的模型将假设汽车由于零加速而以恒定速度移动，但实际上它将具有加速度，即速度将不时波动。这种汽车加速度的这种变化是不确定性/误差/方差，本专利技术使用过程噪声将其引入本专利技术。更新：在此步骤中，我们从系统的设备中获取实际测量值。在自动驾驶车辆的情况下，这些设备可以是雷达或激光雷达。然后我们计算预测值和测量值之间的差值，然后通过计算卡尔曼增益来决定保持哪个值，即预测值或测量值。根据卡尔曼增益做出的决定，计算新值和新的不确定性/误差/方差。来自更新步骤的该输出再次反馈到预测步骤，并且该过程继续直到预测值和测量值之间的差异倾向于转换为零。该计算值将是由卡尔曼滤波器完成的预测。卡尔曼增益：它确定本专利技术的预测值或测量值是否接近实际值。其值范围为0到1。如果其值接近0则表示预测值接近实际值，或者如果该值接近1则表示最终测量值接近实际值。它的值范围从0到1，因为它使用预测值和测量值中的不确定性/误差。卡尔曼滤波器中使用的所有这些函数都是线性的，因为它们在方程中不包括任何角度参数，因此我们可以直接将这些线性函数馈送到高斯分布以获得高斯分布均值和方差。本专利技术还提供了一种低速商用机器人定位导航系统，包括工控机，还包括与工控机信号连接的惯性导航系统、差分GPS、编码器、IMU、电磁罗盘以及16线激光雷达，所述IMU和电池罗盘为机器人提供姿态信息，所述差分GPS提供车身参考位置。本专利技术采用IMU、电磁罗盘来提供车身姿态，IMU的累计误差可以通过电磁罗盘来消除，且电磁罗盘不可靠的时候，通过IMU来保证航向精度；采用编码器提供精准的车身位置距离，采用差分GPS(精度1cm以内)提供车身参考位本文档来自技高网...

【技术保护点】
1.一种低速商用机器人定位导航方法，其特征在于，包括以下步骤：(1)激光slam导航：相对于机器人通过激光雷达构建地图时所设原点的坐标信息；(2)差分GPS导航：通过差分GPS导航机器人相对应的坐标信息；(3)视觉slam导航：通过双目视觉传感器获取两幅不同视角的图像，并通过ORB算法从两幅图像中寻找特征点，匹配并得到旋转角度，将匹配得到的旋转角度与里程计角度融合；(4)结合激光雷达与双目视觉传感器，融合距离信息与旋转角度信息，获得路标信息；(5)定位机器人的初始位置，根据路标信息，构建特征地图，实现导航。

【技术特征摘要】
1.一种低速商用机器人定位导航方法，其特征在于，包括以下步骤：(1)激光slam导航：相对于机器人通过激光雷达构建地图时所设原点的坐标信息；(2)差分GPS导航：通过差分GPS导航机器人相对应的坐标信息；(3)视觉slam导航：通过双目视觉传感器获取两幅不同视角的图像，并通过ORB算法从两幅图像中寻找特征点，匹配并得到旋转角度，将匹配得到的旋转角度与里程计角度融合；(4)结合激光雷达与双目视觉传感器，融合距离信息与旋转角度信息，获得路标信息；(5)定位机器人的初始位置，根据路标信息，构建特征地图，实现导航。2.一种低速商用机器人定位导航系统，包括工控机，...

【专利技术属性】
技术研发人员：丁宇，
申请(专利权)人：天合光能股份有限公司，
类型：发明
国别省市：江苏,32