阅读说明：本技术 一种移动机器人定位监测方法、装置、设备和介质 (Mobile robot positioning monitoring method, device, equipment and medium ) 是由 马啸 于 2020-08-06 设计创作，主要内容包括：本发明涉及机器人技术领域,尤其是一种移动机器人定位监测方法,步骤1,获取并处理二维栅格地图数据及地图坐标信息,得到相关地图数据用于后续计算；步骤2,获取激光雷达发送的一帧激光数据；步骤3,获取并处理里程计数据,得到激光发射时刻对应的里程计数据；步骤4,修正激光数据；步骤5,计算定位准确度,定位准确度计算精度较高；本发明通过里程计数据修正激光雷达传感器数据,计算修正后的数据与栅格地图数据的匹配情况,进而判断机器人定位准确度,该方法可以广泛适用于移动机器人领域；本发明还提供了一种装置、设备和介质。(The invention relates to the technical field of robots, in particular to a mobile robot positioning monitoring method, which comprises the following steps of 1, acquiring and processing two-dimensional grid map data and map coordinate information to obtain related map data for subsequent calculation; step 2, acquiring a frame of laser data sent by a laser radar; step 3, acquiring and processing odometer data to obtain odometer data corresponding to the laser emission time; step 4, correcting laser data; step 5, calculating the positioning accuracy, wherein the calculation precision of the positioning accuracy is higher; according to the method, the data of the laser radar sensor is corrected through the mileage count data, the matching condition of the corrected data and the raster map data is calculated, and then the positioning accuracy of the robot is judged, so that the method can be widely applied to the field of mobile robots; the invention also provides a device, equipment and a medium.)

一种移动机器人定位监测方法、装置、设备和介质

技术领域

本发明涉及机器人技术领域，尤其是一种移动机器人定位监测方法、装置、设备和介质。

背景技术

随着技术的进步，移动机器人被广泛应用于社会的方方面面。定位技术是移动机器人的基础技术，定位准确与否直接影响移动机器人的性能。移动机器人在移动过程中，其定位准确度可能会受到环境变化、机器人底盘车轮打滑、人为触碰等因素的影响而降低。实时监测移动机器人定位准确度很有必要。

现有技术方案没有考虑激光雷达数据的运动畸变问题，导致定位准确度计算精度较低。

本发明提供了一种移动机器人定位监测方法、介质、终端和装置，解决了以上所述的技术问题。

发明内容

本发明要解决的技术问题是：为了解决现有技术方案没有考虑激光雷达数据的运动畸变问题，导致定位准确度计算精度较低问题，本发明提供了一种移动机器人定位准确度判断方法，步骤1，获取并处理二维栅格地图数据及地图坐标信息，得到相关地图数据用于后续计算；步骤2，获取激光雷达发送的一帧激光数据；步骤3，获取并处理里程计数据，得到激光发射时刻对应的里程计数据；步骤4，修正激光数据；步骤5，计算定位准确度，有效解决了现有上述问题。

第一方面，本发明提供一种移动机器人定位监测方法，

一种移动机器人定位监测方法，包括以下步骤：

步骤1，获取并处理二维栅格地图数据及地图坐标信息，得到相关地图数据用于后续计算；

步骤2，获取激光雷达发送的一帧激光数据；

步骤3，获取并处理里程计数据，得到激光发射时刻对应的里程

计数据；步骤4，修正激光数据；

步骤5，计算定位准确度。

进一步的，o,x,y为地图坐标系即全局坐标系，该坐标系在加载地图的同时确立；d_o,d_x,d_y为里程计坐标系，里程计坐标系相对于全局坐标的变换随着里程计误差的变化而变化；b_o,b_x,b_y为机器人坐标系，机器人坐标系相对于全局坐标系的变换随着机器人的移动而变化；l_o,l_x,l_y为激光雷达坐标系。

进一步的，所述步骤1中的栅格地图的坐标系即为全局坐标系，栅格单元的尺寸Sm/pix；栅格单元在x方向上的坐标为n_x×S(n_x为栅格单元在x方向上的序列),栅格单元在y方向的坐标n_y×S(n_y为栅格单元在y方向上的序列)；栅格单元的最近障碍物距离o_i，若该栅格单元被障碍物占据则o_i为0，否则o_i为该栅格单元与其相邻最近的障碍物栅格单元之间的距离。

进一步的，所述步骤2中获取的激光数据包括：一帧激光的光束数量N；第一束激光发射的时间t_s，最后一束激光发射的时间t_e,相邻激光束的时间间隔Δt；相对于激光雷达坐标系，每一束激光光束的角度θ_i，每一束激光光束端点和激光雷达坐标系原点的距离l_i，i代表激光发射时间。

进一步的，所述步骤3中的里程计数据发布频率，可以获取

时刻里程计的位姿数据(机器人在里程计坐标系下的位姿)，其中t_f≤t_s，t_l≥t_e，Δt₁是里程计数据的时间间隔，通过拟合插值的方式，可以得到在激光光束发射时间{t_s,t_s+Δt,…,t_e}下的里程计位姿数据{pd_s,pd_s+Δt,…,pd_e}。

进一步的，所述步骤4中修正激光数据的目的是将激光数据统一到里程计坐标系下，各时刻激光光束端点在激光雷达坐标下的坐标为(l_i×cosθ_i,l_i×sinθ_i)，经过坐标变换可以得到激光光束端点在里程计坐标系下的坐标(dx_i,dy_i)。

进一步的，所述步骤5中的机器人位姿数据为全局坐标系下的位姿坐标(px,py,pθ)，px为机器人在x方向坐标,单位为米；px为机器人在y方向坐标,单位为米；pθ为机器人朝向与x方向的夹角，单位为弧度。此位姿数据是t_e时刻机器人的位姿数据。

进一步的，所述步骤5还包括如下步骤：步骤5.1，获取定位信息，得到激光光束端点在全局坐标下的坐标；步骤5.2，计算激光数据中每一束激光的端点对应的栅格地图位置；步骤5.3，计算每一束激光与栅格地图的匹配情况；步骤5.4，整合每一束激光，计算定位准确度。

进一步的，所述步骤5.1中的定位信息p_e，就是待判断的数据；定位信息是t_e时刻机器人在地图坐标系下的位姿数据；通过p_e及步骤3中的pd_e可以得到在t_e时刻里程计坐标系相对于全局坐标系的坐标变换；可以假设在t_s～t_e时刻下里程计坐标系相对于全局坐标系的坐标变换固定，从而将步骤4中的激光光束端点在里程计坐标系下的坐标转换为在全局坐标下的坐标(x_i,y_i)。

进一步的，所述步骤5.2中，根据激光光束端点坐标，可以得到端点对应的栅格位置(nx_i,ny_i)，其中nx_i＝[x_i÷S]，ny_i＝[y_i÷S]。通过查表可以得到端点对应的最近障碍物距离o_i。

进一步的，所述步骤5.3中，计算每一束激光的匹配度

其中α是高斯分布系数，例如α＝0.4，β是高斯分布方差，例如β＝0.05。o_i越小说明此激光光束与栅格地图的匹配度越高。

进一步的，所述步骤5.4中定位准确度即为所有激光光束匹配度的均值。

第二方面，本发明提供一种实现定位准确度监测的装置，

一种实现定位准确度监测的装置，采用上述监测方法，包括：地图模块，用于加载指定的栅格地图；激光雷达模块，用于生成激光扫描信息；里程计模块，用于生成里程计位姿数据；激光数据修正模块，结合里程计模块生成数据修正激光雷达模块生成数据；准确度计算模块，计算位姿数据与栅格地图数据、修正后的激光数据的匹配情况，生成定位准确度。此模块包括一个位姿接口，用于接收外部输入的位姿数据；准确度显示模块，用于显示定位准确度计算结果。

第三方面，本发明提供一种计算机设备，

一种计算机设备，采用上述监测方法，包括存储器和执行器，存储器存储有计算机程序，执行器执行计算机程序时实现上述定位准确度监测方法。

第四方面，本发明提供一种移动机器人定位监测方法，

一种存储介质，采用上述监测方法，其上存储有计算机程序，计算机程序被执行器执行时实现上述定位准确度监测方法。

本发明的有益效果是：本发明提供了一种移动机器人定位准确度判断方法，步骤1，获取并处理二维栅格地图数据及地图坐标信息，得到相关地图数据用于后续计算；步骤2，获取激光雷达发送的一帧激光数据；步骤3，获取并处理里程计数据，得到激光发射时刻对应的里程计数据；步骤4，修正激光数据；步骤5，计算定位准确度，定位准确度计算精度较高；本发明通过里程计数据修正激光雷达传感器数据，计算修正后的数据与栅格地图数据的匹配情况，进而判断机器人定位准确度。该方法可以广泛适用于移动机器人领域。

附图说明

下面结合附图和实施例对本发明进一步说明。

图1是本发明的一种机器人定位准确度监测方法中的示意图；

图2是本发明的一种机器人定位准确度监测方法中的坐标系示意图；

图3是本发明的一种机器人定位准确度监测方法中的栅格地图示意图；

图4是本发明的定位准确度监测装置的结构示意图。

具体实施方式

现在结合附图对本发明作进一步详细的说明。这些附图均为简化的示意图，仅以示意方式说明本发明的基本结构，因此其仅显示与本发明有关的构成。

如图1-4所示，

第一方面，本发明提供一种移动机器人定位监测方法，

一种移动机器人定位监测方法，包括以下步骤：

步骤1，获取并处理二维栅格地图数据及地图坐标信息，得到相关地图数据用于后续计算；

步骤2，获取激光雷达发送的一帧激光数据；

步骤3，获取并处理里程计数据，得到激光发射时刻对应的里程

计数据；步骤4，修正激光数据；

步骤5，计算定位准确度。

o,x,y为地图坐标系即全局坐标系，该坐标系在加载地图的同时确立；d_o,d_x,d_y为里程计坐标系，里程计坐标系相对于全局坐标的变换随着里程计误差的变化而变化；b_o,b_x,b_y为机器人坐标系，机器人坐标系相对于全局坐标系的变换随着机器人的移动而变化；l_o,l_x,l_y为激光雷达坐标系。

步骤1中的栅格地图的坐标系即为全局坐标系，栅格单元的尺寸Sm/pix；栅格单元在x方向上的坐标为n_x×S(n_x为栅格单元在x方向上的序列),栅格单元在y方向的坐标n_y×S(n_y为栅格单元在y方向上的序列)；栅格单元的最近障碍物距离o_i，若该栅格单元被障碍物占据则o_i为0，否则o_i为该栅格单元与其相邻最近的障碍物栅格单元之间的距离。

步骤2中获取的激光数据包括：一帧激光的光束数量N；第一束激光发射的时间t_s，最后一束激光发射的时间t_e,相邻激光束的时间间隔Δt；相对于激光雷达坐标系，每一束激光光束的角度θ_i，每一束激光光束端点和激光雷达坐标系原点的距离l_i，i代表激光发射时间。

步骤3中的里程计数据发布频率，可以获取时刻里程计的位姿数据(机器人在里程计坐标系下的位姿)，其中t_f≤t_s，t_l≥t_e，Δt₁是里程计数据的时间间隔，通过拟合插值的方式，可以得到在激光光束发射时间{t_s,t_s+Δt,…,t_e}下的里程计位姿数据{pd_s,pd_s+Δt,…,pd_e}。

步骤4中修正激光数据的目的是将激光数据统一到里程计坐标系下，各时刻激光光束端点在激光雷达坐标下的坐标为(l_i×cosθ_i,l_i×sinθ_i)，经过坐标变换可以得到激光光束端点在里程计坐标系下的坐标(dx_i,dy_i)。

步骤5中的机器人位姿数据为全局坐标系下的位姿坐标(px,py,pθ)，px为机器人在x方向坐标,单位为米；px为机器人在y方向坐标,单位为米；pθ为机器人朝向与x方向的夹角，单位为弧度。此位姿数据是t_e时刻机器人的位姿数据。

步骤5还包括如下步骤：步骤5.1，获取定位信息，得到激光光束端点在全局坐标下的坐标；步骤5.2，计算激光数据中每一束激光的端点对应的栅格地图位置；步骤5.3，计算每一束激光与栅格地图的匹配情况；步骤5.4，整合每一束激光，计算定位准确度。

步骤5.1中的定位信息p_e，就是待判断的数据；定位信息是t_e时刻机器人在地图坐标系下的位姿数据；通过p_e及步骤3中的pd_e可以得到在t_e时刻里程计坐标系相对于全局坐标系的坐标变换；可以假设在t_s～t_e时刻下里程计坐标系相对于全局坐标系的坐标变换固定，从而将步骤4中的激光光束端点在里程计坐标系下的坐标转换为在全局坐标下的坐标(x_i,y_i)。

步骤5.2中，根据激光光束端点坐标，可以得到端点对应的栅格位置(nx_i,ny_i)，其中nx_i＝[x_i÷S]，ny_i＝[y_i÷S]。通过查表可以得到端点对应的最近障碍物距离o_i。

步骤5.3中，计算每一束激光的匹配度

其中α是高斯分布系数，例如α＝0.4，β是高斯分布方差，例如β＝0.05。o_i越小说明此激光光束与栅格地图的匹配度越高。

步骤5.4中定位准确度

即为所有激光光束匹配度的均值。

第二方面，本发明提供一种实现定位准确度监测的装置，

一种实现定位准确度监测的装置，采用上述监测方法，包括：地图模块，用于加载指定的栅格地图；激光雷达模块，用于生成激光扫描信息；里程计模块，用于生成里程计位姿数据；激光数据修正模块，结合里程计模块生成数据修正激光雷达模块生成数据；准确度计算模块，计算位姿数据与栅格地图数据、修正后的激光数据的匹配情况，生成定位准确度。此模块包括一个位姿接口，用于接收外部输入的位姿数据；准确度显示模块，用于显示定位准确度计算结果。

第三方面，本发明提供一种计算机设备，

一种计算机设备，采用上述监测方法，包括存储器和执行器，存储器存储有计算机程序，执行器执行计算机程序时实现上述定位准确度监测方法。

第四方面，本发明提供一种移动机器人定位监测方法，

一种存储介质，采用上述监测方法，其上存储有计算机程序，计算机程序被执行器执行时实现上述定位准确度监测方法。

以上述依据本发明的理想实施例为启示，通过上述的说明内容，相关工作人员完全可以在不偏离本项发明技术思想的范围内，进行多样的变更以及修改。本项发明的技术性范围并不局限于说明书上的内容，必须要根据权利要求范围来确定其技术性范围。