CN111862219B - 计算机设备定位方法、装置、计算机设备和存储介质 - Google Patents
计算机设备定位方法、装置、计算机设备和存储介质 Download PDFInfo
- Publication number
- CN111862219B CN111862219B CN202010747143.4A CN202010747143A CN111862219B CN 111862219 B CN111862219 B CN 111862219B CN 202010747143 A CN202010747143 A CN 202010747143A CN 111862219 B CN111862219 B CN 111862219B
- Authority
- CN
- China
- Prior art keywords
- data
- top view
- data set
- positioning
- local map
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
- G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
- G06T7/74—Determining position or orientation of objects or cameras using feature-based methods involving reference images or patches
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10028—Range image; Depth image; 3D point clouds
Landscapes
- Engineering & Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Instructional Devices (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种计算机设备定位方法、装置、计算机设备和存储介质,其中,该方法包括:获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集,其中,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据;根据所述定位数据集确定所述顶视数据集与局部地图的位姿变换;根据所述位姿变换将所述顶视数据集添加到所述局部地图;基于添加所述顶视数据集后的局部地图确定所述计算机设备在全局地图的定位。通过顶视传感器采集计算机设备所处建筑物内顶面的数据,降低环境变换对计算机设备定位功能的影响,提高计算机设备位置确定的准确性,可增强定位功能的鲁棒性。
Description
技术领域
本发明实施例涉及自动化控制技术领域,尤其涉及一种计算机设备定位方法、装置、计算机设备和存储介质。
背景技术
随着科技技术的不断发展,移动计算机设备逐渐出现在生活的方方面面,如,车站中的清洁机器人、商场中的导购机器人和餐厅中的送餐机器人等,为了实现在不同场景中的不同功能,首先要解决的就是计算机设备的定位问题,计算机设备需要通过所处的环境确定出自身的位置,从而根据用户预先设定或者即时下达的指令实现相应功能。
现有的技术中计算机设备使用相机和激光雷达采集数据并根据采集到的数据实现定位,然而相机和激光雷达等采集设备都是安装在计算机设备的前方,采集计算机设备前方环境的数据,数据存在局限只能反应某一时刻当前环境状态。现实中环境会随着时间变化,当环境参数发生改变时,容易导致计算机设备定位精确度下降,制约了计算机设备的应用场景。
发明内容
本发明提供一种计算机设备定位方法、装置、计算机设备和存储介质,以实现计算机设备的定位,通过计算机设备所处建筑物内顶面的数据,解决周围环境变化过大导致定位失效的问题,提高计算机设备定位的精确度。
第一方面,本发明实施例提供了一种计算机设备定位方法,该方法包括:
获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集,其中,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据;
根据所述定位数据集确定所述顶视数据集与局部地图的位姿变换;
根据所述位姿变换将所述顶视数据集添加到所述局部地图;
基于添加所述顶视数据集后的局部地图确定所述计算机设备在全局地图的定位。
第二方面,本发明实施例提供了一种计算机设备定位装置,该装置包括:
数据采集模块,用于获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集,其中,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据;
位姿确定模块,用于根据所述定位数据集确定所述顶视数据集与局部地图的位姿变换;
地图更新模块,用于根据所述位姿变换将所述顶视数据集添加到所述局部地图;
地图定位模块,用于基于添加所述顶视数据集后的局部地图确定所述计算机设备在全局地图的定位。
第三方面,本发明实施例提供了一种计算机设备,该计算机设备包括:
一个或多个处理器;
存储器,用于存储一个多个程序;
至少一个顶视传感器,用于获取顶视数据集,顶视数据集计算机设备所处建筑物的内顶面的数据;
至少一个定位装置,用于获取辅助计算机设备定位的定位数据集;
当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现如本发明实施例中任一所述的计算机设备定位方法。
第四方面,本发明实施例提供了一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如本发明实施例中任一所述的计算机设备定位方法。
本发明实施例,通过顶视传感器采集计算机设备所处建筑物内顶面的数据以及定位装置获取定位数据集,基于定位数据集确定顶视数据集与局部地图的位姿变换,将通过位姿变换转换后的顶视数据集添加到局部地图,通过局部地图与全局地图进行匹配以获取计算机设备的定位。通过采集计算机设备所处建筑物内顶面的数据,解决环境变化导致计算机设备定位失效的问题,实现了计算机设备的精确定位,增强计算机设备的鲁棒性。
附图说明
图1是现有技术中计算机设备数据获取的示例图;
图2是本发明实施例提供的一种数据获取的示例图;
图3是本发明实施例一提供的一种计算机设备定位方法的流程图;
图4是本发明实施例一提供的顶视传感器的数据获取角度的示意图;
图5是本发明实施例二提供的一种计算机设备定位方法的流程图;
图6是本发明实施例三提供的一种计算机设备定位方法的流程图;
图7是本发明实施例三提供的一种计算机设备位姿示例图;
图8是本发明实施例三提供的一种计算机设备地图构建和定位的示例图;
图9是本发明实施例四提供的一种计算机设备定位装置的结构示意图;
图10是本发明实施例五提供的一种计算机设备的结构示意图;
图11是本发明实施例五提供的一种计算机设备的示例图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构,此外,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
图1是现有技术中计算机设备数据获取的示例图,参见图1,现有技术采集物体的传感器2常设置在计算机设备1的前方,通过传感器2采集计算机设备1前方对象3的数据,由于在现实生活中,对象3放置在地面上可以随着时间变化而更改位置,因此对象3的数据只能在一段时间内具有准确性,甚至当对象3具体为人时,会随时发生位置改变,计算机设备1采集到的数据无法用于计算机设备定位。而参见图2,本申请实施例提供的采集数据的传感器20设置在计算机设备10的顶部,在实际环境中,在计算机设备所处建筑物内顶面上的物体,例如,天花板、灯具和装饰物等物品常处于固定状态,短时间内不会发生较大的改变,本申请通过设置在计算机设备10顶部的传感器20在计算机设备所处的建筑物内顶面上的采集对象30的数据,降低对象30位置改变的机率,减少动态物体对定位的影响,从而提高定位的准确性,增强在商场和超市等场景的定位效果。
实施例一
图3是本发明实施例一提供的一种计算机设备定位方法的流程图,本发明实施例可以适用于计算机设备定位的情况,该方法可以由计算机设备定位装置来执行,该装置可以采用硬件和/或软件的方式来实现,参见图3,本发明实施例的方法具体包括如下步骤:
步骤101、获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集,其中,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据。
其中,顶视传感器可以是采集计算机设备所处环境的传感器,顶视传感器的数据采集方向可以为计算机设备所处的建筑物的顶部方向,顶视数据集可以由顶视传感器采集的数据组成,该数据的数据来源为计算机设备所处建筑物的内顶面,可以包括天花板、吊灯、空调口或者装饰物等,进一步的,顶视传感器采集到的数据可以具体为轮廓数据、深度数据和纹理数据中至少一种。定位装置可以是获取计算机设备位置信息的装置,可以将定位装置采集到的位置信息存储为定位数据集,定位装置可以包括轮式编码器、基站定位、卫星导航和惯性导航等。
具体的,计算机设备在运动过程中可以使用顶视传感器和定位装置获取顶视数据集和定位数据集,计算机设备每隔一段时间可以通过顶视传感器采集计算机设备所处建筑物的内顶面的数据,将将该数据组成顶视数据集。相应的,计算机设备也可以每隔一段时间通过定位装置获取计算机设备的位置信息,可以将该位置信息存储为定位数据集,可以理解的是,顶视传感器和定位装置的数据采集时间不同,例如,计算机设备可以每隔一秒使用顶视传感器测取建筑物的内顶面的数据,而定位装置可以在计算机设备运动过程中持续获取数据,当定位装置为5G通信芯片时,计算机设备在移动过程中不断接受5G基站发送的信令,可以将信令中的位置信息存储为定位数据集。
步骤102、根据所述定位数据集确定所述顶视数据集与局部地图的位姿变换。
其中,位姿变换可以是从一个坐标系转换到另一个坐标系需要的参数,可以表示不同坐标系之间的相对位置关系,包括位置变化量和姿态变换量,位姿变换具体可以表示顶视数据集中数据从计算机设备所处的坐标系转换到地图坐标系所处的坐标系需要的位置变化量和姿态变化量。局部地图可以是最近一段时间内获取到的数据,例如,可以使用顶视传感器最近采集的连续N帧点云数据构成局部地图,局部地图中数据可以处于相同坐标系,建立局部地图时,,局部地图中的数据可以具体为三维深度数据或者三维点云数据。
在本发明实施例中,为了将采集到的顶视数据集添加到局部地图中,定位数据集可以是计算机设备移动产生的数据,可以确定出计算机设备的位置变化量和姿态变化量,可以将获取到的位置变化量和姿态变化量作为计算机设备在数据采集对应时间段的位姿变换。
步骤103、根据所述位姿变换将所述顶视数据集添加到所述局部地图。
在本发明实施例中,可以通过位姿变换将顶视数据集内数据对应的坐标系同步到局部地图对应的坐标系下,然后将变换后的顶视数据集添加到局部地图中。
步骤104、基于添加所述顶视数据集后的局部地图确定所述计算机设备在全局地图的定位。
其中,全局地图可以是反应出计算机设备所处环境的环境数据,局地图可以是三维深度数据或者三维点云数据,全局地图的建立可以早于计算机设备定位,例如,可以控制计算机设备在当前环境中行走一圈或者多圈,通过传感器获取当前环境中的环境数据,通过将环境数据拼接生成。
具体的,可以通过局部地图在全局地图进行匹配,可以将全局地图中匹配程度最好的环境数据对应的位置作为计算机设备所处位置,由于建筑物内顶面的数据的差别较小,可以通过局部地图匹配的方式增强计算机设备所处位置的特征,通过将局部地图中与全局地图的匹配提高计算机设备定位的准确度。匹配的方式可以包括:将局部地图与全局地图中各位置对应的环境数据进行匹配或者将局部地图与全局地图中不同帧的环境数据进行匹配。
本发明实施例,通过分别获取计算机设备顶视传感器和定位装置的顶视数据集和定位数据集,其中顶视数据集包括计算机设备所处建筑物内顶面的数据,基于定位数据集确定出顶视数据集与局部地图的位姿变换,通过位姿变换更改顶视数据集的坐标系后添加到局部地图,根据局部地图在全局地图进行匹配以确定计算机设备的位置,解决环境变化导致定位失效的问题,实现计算机设备的准确定位,增强计算机设备定位功能的鲁棒性。
进一步的,在上述发明实施例的基础上,所述顶视传感器设置于计算机设备顶部,所述顶视数据集内数据的采集方向包括水平夹角30度到150度范围,所述数据构成物体轮廓、物体深度和物体纹路中至少一种。
在本发明实施例中,顶视传感器设置在计算机设备的顶部,通过顶视传感器监测计算机设备所处建筑物内顶面,顶视传感器的采集方向可以位于计算机设备水平方向夹角30度到150度的范围内。图4是本发明实施例一提供的顶视传感器的数据获取角度的示意图,参见图4,顶视传感器20设置于计算机设备10的顶部,顶视传感器20的数据采集视野范围可以为与水平夹角可以为30度到150度,包括30度和150度,顶视传感器20可在[30,150]的范围任意选择角度以测取建筑物的内顶面的数据,当顶视传感器获取数据的方向与水平夹角不在该范围内时,由于计算机设备的高度问题,顶视传感器的数据采集范围可能被周围地面上的物体遮挡,导致无法准确监测到建筑物的内顶面的数据。进一步的,为了提高数据的准确度,顶视传感器可以在与水平夹角90度的方向上获取采集建筑物内顶面的数据。可以理解的是,采集到的数据可以是建筑物的内顶面的轮廓数据、深度数据或者纹理数据等,基于顶视传感器的种类不同,可以采集到不同种类的数据。
进一步的,在上述发明实施例的基础上,所述顶视传感器的数据采集视野被障碍物遮挡时,改变所述顶视传感器的方向以使所述顶视传感器的数据采集视野不被所述障碍物遮挡,其中,所述障碍物位于所述计算机设备与所述内顶面之间。
其中,数据采集视野可以是顶视传感器采集数据的范围,数据采集视野可以由顶视传感器的种类和设置位置决定。障碍物可以是计算机设备与计算机设备所处建筑物内顶面之间的物体,能够妨碍顶视传感器采集内顶面数据。
在本发明实施例中,顶视传感器与计算机设备之间可以设置有运动装置,当检测到顶视传感器的数据采集视野被障碍物遮挡时,可以控制运动装置改变顶视传感器的安装角度和安装位置等,减少或者避免障碍物对顶视传感器数据采集视野的影响。
实施例二
图5是本发明实施例二提供的一种计算机设备定位方法的流程图,对上述发明实施例进行了具体化,通过顶视数据集确定时间差,并确定出定位数据集在该时间差内的初始位姿,实现顶视数据集与局部地图的位姿变换,参见图5,本发明实施例提供的计算机设备定位方法包括如下步骤:
步骤201、对齐顶视传感器和定位装置的时间戳。
在本发明实施例中,时间戳可以是产生和管理顶视传感器和定位装置时间信息的软件和/或硬件装置,可以通过同步顶视传感器和定位装置的计时器的方式实现时间戳的对齐,使得顶视传感器的时间信息与定位装置的时间信息相同,提高顶视数据集与定位数据集时间的一致性,可提高数据精度,增强计算机设备定位的准确性。
步骤202、获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集。
步骤203、基于统计滤波器去除顶视数据集中的噪声数据;滤除所述顶视数据集中不属于建筑物的内顶面的数据。
其中,噪声数据可以是由于顶视传感器的硬件误差造成的错误数据,统计滤波器可以是清洗顶视数据集的数据处理装置,可以按照预设规则对测距数据进行清洗。
具体的,确定顶视传感器对应的数据与其他数据的位置坐标的平均距离,各平均距离符合高斯分布的规律,可以通过统计滤波器可以确定每一个数据与其他数据的平均距离,并确定出各平均距离的标准差σ和均值μ,由于平均距离符合高斯分布的规律,当一个数据与其他数据的平均距离不在[-3σ+μ,+3σ+μ]的范围内时,可以认为该数据为噪声数据,并将该数据从顶视数据集中删除。
在本发明实施例中,顶视传感器获取到建筑物内顶面的数据时,计算机可能采集到前方墙壁的数据,将该数据误判为建筑物内顶面数据,需要将该数据从顶视数据集清除。可以通过对数据对应的位置进行判断,确定该位置不属于建筑物内顶面时,可以将对应的数据从顶视数据集清除,例如,可以将顶视数据集内的数据分别与阈值高度进行比较,当确定数据对应的高度小于该阈值高度时,可以将该数据从顶视数据集中删除,通过对顶视数据集内数据的清洗,提高数据的准确性,可以进一步提高计算机设备定位的准确性。
步骤204、确定顶视数据集中数据对应的时间戳时间。
其中,时间戳时间可以表示各数据的获取时间,时间戳时间可以与顶视数据集中的数据关联存储。
具体的,可以在顶视数据集中查找各数据对应的时间戳时间。
步骤205、根据时间戳时间查找定位数据集的定位数据,并根据定位数据确定初始位姿变换。
其中,初始位姿变换可以是通过定位数据确定出的计算机设备位置变化量和姿态变换量。
具体的,由于顶视传感器和定位装置的时间戳对齐,则定位数据集中时间戳与顶视传感器的时间戳处于同步状态,在相同时间戳时间下定位数据集中的定位数据与顶视数据集中的数据对应的计算机设备姿态相同。通过时间戳时间查找定位数据集中的定位数据,可以将获取到的定位数据作为计算机设备平面位姿,通过各时间戳时间对应的时间差确定出对应的计算机设备位姿的位置和姿态的变化量作为初始位姿变换,可以用于确定顶视数据集与局部地图的位置和姿态的变化量。示例性的,从顶视数据集确定出的时间戳时间为t0和t1,根据t0和t1在定位数据集中查找这个两个时间戳时间范围内的定位数据T1,T2,T3,其中,t0时戳时间对应的定位数据为T1,t1时间戳对应的定位数据为T3,则t0到t1时刻计算机设备的初始位姿变换可以为T1*T3。
步骤206、通过初始位姿变换转换顶视数据集,并确定顶视数据集与局部地图的匹配率。
其中,匹配率可以是顶视数据集与局部地图中内数据的匹配程度,匹配率越高,则顶视数据集在局部地图对应位置的可能性越高。
在本发明实施例中,可以将通过定位数据确定出的初始位姿变换作为对顶视数据集进行坐标系转换的参数,将顶视数据集中的数据的坐标系转换到局部地图对应的坐标系,例如,若初始位姿变换为转换矩阵时,可以将数据的坐标与初始位姿变换的乘法运算结果作为位姿转换后的数据的坐标。
具体的,在对顶视数据集中各数据进行位姿转换后,可以确定出顶视数据集与局部地图的匹配率,可以理解的是,局部地图中包括有多个数据,可以将局部地图中的数据与测试数据集中的数据进行匹配,获取到对应的匹配率。当局部地图可以由多帧地图数据组成,一帧地图数据可以对应计算机设备所处环境中不同位姿,一帧地图数据可以包括一个或多个数据,可以将顶视数据集分别与局部地图中各帧地图数据进行匹配,确定出顶视数据集与各帧地图数据的匹配率。确定匹配率的方式可以包括提取顶视数据集中数据的特征值,通过特征值进行匹配。
步骤207、根据数值最大的匹配率选择数据以确定位姿变换。
具体的,可以在确定出的匹配率中选择数值最大的匹配率,由于匹配率由顶视数据集与局部地图匹配生成,可以确定出顶视数据集与局部地图中参与匹配的数据,可以通过比较两组数据确定出位置和姿态的变化量,可以将该变化量作为位姿变换。
步骤208、根据位姿变换将顶视数据集添加到局部地图。
在本发明实施例中,可以通过位姿变换更新顶视数据集内各数据的坐标系,从顶视数据集对应的坐标系转化到局部地图对应的坐标系,可以将顶视数据集内变换后的数据添加到局部地图中,可以将顶视数据集内的数据作为一帧地图数据添加到局部地图中,也可以将顶视数据集内的数据根据位置添加到局部地图中相应位置。
步骤209、基于添加顶视数据集后的局部地图确定计算机设备在全局地图的定位。
本发明实施例,通过对齐顶视传感器和定位装置的时间戳,获取顶视数据集和定位数据集,使用统计滤波器滤除顶视数据集中的噪声数据并清除其中不属于建筑物内顶面的数据,确定各数据的时间戳时间,通过时间戳时间查找定位数据集中的定位数据,并通过定位数据的位置和姿态的变化量确定出初始位姿变换,确定初始位姿变换改变后的顶视数据集与局部地图的匹配率,通过数值最大的匹配率确定顶视数据集与局部地图的位姿变换,根据该位姿变换更改顶视数据集后添加到局部地图,通过局部地图在全局地图中确定出计算机设备的定位,实现了计算机设备定位功能,通过采集建筑物内顶面的数据减少环境变化对计算机设备定位的影响,防止计算机设备定位失效,增强计算机设备定位功能的鲁棒性。
实施例三
图6是本发明实施例三提供的一种计算机设备定位方法的流程图,对上述发明实施例进行了具体化,参见图6,本发明实施例提供的计算机设备定位方法包括如下步骤:
步骤301、获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集,其中,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据。
步骤302、基于统计滤波器去除顶视数据集中的噪声数据。
步骤303、将顶视数据集中的数据投射到平面栅格坐标系,并获取数据在平面栅格坐标系中的栅格坐标和高度投影,其中,平面栅格坐标系以顶视传感器为原点。
其中,平面栅格坐标系可以是将平面划分为若干栅格的坐标系,该平面栅格坐标系可以将顶视传感器作为原点,平面栅格坐标系所在的平面可以是顶视传感器所在的水平面,平面栅格坐标系中栅格的大小可以预设设置,例如,栅格的长和宽可以分别设置为5厘米。栅格坐标可以是数据在顶视传感器所在水平面上的横纵坐标,高度投影可以是数据所在平面到平面栅格坐标系原点所在平面的高度。
在本发明实施例中,可以将顶视数据集中的数据投影到平面栅格坐标系中,根据数据的横坐标和纵坐标作为平面栅格坐标系中的栅格坐标,并将数据的竖坐标作为高度投影。可以理解的是,平面栅格坐标系所在的平面不限制于水平面,可以是在空间内经过顶视传感器的任意一个平面,相应的高度投影可以是数据到该平面的距离。
步骤304、按照栅格坐标统计属于相同栅格的数据对应高度投影的最大值和最小值。
在本发明实施例,可以确定顶视数据集中的数据的栅格坐标,根据栅格坐标确定数据在平面栅格坐标系中对应的栅格,统计每个栅格中数据的高度投影的最大值和最小值。例如,数据的坐标为(X,Y,Z),按照X-Y平面投影后,统计平面栅格坐标系中不同栅格的Z值,在每个栅格内确定Z值的最大值和最小值。可以理解的是,由于投影平面的不同,高度投影可以是数据坐标中的X值,也可以是数据坐标中的Y值。
步骤305、确定最大值与最小值的差大于阈值时,将属于所述栅格的数据从顶视数据集中删除。
其中,阈值可以是预先设置的数值,该阈值可以判断数据是否属于建筑物的内顶面,阈值可以设定为0.5。
在本发明实施例中,平面栅格坐标系每个栅格可以确定最大值和最小值之间的差值,可以将获取到的差值与阈值进行比较,若最大值与最小值的差值大于阈值,确定该数据为非建筑物内顶面的数据,则将该栅格内的数据从顶视数据集中删除。
步骤306、确定顶视数据集中数据对应的时间戳时间。
步骤307、根据时间戳时间查找定位数据集的定位数据,并根据所述定位数据确定初始位姿变换。
步骤308、通过所述初始位姿变换转换所述顶视数据集,将所述顶视数据集的数据投射到局部地图所处的平面栅格坐标系。
其中,初始位姿变换可以是将顶视数据集转换到局部地图所处坐标系的位姿变换。
具体的,可以先通过初始位姿转换对顶视数据集中的数据进行变换,例如,可以将数据的坐标与初始位姿转换的乘积作为转换后的坐标。可以将顶视数据集中的数据投射到局部地图所处的平面栅格坐标系,每个数据根据其横纵坐标投射到平面栅格坐标系中一个栅格,并将数据的竖坐标作为高度投影关联存储到该栅格。
步骤309、针对平面栅格坐标系的栅格,通过预设公式在高斯分布上确定各数据对应高度投影与栅格内局部地图对应的高度值匹配的概率,将各概率之和作为顶视数据集与局部地图的匹配率。
在本发明实施例中,局部地图可以由数据构成,在局部地图所处的平面栅格坐标系中,按照横纵坐标将构成局部地图的数据投射到栅格内,并将该数据的竖坐标作为高度投影存储到对应栅格。各栅格内的高度投影符合高斯分布,可以将顶视数据集中各数据与所属栅格内高度投影在高斯分布上匹配的概率值,可以将落在相同栅格内的数据的概率值之和,作为顶视数据集与局部地图的匹配率。可以理解的是,当顶视数据集数据落在多个栅格内时,顶视数据集与局部地图的匹配率可以存在多个。
具体的,针对各栅格计算当前栅格内顶视数据集的数据的高度投影与所在栅格内局部地图的高度值匹配的概率值,可以将相同栅格内各数据对应的概率值之和作为顶视数据集与局部地图的匹配率。匹配率可以通过公式确定,其中,Score表示匹配率,k表示顶视数据集内数据落在栅格内的数量,hi表示经过初始位姿变换转换后的各数据的高度投影,μ和σ表示局部地图的高度值符合的高斯分布参数,μ可以表示局部地图内数据的高度值的均值,σ可以表示局部地图内数据的高度的标准差。
步骤310、根据数值最大的匹配率选择数据以确定位姿变换。
步骤311、基于预设代价公式对位姿变换进行非线性优化,其中,所述预设代价公式包括:e表示代价,n表示顶视数据集中数据的数量,μ和δ表示局部地图内数据的高度值符合的高斯分布参数,hi表示经过初始位姿变换转换后的数据的高度值,T′表示初始位姿变换,T表示位姿变换,ω表示定位装置的误差影响。
在本发明实施例中,为了进一步提高定位的准确性,可以在确定顶视数据集与局部地图的位姿变换后,可以对位姿变换进行非线性优化,可以将获取到的初始位姿变换、位姿变换、误差影响、局部地图内数据的高度值对应的均值以及局部地图内数据的高度值对应的标准差等数据代入到预设代价公式,然后通过迭代的方式调整位姿变换,使得预设代价公式生成的代价最小,可以将预设代价公式对应的代价最小时的位姿变换作为非线性优化后的位姿变换。预设代价公式具体可以是其中e表示代价,n表示顶视数据集中数据的数量,μ和σ表示局部地图内数据对应高度值符合的高斯分布参数,hi表示经过初始位姿变换转换后的数据的高度投影,T′表示初始位姿变换,T表示位姿变换,ω表示定位装置的误差影响。表示二维平面上的乘法运算,具体计算过程可以为
步骤312、通过位姿变换将顶视数据集的数据转换到与局部地图相同的坐标系。
在本发明实施例中,由于顶视数据集中的数据对应的坐标系是以顶视传感器为原点的坐标系,可以使用非线性优化后的位姿变换对顶视数据集中的数据进行处理,例如,将数据的坐标与位姿变换作乘法运算,将顶视数据集转换到与局部地图相同坐标系。
步骤313、基于栅格坐标,将转换后的数据中的高度投影作为高度值更新到所述局部地图。
在本发明实施例中,获取转换后数据的横坐标和纵坐标作为栅格坐标,确定各栅格坐标在局部地图对应的平面栅格坐标系中栅格,并将转换后的数据的竖坐标作为局部地图的高度值填充到对应栅格中。
步骤314、确定局部地图与全局地图的地图位姿变换;根据地图位姿变换确定计算机设备在全局地图的定位。
其中,地图位姿变换可以是局部地图转换到全局地图的方向变换参数,可以表示局部地图与全局地图坐标系之间的相对位置关系。
在本发明实施例中,由于局部地图和全局地图的坐标系可以不同,因此需要确定出局部地图与全局地图之间的地图位置变换,可以将局部地图中的数据与全局地图中的数据进行匹配确定出对应的匹配率,可以选择其中匹配率最高的数据作为数据与全局地图的地图位置变换,通过该地图位置变换转换局部地图后,确定出局部地图在全局地图中位置,也就是计算机设备在全局地图中的位置。
示例性的,可以将局部地图中的数据投影到全局地图所处的平面栅格坐标系,利用每个数据的横纵坐标确定所在的栅格,并将数据的竖轴坐标作为高度值在全局地图范围内搜索匹配率,其中,匹配率的计算公式可以是Score表示匹配率,k表示落在栅格内局部地图数据的数量,hi表示经过初始位姿变换转换后的数据的高度值,μ和σ表示全局地图的高度值符合的高斯分布参数,μ可以表示全局地图内测距数据的高度值的均值,σ可以表示全局地图内测距数据的高度值的标准差。
本发明实施例,通过获取计算机设备顶视传感器和定位装置的顶视数据集和定位数据集,基于统计滤波器去除顶视数据集中的噪声数据,通过顶视数据集在平面栅格坐标系的高度投影确定在相同栅格内的最大差值和最小差值,若栅格内最大差值与最小差值的差大于阈值,可以将该栅格内的数据从顶视数据集中删除,确定顶视数据集各数据的时间戳时间,根据时间戳戳时间查找定位数据中定位数据,根据定位数据确定出初始位姿变换,将初始位姿变换后对局部地图匹配获取到匹配率,将匹配率数值最大的数据作为对应的位姿变换,并根据预设代价公式对位姿变换进行非线性优化,通过位姿变换将顶视数据集转换到局部地图,然后顶视数据集添加到局部地图,有局部地图与全局地图的匹配确定出计算机设备的位置,解决了环境变化导致计算机设备环境变化容易导致定位失效的问题,增强了计算机设备定位功能的鲁棒性,提高计算机设备定位的准确性。
进一步的,在上述发明实施例的基础上,还包括:确定所述计算机设备处于建图模式,则根据地图位姿变换转换所述局部地图;将转换后的局部地图存储到所述全局地图。
其中,建图模式可以是计算机设备建立全局地图的模式,建图模式中计算机设备可以识别周围环境并存储相关的数据,建图模式可以是在计算机设备启动时选择。
在本发明实施例中,当计算机设备处于建图模式时,可以根据地图位姿将局部地图转换到全局地图的坐标系下,将转换后的局部地图存储到全局地图。
示例性的,局部地图到全局地图的位姿变换为TG L,上标G表示全局地图坐标系,下标L表示局部地图坐标系,局部地图中任意一个数据可以表示为pL i,上标L表示局部坐标系,下标i表示局部地图中每个点的序列号,局部地图的数据转换到全局地图的过程可以表示为可以将转换后的数据确定在全局地图内的栅格坐标确定全局地图的平面栅格坐标系中的栅格,根据数据的高度投影更新对应栅格的高度分布。
进一步的,在上述发明实施例的基础上,所述顶视传感器包括激光雷达传感器、视觉传感器和红外传感器中至少一种,所述定位装置包括轮式编码器、基站定位、惯性导航和卫星导航中至少一种。
在本发明实施例中,顶视传感器可以为激光雷达传感器,其中,激光雷达传感器获取到的数据可以是激光点云数据,具体的,激光打到建筑物的内顶面上物体产生激光点,将各激光点在三维空间内的坐标存储到顶视数据集。通过各激光点与计算机设备之间的相对位置关系,可以反应出计算机设备的位置和姿态。图7是本发明实施例三提供的一种计算机设备位姿示例图,参见图7,位姿可以包括航向角、俯仰角和翻滚角。而定位装置可以是轮式编码器,可以设置在计算机设备的主传动轴,计算机设备运动时轮式编码器可以记录速度和位移等数据从而反应出计算机设备的运动状况。顶视传感器还可以是视觉传感器和红外传感器,相应的,顶视数据集可以是采集计算机设备所处建筑物的内顶面的图像数据和红外数据等。而定位装置还可以包括基站定位、惯性导航和卫星导航中的一种或者多种,对计算机设备的移动轨迹进行监测。
在一个示例性的实施方式中,图8是本发明实施例三提供的一种计算机设备地图构建和定位的示例图,本发明实施例中使用轮式编码器作为定位装置,以及激光雷达传感器作为顶视传感器。参见图8,本发明实施例示出的方法包括如下步骤:
步骤S1:在机器人顶部安装顶视传感器在机器人驱动轮的轮轴上安装轮式编码器,在机器人运动过程中采集激光数据。其中,顶视传感器安装在机器人的顶部,并且顶视传感器的数据采集方向与水平方向的夹角范围为[30°,50°],当顶视传感器设置的数据采集方向与水平方向夹角为90°时,可以完全避免周围物体对测距传感影响。可以将各传感器采集到的数据的时间戳对齐。
步骤S2:顶视传感器采集到的激光数据进行预处理。
进一步的,步骤S2还可以包括以下步骤:
步骤S21,使用统计滤波器,对激光数据进行噪点去除,去除与其他激光数据之间平均距离落在[-3σ+μ,+3σ+μ]之外的激光数据,其中,σ和μ分别是激光数据之平均距离的标准差和均值。
步骤S22:去除激光数据中落在竖直墙面上的数据,仅保留落在天花板不同平面上的激光数据。其中,步骤S22具体通过如下步骤实现:
以顶视传感器为原点建立平面栅格坐标系,将激光数据转换到笛卡尔坐标系下,并将激光数据安装X-Y投影到建立的平面栅格坐标系中,记录每个栅格中激光数据的坐标。遍历每个栅格,记录每个栅格内激光数据的竖坐标Z值的最大值和最小值的,当栅格中最大值与最小值的差大于阈值时,该栅格内的激光数据是落在竖直墙面上的激光点,将该栅格对应的激光数据丢弃。阈值一般可以取0.5。
步骤S3:计算采集到的激光数据与预设的局部地图之间的位姿变换。
其中,步骤S3还可以包括如下步骤:
步骤S31:利用对齐时间戳后的激光数据和编码器数据,计算顶视传感器当前时刻获取到的激光数据与顶视传感器获取到的上一帧激光数据之间的时间差,利用该时间差从编码器中获取到在该时间差内机器人运动的位姿变换。
例如,从编码器中获取的编码器数据记为(t0,T0),(t1,T1),....,(tn,Tn)其中,t表示获取到编码器数据时的时间戳。T表示在t时刻获取到的编码器数据,下标0、1、n表示编码器数据的获取顺序。顶视传感器的时间差的开始时间为k-1,顶视传感器的时间差的结束时间为k,则位姿变换为Tk-1*Tk。
步骤S32:利用步骤S31步骤中获取到的位姿变换当作激光数据与局部地图进行匹配的初始,可以将激光数据以X-Y平面投影到局部地图所在的平面栅格坐标系,确定各激光数据对应的栅格,通过激光数据的竖坐标Z值与栅格内局部地图的测距数据进行匹配,在相同栅格内竖坐标Z值服从高斯分布,根据Z值计算激光数据与局部地图的匹配率,将匹配率最高的激光数据对应的位姿作为激光数据与局部地图之间的位姿变换,匹配率的计算公式可以如下:
其中Score表示匹配率,k表示落在栅格内激光数据的数量,hi表示经过初始位姿变换转换后的激光数据的高度投影,μ和σ表示栅格内局部地图的高度值符合的高斯分布参数,μ可以表示局部地图内测距数据的高度值的均值,σ可以表示局部地图内测距数据的高度的标准差。
步骤S33,在步骤S32确定出位姿变换后,还可以通过代价公式对该位姿变换进行非线性优化,代价公式可以如下所示:
其中,e表示代价,n表示顶视数据集中数据的数量,μ和σ表示局部地图的高度值符合的高斯分布参数,hi表示经过初始位姿变换转换后的数据的高度投影,T′表示步骤S3中通过编码器数据确定出的位姿变换,T表示位姿变换,ω表示定位装置的误差影响。通过调整位姿变换T的取值迭代计算代价公式,使得代价e的结果最小,当代价e的结果最小时,对应的位姿变换T可以是经过非线性优化的结果值。
步骤S4:利用步骤S3得到的位姿变换,将激光数据添加到局部地图中。
进一步的,步骤S4具体包括如下步骤:利用步骤S3得到位姿,将激光数据转换到局部地图对应的坐标系,利用激光数据在局部地图坐标下的坐标参数确定在X-Y平面的投影,并确定各激光数据对应的栅格,使用坐标参数中的Z值更新对应栅格内的高度分布。
步骤S5:利用添加激光数据后的局部地图与预先生成的全局地图进行匹配,确定局部地图与全局地图之间的位姿变换。
进一步的,步骤S5具体包括以下步骤:将局部地图中中所有激光数据的坐标按照X-Y平面进行投影,确定每个激光数据在X-Y平面中的对应的栅格,利用坐标中Z值与全局地图中的该栅格的Z值进行匹配,确定对应的匹配率,匹配率的计算公式如下:
其中,Score表示匹配率,k表示落在栅格内局部地图激光数据的数量,hi表示经过初始位姿变换转换后的激光数据的高度值,μ和σ表示全局地图的高度值符合的高斯分布参数,μ可以表示全局地图内数据的高度值的均值,σ可以表示全局地图内数据的高度值的标准差。
步骤S6:确定机器人是否处于建图模式,若是则继续执行步骤S7,若否,则将全局地图中匹配率最高的位置作为机器人定位确定位置。
步骤S7:将步骤S5中最高匹配率对应的位姿,将局部地图中激光数据添加到全局地图。
在上述发明实施例的基础上,局部地图到全局地图的位姿确定为TG L,上标G表示全局地图坐标系,下标L表示局部地图坐标系,局部地图中任意一个激光数据可以表示为pL i,上标L表示局部坐标系,下标i表示局部地图中每个点的序列号,局部地图的数据转换到全局地图的过程可以表示为可以将转换后的数据确定在全局地图内的栅格坐标确定全局地图的平面栅格坐标系中的栅格,根据数据的高度投影更新对应栅格的高度分布。
实施例四
图9是本发明实施例四提供的一种计算机设备定位装置的结构示意图,图9中示出的装置可以执行本发明任意实施例所提供的计算机设备定位方法,具备执行方法相应的功能模块和有益效果。该装置可以由软件和/或硬件实现,具体包括:数据采集模块410、位姿确定模块420、地图更新模块430和地图定位模块440.
其中,数据采集模块410,用于获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集,其中,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据。
位姿确定模块420,用于根据所述定位数据集确定所述顶视数据集与局部地图的位姿变换。
地图更新模块430,用于根据所述位姿变换将所述顶视数据集添加到所述局部地图。
地图定位模块440,用于基于添加所述顶视数据集后的局部地图确定所述计算机设备在全局地图的定位。
本发明实施例,通过数据采集模块分别获取计算机设备顶视传感器和定位装置的顶视数据集和定位数据集,其中顶视数据集包括建筑物内顶面的数据,位姿确定模块基于定位数据集确定出顶视数据集与局部地图的位姿变换,地图更新模块通过位姿变换更改顶视数据集的坐标系后添加到局部地图,地图定位模块根据局部地图在全局地图进行匹配以确定计算机设备的位置,解决了由于计算机设备所处环境变化导致定位失效的问题,实现了计算机设备定位的准确性,增强计算机设备定位功能的鲁棒性。
进一步的,在上述发明实施例的基础上,还包括:
时间戳对齐模块,用于对齐所述顶视传感器和定位装置的时间戳。
进一步的,在上述发明实施例的基础上,还包括:
噪声去除模块,用于基于统计滤波器去除所述顶视数据集中的噪声数据。
距离数据清洗模块,用于滤除所述顶视数据集中不属于建筑物的内顶面的数据。
进一步的,在上述发明实施例的基础上,距离数据清洗模块具体用于:将所述顶视数据集中的数据投射到平面栅格坐标系,并获取所述数据在所述平面栅格坐标系中的栅格坐标和高度投影,其中,所述平面栅格坐标系以所述顶视传感器为原点;按照所述栅格坐标统计属于相同栅格的数据对应高度投影的最大值和最小值;确定所述最大值与所述最小值的差大于阈值时,将属于所述栅格的从所述顶视数据集中删除。
进一步的,在上述发明实施例的基础上,位姿确定模块420包括:
时间确定单元,用于确定所述顶视数据集中数据对应的时间戳时间。
初始位姿单元,用于根据所述时间戳时间查找所述定位数据集的定位数据,并根据所述定位数据确定初始位姿变换。
匹配处理单元,用于通过所述初始位姿变换转换所述顶视数据集,并确定顶视数据集与局部地图的匹配率。
位姿确定单元,用于根据数值最大的匹配率选择数据以确定位姿变换。
进一步的,在上述发明实施例的基础上,匹配处理单元包括:
栅格投影子单元,用于将所述顶视数据集的数据投射到局部地图所处的平面栅格坐标系。
匹配率子单元,用于针对所述平面栅格坐标系的栅格,通过预设公式在高斯分布上确定各所述数据对应高度投影与所述栅格内局部地图对应的高度值匹配的概率,将各所述概率之和作为顶视数据集与局部地图的匹配率。
进一步的,在上述发明实施例的基础上,位姿确定模块420还包括:
非线性优化单元,用于基于预设代价公式对所述位姿变换进行非线性优化。其中,所述预设代价公式包括:e表示代价,n表示顶视数据集中数据的数量,μ和σ表示局部地图的高度值符合的高斯分布参数,hi表示经过初始位姿变换转换后的数据的高度投影,T′表示初始位姿变换,T表示位姿变换,ω表示定位装置的误差影响。
进一步的,在上述发明实施例的基础上,所述地图更新模块430包括:
坐标转换单元,用于通过所述位姿变换将所述顶视数据集的数据转换到与所述局部地图相同的坐标系。
数据添加单元,用于基于栅格坐标,将转换后的数据中的高度投影作为高度值更新到所述局部地图。
进一步的,在上述发明实施例的基础上,所述地图定位模块440包括:
地图转换单元,用于确定所述局部地图与所述全局地图的地图位姿变换。
地图定位单元,用于根据所述地图位姿变换确定所述计算机设备在所述全局地图的定位。
进一步的,在上述发明实施例的基础上,所述装置还包括建图模块,用于确定所述计算机设备处于建图模式,则根据地图位姿变换转换所述局部地图;将转换后的局部地图存储到所述全局地图。
进一步的,在上述发明实施例的基础上,所述装置中的顶视传感器设置于计算机设备顶部,所述顶视数据集内数据的采集方向包括水平夹角30度到150度范围,所述数据包括轮廓数据、深度数据和纹路数据中至少一种。
进一步的,在上述发明实施例的基础上,所述顶视传感器包括激光雷达传感器、视觉传感器和红外传感器中至少一种,所述定位装置包括轮式编码器、基站定位、惯性导航和卫星导航中至少一种。
进一步的,在上述发明实施例的基础上,还包括,采集调整模块,用于顶视传感器的数据采集视野被障碍物遮挡时,改变所述顶视传感器的方向以使所述顶视传感器的数据采集视野不被所述障碍物遮挡,其中,所述障碍物位于所述计算机设备与所述内顶面之间。
实施例五
图10是本发明实施例五提供的一种计算机设备的结构示意图,如图10所示,该计算机设备包括处理器50、存储器51、输入装置52、输出装置53、顶视传感器54和定位装置55;计算机设备中处理器50的数量可以是一个或多个,图10中以一个处理器50为例;计算机设备中的处理器50、存储器51、输入装置52、输出装置53、顶视传感器54和定位装置55可以通过总线或其他方式连接,图10中以通过总线连接为例。
存储器51作为一种计算机可读存储介质,可用于存储软件程序、计算机可执行程序以及模块,如本发明实施例中的计算机设备定位方法对应的程序指令/模块(例如,计算机设备定位装置中的数据采集模块410、位姿确定模块420、地图更新模块430和地图定位模块440)。处理器50通过运行存储在存储器51中的软件程序、指令以及模块,从而执行计算机设备的各种功能应用以及数据处理,即实现上述的计算机设备定位方法。
存储器51可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需的应用程序;存储数据区可存储根据终端的使用所创建的数据等。此外,存储器51可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件。在一些实例中,存储器51可进一步包括相对于处理器50远程设置的存储器,这些远程存储器可以通过网络连接至计算机设备。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
输入装置52可用于接收输入的数字或字符信息,以及产生与计算机设备的用户设置以及功能控制有关的键信号输入。输出装置53可包括显示屏等显示设备。
顶视传感器54可以设置在计算机设备的顶部,可以采集计算机设备所处建筑物内顶面的数据作为顶视数据集,顶视传感器54具体可以包括激光雷达传感器,声波顶视传感器和红外顶视传感器等,定位装置55可以获取计算机设备定位数据,可以辅助确定计算机设备所处位置,定位装置可以包括全球定位系统和轮式编码器等。
图11是本发明实施例五提供的一种计算机设备的示例图,参见图11,顶视传感器61设置在计算机设备的顶部,可以获取建筑物内顶面的数据,顶视传感器61的顶视传感器的视野范围可以如图11所示。本发明实施例中计算机设备主动轮的传动轴上设置有轮式编码器62,在传动轴的两侧各设置有一个轮式编码器62,通过两个轮式编码器62之间的位移和速度之差可以确定出计算机设备的转弯方向和转弯角度,从而确定出计算机设备经过运动后所处的位置。本发明实施例中计算机设备通过顶视传感器61采集的顶视数据集和轮式编码器62采集的定位数据集确定出计算机设备在运动后的所处位置。
实施例六
本发明实施例六还提供一种包含计算机可执行指令的存储介质,所述计算机可执行指令在由计算机处理器执行时用于执行一种计算机设备定位方法,该方法包括:
获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集,其中,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据;
根据所述定位数据集确定所述顶视数据集与局部地图的位姿变换;
根据所述位姿变换将所述顶视数据集添加到所述局部地图;
基于添加所述顶视数据集后的局部地图确定所述计算机设备在全局地图的定位。
当然,本发明实施例所提供的一种包含计算机可执行指令的存储介质,其计算机可执行指令不限于如上所述的方法操作,还可以执行本发明任意实施例所提供的计算机设备定位方法中的相关操作。
通过以上关于实施方式的描述,所属领域的技术人员可以清楚地了解到,本发明可借助软件及必需的通用硬件来实现,当然也可以通过硬件实现,但很多情况下前者是更佳的实施方式。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如计算机的软盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(RandomAccess Memory,RAM)、闪存(FLASH)、硬盘或光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述的方法。
值得注意的是,上述计算机设备定位装置的实施例中,所包括的各个单元和模块只是按照功能逻辑进行划分的,但并不局限于上述的划分,只要能够实现相应的功能即可;另外,各功能单元的具体名称也只是为了便于相互区分,并不用于限制本发明的保护范围。
注意,上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解,本发明不限于这里所述的特定实施例,对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此,虽然通过以上实施例对本发明进行了较为详细的说明,但是本发明不仅仅限于以上实施例,在不脱离本发明构思的情况下,还可以包括更多其他等效实施例,而本发明的范围由所附的权利要求范围决定。
Claims (14)
1.一种计算机设备定位方法,其特征在于,所述方法包括:
获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集,其中,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据;
根据所述定位数据集确定所述顶视数据集与局部地图的位姿变换;
根据所述位姿变换将所述顶视数据集添加到所述局部地图;
基于添加所述顶视数据集后的局部地图确定所述计算机设备在全局地图的定位;
所述根据所述定位数据集确定所述顶视数据集与局部地图的位姿变换,包括:
确定所述顶视数据集中数据对应的时间戳时间;
根据所述时间戳时间查找所述定位数据集的定位数据,并根据所述定位数据确定初始位姿变换;
通过所述初始位姿变换转换所述顶视数据集,并确定顶视数据集与局部地图的匹配率;
确定匹配率的方式包括提取顶视数据集中数据的特征值,通过特征值进行匹配;
根据数值最大的匹配率选择数据以确定位姿变换;
所述确定顶视数据集与局部地图的匹配率,包括:
将所述顶视数据集的数据投射到局部地图所处的平面栅格坐标系;
针对所述平面栅格坐标系的栅格,通过预设公式在高斯分布上确定各所述数据对应高度投影与所述栅格内局部地图对应的高度值匹配的概率,将各所述概率之和作为顶视数据集与局部地图的匹配率。
2.根据权利要求1所述的方法,其特征在于,还包括:
对齐所述顶视传感器和定位装置的时间戳。
3.根据权利要求1所述的方法,其特征在于,在所述根据所述定位数据集确定所述顶视数据集确定与局部地图的位姿变换之前,还包括:
基于统计滤波器去除所述顶视数据集中的噪声数据;
滤除所述顶视数据集中不属于建筑物的内顶面的数据。
4.根据权利要求3所述的方法,其特征在于,所述滤除所述顶视数据集中不属于建筑物的内顶面的数据,包括:
将所述顶视数据集中的数据投射到平面栅格坐标系,并获取所述数据在所述平面栅格坐标系中的栅格坐标和高度投影,其中,所述平面栅格坐标系以所述顶视传感器为原点;
按照所述栅格坐标统计属于相同栅格的数据对应高度投影的最大值和最小值;
确定所述最大值与所述最小值的差大于阈值时,将属于所述栅格的数据从所述顶视数据集中删除。
5.根据权利要求1所述的方法,其特征在于,还包括:
基于预设代价公式对所述顶视数据集与局部地图的位姿变换进行非线性优化。
6.根据权利要求1所述的方法,其特征在于,所述根据所述位姿变换将所述顶视数据集添加到所述局部地图,包括:
通过所述位姿变换将所述顶视数据集的数据转换到与所述局部地图相同的坐标系;
基于栅格坐标,将转换后的数据中的高度投影作为高度值更新到所述局部地图。
7.根据权利要求1所述的方法,其特征在于,所述基于添加所述顶视数据集后的局部地图确定所述计算机设备在全局地图的定位,包括:
确定所述局部地图与所述全局地图的地图位姿变换;
根据所述地图位姿变换确定所述计算机设备在所述全局地图的定位。
8.根据权利要求7所述的方法,其特征在于,还包括:
确定所述计算机设备处于建图模式,则根据地图位姿变换转换所述局部地图;
将转换后的局部地图存储到所述全局地图。
9.根据权利要求1-8任一所述的方法,其特征在于,所述顶视传感器设置于计算机设备顶部,所述顶视数据集内数据的采集方向包括水平夹角30度到150度范围,所述数据包括轮廓数据、深度数据和纹路数据中至少一种。
10.根据权利要求1-8任一所述的方法,其特征在于,所述顶视传感器包括激光雷达传感器、视觉传感器和红外传感器中至少一种,所述定位装置包括轮式编码器、基站定位、惯性导航和卫星导航中至少一种。
11.根据权利要求1所述的方法,其特征在于,所述顶视传感器的数据采集视野被障碍物遮挡时,改变所述顶视传感器的方向以使所述顶视传感器的数据采集视野不被所述障碍物遮挡,其中,所述障碍物位于所述计算机设备与所述内顶面之间。
12.一种计算机设备定位装置,其特征在于,所述装置包括:
数据采集模块,用于获取计算机设备顶视传感器的顶视数据集和定位装置的定位数据集,其中,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据;
位姿确定模块,用于根据所述定位数据集确定所述顶视数据集与局部地图的位姿变换;
地图更新模块,用于根据所述位姿变换将所述顶视数据集添加到所述局部地图;
地图定位模块,用于基于添加所述顶视数据集后的局部地图确定所述计算机设备在全局地图的定位;
位姿确定模块包括:
时间确定单元,用于确定所述顶视数据集中数据对应的时间戳时间;
初始位姿单元,用于根据所述时间戳时间查找所述定位数据集的定位数据,并根据所述定位数据确定初始位姿变换;
匹配处理单元,用于通过所述初始位姿变换转换所述顶视数据集,并确定顶视数据集与局部地图的匹配率;
确定匹配率的方式包括提取顶视数据集中数据的特征值,通过特征值进行匹配;
位姿确定单元,用于根据数值最大的匹配率选择数据以确定位姿变换;
所述匹配处理单元包括:
栅格投影子单元,用于将所述顶视数据集的数据投射到局部地图所处的平面栅格坐标系;
匹配率子单元,用于针对所述平面栅格坐标系的栅格,通过预设公式在高斯分布上确定各所述数据对应高度投影与所述栅格内局部地图对应的高度值匹配的概率,将各所述概率之和作为顶视数据集与局部地图的匹配率。
13.一种计算机设备,其特征在于,所述计算机设备包括:
一个或多个处理器;
存储器,用于存储一个或者多个程序;
至少一个顶视传感器,用于获取顶视数据集,所述顶视数据集包括所述计算机设备所处建筑物的内顶面的数据;
至少一个定位装置,用于获取辅助计算机设备定位的定位数据集;
当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现如权利要求1-11中任一所述的计算机设备定位方法。
14.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述程序被处理器执行时实现如权利要求1-11中任一所述的计算机设备定位方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010747143.4A CN111862219B (zh) | 2020-07-29 | 2020-07-29 | 计算机设备定位方法、装置、计算机设备和存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010747143.4A CN111862219B (zh) | 2020-07-29 | 2020-07-29 | 计算机设备定位方法、装置、计算机设备和存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111862219A CN111862219A (zh) | 2020-10-30 |
CN111862219B true CN111862219B (zh) | 2021-08-10 |
Family
ID=72945362
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010747143.4A Active CN111862219B (zh) | 2020-07-29 | 2020-07-29 | 计算机设备定位方法、装置、计算机设备和存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111862219B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113324551A (zh) * | 2021-05-28 | 2021-08-31 | 上海高仙自动化科技发展有限公司 | 一种定位方法、装置、电子设备及存储介质 |
CN113313764B (zh) * | 2021-05-28 | 2023-08-29 | 上海高仙自动化科技发展有限公司 | 定位方法、装置、电子设备和存储介质 |
CN113313765B (zh) * | 2021-05-28 | 2023-12-01 | 上海高仙自动化科技发展有限公司 | 定位方法、装置、电子设备和存储介质 |
CN113340293A (zh) * | 2021-05-28 | 2021-09-03 | 上海高仙自动化科技发展有限公司 | 一种定位方法、装置、电子设备及存储介质 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105928505B (zh) * | 2016-04-19 | 2019-01-29 | 深圳市神州云海智能科技有限公司 | 移动机器人的位姿确定方法和设备 |
CN109781119B (zh) * | 2017-11-15 | 2020-01-21 | 百度在线网络技术(北京)有限公司 | 一种激光点云定位方法和系统 |
CN108007456A (zh) * | 2017-12-06 | 2018-05-08 | 深圳市致趣科技有限公司 | 一种室内导航方法、装置及系统 |
CN109671120A (zh) * | 2018-11-08 | 2019-04-23 | 南京华捷艾米软件科技有限公司 | 一种基于轮式编码器的单目slam初始化方法及系统 |
CN109633665A (zh) * | 2018-12-17 | 2019-04-16 | 北京主线科技有限公司 | 交通场景稀疏激光点云拼接方法 |
-
2020
- 2020-07-29 CN CN202010747143.4A patent/CN111862219B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111862219A (zh) | 2020-10-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111862219B (zh) | 计算机设备定位方法、装置、计算机设备和存储介质 | |
CN111429574B (zh) | 基于三维点云和视觉融合的移动机器人定位方法和系统 | |
US20220028163A1 (en) | Computer Vision Systems and Methods for Detecting and Modeling Features of Structures in Images | |
US9858640B1 (en) | Device and method for merging 3D point clouds from sparsely distributed viewpoints | |
CN110717983A (zh) | 一种基于背包式三维激光点云数据的建筑物立面三维重建方法 | |
CN112347840A (zh) | 视觉传感器激光雷达融合无人机定位与建图装置和方法 | |
CN111862214B (zh) | 计算机设备定位方法、装置、计算机设备和存储介质 | |
CN111862215B (zh) | 一种计算机设备定位方法、装置、计算机设备和存储介质 | |
JP6997057B2 (ja) | 不動物体情報から端末位置を推定する装置、プログラム及び方法 | |
CN116255992A (zh) | 一种同时定位与建图的方法和装置 | |
CN110736456A (zh) | 稀疏环境下基于特征提取的二维激光实时定位方法 | |
CN111862216B (zh) | 计算机设备定位方法、装置、计算机设备和存储介质 | |
CN115639547A (zh) | 多线激光雷达与gnss_ins联合标定方法、系统及介质 | |
CN113313765B (zh) | 定位方法、装置、电子设备和存储介质 | |
CN111105459A (zh) | 描述子地图生成方法、定位方法、装置、设备和存储介质 | |
WO2022021133A1 (zh) | 计算机设备定位方法、装置、计算机设备和存储介质 | |
WO2023030062A1 (zh) | 一种无人机的飞行控制方法、装置、设备、介质及程序 | |
CN115909253A (zh) | 一种目标检测、模型训练方法、装置、设备及存储介质 | |
CN111862218B (zh) | 计算机设备定位方法、装置、计算机设备和存储介质 | |
WO2022021132A1 (zh) | 计算机设备定位方法、装置、计算机设备和存储介质 | |
CN113313764B (zh) | 定位方法、装置、电子设备和存储介质 | |
CN111862217B (zh) | 计算机设备定位方法、装置、计算机设备和存储介质 | |
CN116051775B (zh) | 语义地图构建方法、移动机器人及存储介质 | |
KR102356162B1 (ko) | 특정구역의 수집 정보에 대한 레이어 자동변환 기능의 모바일 매핑 시스템 | |
CN117058358B (zh) | 一种场景边界检测方法和移动平台 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |