一种移动设备的定位误差修正方法技术

本发明专利技术公开了一种移动设备的定位误差修正方法。移动设备在移动过程中，实时采集所述移动设备周围的环境数据；对环境数据中的里程计数据进行第一处理获得运动状态信息并保存；对环境数据中的激光数据进行第二处理，获取新的点云数据、修正维度和误差修正系数并保存；对环境数据中的激光数据进行第三处理移动设备的物理运动量和筛选后的激光数据；根据筛选的激光数据、误差修正系数、修正维度和移动设备的物理运动量进行误差修正。本发明专利技术方法能够自适应的融合激光和里程计数据，充分考虑了环境分布情况对传感器的影响，提高移动设备的定位精度及鲁棒性，提升移动设备的智能化水平。提升移动设备的智能化水平。提升移动设备的智能化水平。

【技术实现步骤摘要】
一种移动设备的定位误差修正方法


[0001]本专利技术涉及移动机器人
的一种定位测量方法，尤其涉及一种机器人的定位误差修正方法。

技术介绍

[0002]近年来，随着科技水平不断提升，移动机器人技术已经广泛应用到日常生活的各个领域。基于激光雷达的移动机器人，越发受到人们的重视。
[0003]目前现有的移动机器人，经常需要进出各类复杂的环境；考虑到特定的工作场景，如空旷，长廊等不利因素，现有技术很难保证定位的鲁棒性。现有的部分移动设备，会在空旷场景或长廊，增加一些辅助定位的标签，但是这种方式需要对环境进行改造，不够鲁邦；另外一些会在进入特定区域，只使用里程计进行推算，但是这种方式需要太多的人工参与，不够智能；另外一些会增加相机等传感器，但是该方法会增加硬件成本，并且相机容易收到光线影响，使用感较差。
[0004]因此在长廊，空旷场景等环境下，依赖激光进行定位的移动机器人，会产生由于约束不足导致的退化问题，进而影响定位精度，现有技术缺少了一种机器人误差修正的方法来克服上述缺陷。

技术实现思路

[0005]为了解决
技术介绍
中存在的问题，本专利技术的目的在于提供一种移动机器人误差修正的方法，提高机器人在各种复杂场景的定位精度及鲁棒性，提升机器人的智能化水平。
[0006]为解决上述问题，本专利技术采用了以下技术方案：
[0007]移动设备在移动过程中，实时采集所述移动设备周围的环境数据；
[0008]对环境数据中的里程计数据进行第一处理获得移动设备的运动状态信息并保存；
[0009]对环境数据中的激光数据进行第二处理，获取新的点云数据、修正维度和误差修正系数并保存；
[0010]对环境数据中的激光数据进行第三处理移动设备的物理运动量和筛选后的激光数据；
[0011]根据筛选的激光数据、误差修正系数、修正维度和移动设备的实际物理运动量进行实时误差修正，从而进行定位误差修正。
[0012]所述的移动设备可以为机器人。
[0013]所述移动设备上装备有里程计、惯性测量单元(imu)、激光雷达等传感器。
[0014]所述移动设备周围的环境数据具体为移动设备所装配的传感器数据，包括里程计的里程计数据、惯性测量单元的imu数据和激光雷达的激光数据。
[0015]所述对采集的里程计数据进行第一处理获得运动状态信息并保存，具体包括：
[0016]以移动设备当前获取的环境数据中的里程计数据和imu数据计算移动设备的运动状态；所述移动设备的运动状态包括移动设备的位置、方向、速度、时间等。
[0017]保存移动设备的运动状态信息。
[0018]所述对采集的激光数据进行第二处理，获取新的点云数据、修正维度和误差修正系数并保存，具体包括：
[0019]S1、计算当前视野内激光数据的法向量；
[0020]S2、计算当前视野内激光数据的有效数据占有率；
[0021]S3、将当前视野内激光数据的法向量进行投影变换为另一坐标系的点云数据；
[0022]S4、对新坐标系下的点云数据，利用主成份分析法PCA计算特征值及特征向量；
[0023]S5、由特征值及特征向量确定误差修正对应的修正维度，回到步骤S3中处理获得新的点云数据；
[0024]S6、根据新的点云数据处理得到初步修正系数；
[0025]S7、根据初步修正系数结合有效数据占有率处理得到最终的误差修正系数；
[0026]S8、保存数据。
[0027]所述的激光数据为激光雷达采集的点云数据。
[0028]计算当前视野内激光数据的法向量，具体是针对点云数据中的每个点提取法向量，获得所有点的法向量。
[0029]所述S2计算当前视野内激光数据的有效数据占有率，具体包括：
[0030]由激光数据的所有法向量的数量、激光的视野角和角分辨率按照以下公式计算有效数据占有率k；
[0031][0032]其中，k
α
为有效数据占有率，N
normal
为法向量数量，r,R分别为角分辨率和视野角，N
line
为激光雷达线数。
[0033]所述S3将当前视野内激光数据的法向量进行投影变换为另一坐标系的点云数据，具体包括：
[0034]法向量是由多维向量构成，根据所有法向量构建多维空间坐标系；
[0035]每个法向量以自身向量方向确定在多维空间坐标系内的方位角；
[0036]以每个法向量在激光数据中对应的点根据在自身坐标系下的模长及上一步在多维空间坐标系内的方位角，确定投影后的坐标点；
[0037]最终由所有投影后的坐标点构成点云数据。
[0038]所述的多维空间坐标系为三维空间坐标系或者二维空间坐标系。
[0039]当多维空间坐标系为三维空间坐标系时，方位角包括法向量与x,y平面之间的夹角以及法向量投影到x,y平面后与y轴之间的夹角；并且按照以下公式确定投影后的坐标点：
[0040]x
coor
＝R
·
cos(ω)
·
sin(α)
[0041]y
coor
＝R
·
cos(ω)
·
cos(α)
[0042]z
coor
＝R
·
sin(ω)
[0043]其中，R为模长，ω为法向量与x,y平面之间的夹角，α为法向量投影到x,y平面后与y轴之间的夹角，x
coor
,y
coor
,z
coor
为投影后的坐标点。
[0044]当多维空间坐标系为二维空间坐标系时，方位角仅包括法向量与y轴之间的夹角；
并且按照以下公式确定投影后的坐标点：
[0045]x
coor
＝Rsin(α)
[0046]y
coor
＝Rcos(α)
[0047]其中，R为模长，α为法向量在坐标系下的角度，x
coor
,y
coor
为投影后的坐标点。
[0048]所述S5由特征值及特征向量确定误差修正对应的维度，回到步骤S3中处理获得新的点云数据，具体是以所有特征值中最大特征值对应方向作为x轴方向；并且以所有特征值中最小特征值对应方向作为误差修正对应的修正维度，当多维空间为三维时，作为z轴方向，当多维空间为二维时，作为y轴方向，以此回到步骤S3重新构建新的多维空间坐标系，并将所有法向量转换到新的多维空间坐标系下获得新的点云数据。
[0049]所述S6根据新的点云数据处理得到初步修正系数，具体是按照以下公式处理获得：
[0050][0051]其中，k
β
为修正系数，N为估计的点云数量，x,y,z为新的多维空间坐标系下新的点云数据的坐标，dim为对应数据的维度，当为三维数据时x
’...

