[发明专利]基于GNSS/ODO的机器人双轮差速定位方法

说明书

本发明属于机器人技术领域，特别涉及一种机器人定位方法。基于GNSS/ODO的机器人双轮差速定位方法，步骤为：A.初始化机器人，利用GNSS获取初始时刻机器人的位姿信息；B.利用双轮里程计定位算法对机器人n+1时刻的全局位姿信息进行推算；C.判断当前时刻是否为设定的GNSS数据修正时刻，如果是，则执行D步骤；如果不是，则执行E步骤；D.根据步骤B中推算得到的n+1时刻的无人车位姿状态，进行卡尔曼滤波“预测‑修正”；E.仅进行D步骤中的卡尔曼滤波预测，而不做修正；F.输出滤波后的机器人的全局位姿信息。利用本发明，机器人的定位、定向精度有显著提高。

技术领域

本发明属于机器人技术领域，特别涉及一种机器人定位方法。

背景技术

机器人定位主要是指机器人通过外部传感器获取相关信息经过处理来确定自身及目标位姿的过程。现有的技术方案有里程计法、惯性导航法、卫星导航法、磁导航法等。其中，里程计法(ODO)是使用最为广泛的定位方法。在移动机器人车轮上装有光电编码器，通过对车轮转动的记录来实现对机器人的位姿跟踪。但此方法定位为航位推算法，是一个累加过程，其测量误差与车辆行驶路程长度有关，随着移动距离的增加，定位精度逐渐下降。惯性导航法利用惯性器件(加速度计和陀螺仪)来测量机器人本身的加速度以及角速度，并结合给定的初始条件，经过积分、解算得到每一时刻机器人的速度、位置、姿态等参数。但导航定位误差会随着时间积累，精度逐渐下降，所以惯性导航法不适合长时间的精确定位。卫星导航通过在机器人上安装GNSS移动站接收机，在另一已知点上安装GNSS基站，移动站GNSS接收基站GNSS的差分改正数据，为机器人提供高精度的位置、速度等信息来完成导航。但其具有局限性，即在卫星信号受到遮挡或干扰时无法提供有效的定位信息，不能满足导航具备完全自主性的要求。磁导航通过磁传感器检测磁场变化，从而进行定位导航。但此方法可变性和可维护性差，易受环境的影响。

发明内容

本发明的目的是：提供一种结合GNSS和ODO两传感器各自优点，扬长避短，基于GNSS/ODO的组合定位方法，避免GNSS定位信息由于遮挡或信号失锁时无法实现定位的问题，同时避免了ODO定位导致的累积误差问题，提高定位的可靠性。

本发明的技术方案是：一种基于GNSS/ODO的机器人双轮差速定位方法，包括以下步骤：

A.初始化机器人，利用GNSS获取初始时刻机器人的全局位姿信息；

设当前时刻为n，该时刻机器人的全局位姿信息由[x_g(n),y_g(n),θ_g(n)]描述，其中，[x_g(n),y_g(n)]表示机器人在全局坐标系中的平面坐标位置，θ_g(n)表示机器人的航向角；

B.依据n时刻机器人的全局位姿信息，根据公式(1.1)中双轮里程计该历元里的里程变化对机器人n+1时刻的全局位姿信息进行预测；

其中：L₁、L₂分别表示双轮里程计测量到的机器人左、右轮每历元的里程变化量，K₁、K₂分别为机器人左、右轮编码器矫正系数；L为机器人两轮中心轮距；

dθ_g为机器人在相邻两时刻转过的角度，(dx_l,dy_l)为机器人在本体坐标系下平面位置：

C.判断当前时刻是否为设定的GNSS数据修正时刻，如果是，则执行D步骤；如果不是，则执行E步骤；

D.根据步骤B中预测得到的n+1时刻的全局位姿信息，进行卡尔曼滤波“预测-修正”，卡尔曼组合滤波器设计如下：

系统状态变量和系统方程分别如公式(1.3)和(1.4)所示，