【技术保护点】

【技术特征摘要】
1.一种移动设备的定位误差修正方法，其特征在于，所述方法包括：移动设备在移动过程中，实时采集所述移动设备周围的环境数据；对环境数据中的里程计数据进行第一处理获得运动状态信息并保存；对环境数据中的激光数据进行第二处理，获取新的点云数据、修正维度和误差修正系数并保存；对环境数据中的激光数据进行第三处理移动设备的物理运动量和筛选后的激光数据；根据筛选的激光数据、误差修正系数、修正维度和移动设备的物理运动量进行误差修正。2.根据权利要求1所述的一种移动设备的定位误差修正方法，其特征在于，所述移动设备周围的环境数据具体为移动设备所装配的传感器数据，包括里程计的里程计数据、惯性测量单元的imu数据和激光雷达的激光数据。3.根据权利要求1所述的一种移动设备的定位误差修正方法，其特征在于，所述对采集的里程计数据进行第一处理获得运动状态信息并保存，具体包括：以移动设备当前获取的环境数据中的里程计数据和imu数据计算移动设备的运动状态；保存移动设备的运动状态信息。4.根据权利要求1所述的一种移动设备的定位误差修正方法，其特征在于，所述对采集的激光数据进行第二处理，获取新的点云数据、修正维度和误差修正系数并保存，具体包括：S1、计算当前视野内激光数据的法向量；S2、计算当前视野内激光数据的有效数据占有率；S3、将当前视野内激光数据的法向量进行投影变换为另一坐标系的点云数据；S4、对新坐标系下的点云数据，利用主成份分析法PCA计算特征值及特征向量；S5、由特征值及特征向量确定误差修正对应的修正维度，回到步骤S3中处理获得新的点云数据；S6、根据新的点云数据处理得到初步修正系数；S7、根据初步修正系数结合有效数据占有率处理得到最终的误差修正系数；S8、保存数据。5.根据权利要求4所述的一种移动设备的定位误差修正方法，其特征在于，所述S2计算当前视野内激光数据的有效数据占有率，具体包括：由激光数据的所有法向量的数量、激光的视野角和角分辨率按照以下公式计算有效数据占有率k；其中，k
α
为有效数据占有率，N
normal
为法向量数量，r,R分别为角分辨率和视野角，N
line
为激光雷达线数。6.根据权利要求4所述的一种移动设备的定位误差修正方法，其特征在于，所述S3将当前视野内激光数据的法向量进行投影变换为另一坐标系的点云数据，具体包括：根据所有法向量构建多维空间坐标系；
每个法向量以自身向量方向确定在多维空间坐标系内的方位角；以每个法向量在激光数据中对应的点根据模长及上一步在多维空间坐标系内的方位角，确定投影后的坐标点；最终由所有投影后的坐标点构成点云数据。7.根据权利要求4所述的一种移动设备的定位误差修正方法，其特征在于，所述S5由特征值及特征向量确定误差修正对应的维度，回到步骤S3中处理获得新的点云数据，具体是以所有特征值中最大特征值对应方向作为x轴...

【专利技术属性】
技术研发人员：赵成伟，靳兴来，杨森，冯艳晓，朱世强，廖俊，
申请(专利权)人：杭州国辰机器人科技有限公司，
类型：发明
国别省市：