CN110967027B - 地图校正方法、装置和电子设备 - Google Patents
地图校正方法、装置和电子设备 Download PDFInfo
- Publication number
- CN110967027B CN110967027B CN201811163160.2A CN201811163160A CN110967027B CN 110967027 B CN110967027 B CN 110967027B CN 201811163160 A CN201811163160 A CN 201811163160A CN 110967027 B CN110967027 B CN 110967027B
- Authority
- CN
- China
- Prior art keywords
- track
- movement
- moving
- preset
- visual scale
- 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
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
- G01C21/32—Structuring or formatting of map data
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
公开了一种地图校正方法、装置和电子设备。确定可移动设备的第一移动轨迹以及预设视觉尺度,根据第一移动轨迹和预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹。例如,在第一移动轨迹周边确定出与第一移动轨迹相似的至少一条具有视觉尺度的第二移动轨迹,然后获取第一移动轨迹所在的位置区域内的预设道路轨迹。根据预设道路轨迹以及至少一条第二移动轨迹确定可移动设备的、具有视觉尺度的第三移动轨迹。由于可移动设备往往是在预设道路轨迹上移动的,如此可以得到可移动设备在预设道路轨迹上的真实的移动轨迹,也即第三移动轨迹,之后根据第三移动轨迹的视觉尺度校正可移动设备移动时生成的地图,从而可以使得校正后的地图是客观标准的。
Description
技术领域
本申请涉及计算机技术领域,且更具体地,涉及一种地图校正方法、装置和电子设备。
背景技术
随着技术的飞速发展,机器人在各行各业得到了广泛使用,在机器人移动的过程中往往需要通过拍摄周围环境图像来建立地图。
在建立地图的过程中,往往需要对机器人定位,如果定位准确,则生成的地图的视觉尺度就是标准的视觉尺度,进而使得生成的地图是客观标准的,如果定位不准确,则生成的地图的视觉尺度就不是标准的视觉尺度,进而使得生成的地图不是客观标准的。
由于机器人在移动时,机器人的轮子与地面之间会产生摩擦,导致根据里程计确定出的机器人的移动里程与机器人实际的移动里程之间会存在细小误差,随着移动里程的增加,累计误差会越来越大,进而无法准确对机器人定位,进而导致生成的地图不是客观标准的。
发明内容
为了解决上述技术问题,提出了本申请。本申请的实施例提供了一种地图校正方法、装置和电子设备,其可以校正可移动设备移动过程中生成的地图,以使校正后的地图是客观标准的。
根据本申请的一个方面,提供了一种地图校正方法,包括:
确定可移动设备的第一移动轨迹以及预设视觉尺度;
根据所述第一移动轨迹和所述预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹;
从数字地图中获取所述第一移动轨迹所在的位置区域内的预设道路轨迹;
根据所述预设道路轨迹以及所述至少一条第二移动轨迹确定所述可移动设备的、具有视觉尺度的第三移动轨迹;
根据所述第三移动轨迹的视觉尺度校正所述可移动设备移动时生成的地图。
根据本申请的另一方面,提供了一种地图校正装置,包括:
第一确定模块,用于确定可移动设备的第一移动轨迹以及预设视觉尺度;
生成模块,用于根据所述第一移动轨迹和所述预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹;
获取模块,用于从数字地图中获取所述第一移动轨迹所在的位置区域内的预设道路轨迹;
第二确定模块,用于根据所述预设道路轨迹以及所述至少一条第二移动轨迹确定所述可移动设备的、具有视觉尺度的第三移动轨迹;
校正模块,用于根据所述第三移动轨迹的视觉尺度校正所述可移动设备移动时生成的地图。
根据本申请的另一方面,提供了一种电子设备,包括:处理器;存储器;以及存储在所述存储器中的计算机程序指令,所述计算机程序指令在被所述处理器运行时使得所述处理器执行上述的地图校正方法。
根据本申请的另一方面,提供了一种计算机程序产品,包括计算机程序指令,所述计算机程序指令在被处理器运行时使得所述处理器执行上述的地图校正方法。
根据本申请的另一方面,提供了一种计算机可读存储介质,其上存储有计算机程序指令,所述计算机程序指令在被处理器运行时使得所述处理器执行上述的地图校正方法。
在现有技术中,通过一些定位设备定位出的可移动设备的移动轨迹与可移动设备的真实移动之间往往存在误差,导致可移动设备在移动过程中生成的地图并不是客观标准的。而在本申请中,确定可移动设备的第一移动轨迹以及预设视觉尺度,根据第一移动轨迹和预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹。例如,在第一移动轨迹周边确定出与第一移动轨迹相似的至少一条具有视觉尺度的第二移动轨迹,然后从数字地图中获取第一移动轨迹所在的位置区域内的预设道路轨迹。根据预设道路轨迹以及至少一条第二移动轨迹确定可移动设备的、具有视觉尺度的第三移动轨迹。第三移动轨迹包括与预设道路轨迹相似一条移动轨迹,由于可移动设备往往是在预设道路轨迹上移动的,如此可以得到可移动设备在预设道路轨迹上的真实的移动轨迹,也即第三移动轨迹,之后根据第三移动轨迹的视觉尺度校正可移动设备移动时生成的地图,从而可以使得校正后的地图是客观标准的。
附图说明
通过结合附图对本申请实施例进行更详细的描述,本申请的上述以及其他目的、特征和优势将变得更加明显。附图用来提供对本申请实施例的进一步理解,并且构成说明书的一部分,与本申请实施例一起用于解释本申请,并不构成对本申请的限制。在附图中,相同的参考标号通常代表相同部件或步骤。
图1根据本申请实施例示出了一种地图校正方法的流程图。
图2根据本申请实施例示出了一种生成第二移动轨迹的方法的流程图。
图3根据本申请实施例示出了一种场景示意图。
图4根据本申请实施例示出了一种场景示意图。
图5根据本申请实施例示出了一种场景示意图。
图6根据本申请实施例示出了一种确定第三移动轨迹的方法的流程图。
图7根据本申请实施例示出了一种确定第三移动轨迹的方法的流程图。
图8根据本申请实施例示出了一种地图校正装置的框图。
图9根据本申请实施例示出了一种地图校正装置的框图。
图10根据本申请实施例示出了一种电子设备的框图。
具体实施方式
下面,将参考附图详细地描述根据本申请的示例实施例。显然,所描述的实施例仅仅是本申请的一部分实施例,而不是本申请的全部实施例,应理解,本申请不受这里描述的示例实施例的限制。
在本申请中,可移动设备移动时,根据可移动设备的移动轨迹以及可移动设备的预设视觉尺度可以生成地图,然而,其移动轨迹是通过设置在可移动设备上的里程计获取的,由于根据里程计获取的移动轨迹有误差,因此生成的地图有误差。通常情况下,可移动设备是在真实的道路中移动的,也即,确定出可移动设备在真实的道路上的移动轨迹就可以得到可移动设备的真实的移动轨迹,进而确定真实的移动轨迹的视觉尺度,根据该视觉尺度校正生成的地图。
示例性方法
图1图示了根据本申请实施例的一种地图校正方法的流程图。
如图1所示,根据本申请实施例的一种地图校正方法可以包括:
在步骤S101中,确定可移动设备的第一移动轨迹以及预设视觉尺度。
本发明实施例中的视觉尺度包括SLAM((simultaneous localization andmapping),即时定位与地图构建)视觉尺度。
在一实施例中,可移动设备移动时,根据可移动设备的移动轨迹以及可移动设备的预设视觉尺度可以生成地图,然而,其移动轨迹是通过设置在可移动设备上的里程计获取的,由于根据里程计获取的移动轨迹不是可移动设备的真实的移动轨迹,因此生成的地图并不是客观标准的。因此,需要对生成的地图进行校正,以使校正后的地图是客观标准的。
在本步骤中,可移动设备可以接收里程计获取的里程计信息,里程计设置在可移动设备上,然后根据里程计信息获取第一移动轨迹以及预设视觉尺度。预设视觉尺度为可移动设备的默认的视觉尺度。
为了得到可移动设备的真实的移动轨迹,以对生成的地图进行校正,在确定可移动设备的第一移动轨迹以及预设视觉尺度之后,需要执行步骤S102。
在步骤S102中,根据第一移动轨迹和预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹。
第一移动轨迹是由多个具有先后顺序的移动轨迹点组成的,对于任意一个移动轨迹点,可以在该移动轨迹点周边随机生成至少一个虚拟轨迹点,作为该移动轨迹点对应的至少一个虚拟轨迹点,然后将每一个移动轨迹点对应的至少一个虚拟轨迹点,按照其对应的移动轨迹点之间的先后顺序组成具有视觉尺度的至少一条候选移动轨迹。然后根据预设视觉尺度生成至少一个候选视觉尺度,再使用至少一个候选视觉尺度将至少一条候选移动轨迹转换为至少一条新的移动轨迹,并作为至少一条第二移动轨迹。具体流程可以参见如图2所示的实施例,在此不做详述。
在步骤S103中,从数字地图中获取第一移动轨迹所在的位置区域内的预设道路轨迹。
在本申请中,预设道路轨迹事先在从数字地图中设置好的,然而,一个城市的数字地图中或者一个地区的数字地图中预设道路轨迹有很多,由于可移动设备往往只会在一部分区域内移动,因此本申请无需获取事先设置的所有预设道路轨迹,而可以先确定第一移动轨迹所在的位置区域,然后获取第一移动轨迹所在的位置区域内的预设道路轨迹。
在步骤S104中,根据预设道路轨迹以及至少一条第二移动轨迹确定可移动设备的、具有视觉尺度的第三移动轨迹。
其中,可以在至少一条第二移动轨迹中确定与预设道路轨迹最相似的一条第二移动轨迹,作为可移动设备的第三移动轨迹,由于可移动设备往往是在预设道路轨迹上移动的,因此,可以将第三移动轨迹作为可移动设备的真实的移动轨迹,具体流程可参见如图6或图7所示的实施例,在此不做详述。
在步骤S105中,根据第三移动轨迹的视觉尺度校正可移动设备移动时生成的地图。
其中,可以根据设置在可移动设备上的里程计的里程计信息获取可移动设备移动时生成的地图,然后根据第三移动轨迹的视觉尺度校正该地图,以使校正后的该地图客观标准。
在现有技术中,通过一些定位设备定位出的可移动设备的移动轨迹与可移动设备的真实移动之间往往存在误差,导致可移动设备在移动过程中生成的地图并不是客观标准的。而在本申请中,确定可移动设备的第一移动轨迹以及预设视觉尺度,根据第一移动轨迹和预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹。例如,在第一移动轨迹周边确定出与第一移动轨迹相似的至少一条具有视觉尺度的第二移动轨迹,然后从数字地图中获取第一移动轨迹所在的位置区域内的预设道路轨迹。根据预设道路轨迹以及至少一条第二移动轨迹确定可移动设备的、具有视觉尺度的第三移动轨迹。第三移动轨迹包括与预设道路轨迹相似一条移动轨迹,由于可移动设备往往是在预设道路轨迹上移动的,如此可以得到可移动设备在预设道路轨迹上的真实的移动轨迹,也即第三移动轨迹,之后根据第三移动轨迹的视觉尺度校正可移动设备移动时生成的地图,从而可以使得校正后的地图是客观标准的。
在本申请,参见图2,步骤S102可以通过如下流程实现,包括:
在步骤S201中,根据第一移动轨迹生成至少一条第四移动轨迹。
其中,第一移动轨迹中包括具有先后顺序的多个移动轨迹点。
本步骤可以通过如下流程实现,包括:
2011、对于第一移动轨迹中包括的每一个移动轨迹点,获取与移动轨迹点之间的距离小于预设距离的虚拟轨迹点。
在可移动设备移动的过程中,设置在可移动设备上的里程计会实时确定可移动设备的移动方向和移动距离,并根据可移动设备的移动方向和移动距离实时确定可移动设备的移动轨迹点,可移动设备的移动轨迹点按照先后顺序组成了第一移动轨迹。
对于任意一个移动轨迹点,如果该移动轨迹点为第一移动轨迹中的第一个移动轨迹点,可以通过里程计信息确定出当可移动设备位于该移动轨迹点时,可移动设备的移动方向,然后以该移动轨迹点为圆心确定以该移动方向所在的直线为角平分线的扇形区域,扇形的圆心角可以根据实际情况确定,例如圆形角可以为180°、140°、90°或30°等,本申请对此不做限定,扇形区域的半径可以为预设距离,预设距离可以根据实际情况确定,本申请对此不做限定,然后在扇形区域内随机确定出多个轨迹点,并作为该移动轨迹点对应的虚拟轨迹点。
如果该移动轨迹点不为第一移动轨迹中的第一个移动轨迹点,则可以确定该移动轨迹点相对于参考轨迹点的方向,参考轨迹点位于第一移动轨迹中,参考轨迹点与该移动轨迹点相邻且位于移动轨迹点之前。然后在参考轨迹点的方向上获取与移动轨迹点之间的距离小于预设距离的多个虚拟轨迹点。
例如,可以通过里程计信息确定出当可移动设备位于参考轨迹点时,可移动设备的移动方向,然后以参考轨迹点为圆心确定以该移动方向所在的直线为角平分线的扇形区域,扇形的圆心角可以根据实际情况确定,例如圆形角可以为180°、140°、90°或30°等,本申请对此不做限定,然后在扇形区域内确定出以该移动轨迹点为中心的一个区域,该区域中距离该移动轨迹点最远的点与该移动轨迹点之间的距离小于预设距离,预设距离可以根据实际情况确定,本申请对此不做限定,然后在确定出该区域内随机确定出多个轨迹点,并作为该移动轨迹点对应的虚拟轨迹点。
本申请的扇形区域仅仅作为实例,当然也可以为其他形状的区域,本申请对此不做限定。
例如,如图3所示,可移动设备1在移动轨迹点A时的移动方向为虚线箭头所示的方向,以移动轨迹点A为圆心确定以该移动方向所在的直线为角平分线的扇形区域,扇形的圆心角为90°,扇形区域的半径为预设距离,在扇形区域内随机确定出移动轨迹点A1以及A2。
对于其他每一个移动轨迹点,同样执行上述操作。
2012、根据每一个移动轨迹点分别对应的虚拟轨迹点生成多个第四移动轨迹。
在本步骤中,根据每一个移动轨迹点都会确定出多个虚拟轨迹点,可以按照排列组合的方式,从每一个移动轨迹点分别对应的虚拟轨迹点中选择一个虚拟轨迹点,将选择出的多个虚拟轨迹点按照其分别对应的移动轨迹之间的先后顺序组成一个第四移动轨迹。
例如,如图4所示,第一移动轨迹中包括3个移动轨迹点A、B以及C,移动轨迹点A的先后顺序早于为移动轨迹点B的先后顺序,移动轨迹点B的先后顺序早于为移动轨迹点C的先后顺序,移动轨迹点A对应的虚拟轨迹点为A1和A2,移动轨迹点B对应的虚拟轨迹点为B1,移动轨迹点A对应的虚拟轨迹点为C1和C2。如此,而可以将虚拟轨迹点A1、B1、和C1组成一个第四移动轨迹,将虚拟轨迹点A1、B1、和C2组成一个第四移动轨迹,将虚拟轨迹点A2、B1、和C1组成一个第二移动轨迹,以及将虚拟轨迹点A2、B1、和C2组成一个第四移动轨迹。
在步骤S202中,根据预设视觉尺度确定至少一个视觉尺度。
其中,可以确定预设视觉尺度所在的一个视觉尺度区间,例如,确定第一视觉尺度和第二视觉尺度,第一视觉尺度小于预设视觉尺度,第二视觉尺度大于预设视觉尺度,预设视觉尺度与第一视觉尺度之间的差值为预设数值,第二视觉尺度与预设视觉尺度之间的差值为预设数值。预设数值可以根据实际需求具体确定,在此不做详述。
其中,可以以第一视觉尺度和第二视觉尺度确定一个视觉尺度区间,该视觉尺度区间的左边界为第一视觉尺度,该视觉尺度区间的右边界为第二预设视觉尺度。可以在该视觉尺度区间中确定出至少一个视觉尺度。
在步骤S203中,对于每一个第四移动轨迹,根据确定的视觉尺度将第四移动轨迹转换为至少一条第二移动轨迹。
对于任意一个第四移动轨迹以及确定出的任意一个视觉尺度,根据该视觉尺度分别将该第四移动轨迹转换为一个新的移动轨迹,并作为第二移动轨迹,
例如,参见图5,图5示出了一个第四移动轨迹包括轨迹点A、B以及C在地图中位置,使用某一视觉尺度将该第四移动轨迹转换后得到由轨迹点A’、B’以及C’组成的第二移动轨迹。
其中,在图5所示的例子中,可以使用轨迹点A在地图中的位置乘以视觉尺度,得到转换后的轨迹点A’在地图中的位置,使用轨迹点B在地图中的位置乘以视觉尺度,得到转换后的轨迹点B’在地图中的位置,使用轨迹点C在地图中的位置乘以视觉尺度,得到转换后的轨迹点C’在地图中的位置。其中,图5的示例中,该视觉尺度为2,由轨迹点A’、B’以及C’组成的第二移动轨迹相当于在由轨迹点A、B以及C组成的第四移动轨迹的基础上扩大两倍。
对于其他每一个第四移动轨迹和每一个视觉尺度,同样执行上述操作。
通过本实施例的方法,由于确定的虚拟轨迹点与移动轨迹点之间的距离小于预设距离,因此可以在第一移动轨迹周边确定出与第一移动轨迹非常相似的多个第二移动轨迹,也即与第一移动轨迹非常相似的多个虚拟移动轨迹,如此结合预设道路轨迹可以精准地确定出可移动设备的真实的移动轨迹,之后可以使用真实的移动轨迹的视觉尺度对生成的地图进行精准的校正。
在一个实施例中,参见图6,步骤S104可以通过如下流程实现,包括:
在步骤S301中,对于每一个第二移动轨迹,计算该第二移动轨迹与预设道路轨迹之间的相似度。
在本申请中,每一个第二移动轨迹都包括多个移动轨迹点,每一个移动轨迹点都具备各自的位置信息,且预设道路轨迹也包括多个预设道路轨迹点,每一个预设道路轨迹点都具备各自的位置信息。
其中,预设道路轨迹包括的预设道路轨迹点是事先设置好的,以及每一个预设道路轨迹点各自具备的位置信息也是事先设置好的。
对于任意一个第二移动轨迹,可以获取该第二移动轨迹包括的每一个移动轨迹点的位置信息。然后获取预设道路轨迹中包括的每一个预设道路轨迹点的位置信息。
然后对于该第二移动轨迹中包括的任意一个移动轨迹点,根据该移动轨迹点的位置信息与每一个预设道路轨迹点的位置信息,在多个预设道路轨迹点中,查找距离该移动轨迹点距离最近的预设道路轨迹点,其中,可以移动轨迹点的位置信息与预设道路轨迹点的位置信息计算移动轨迹点与预设道路轨迹点之间的距离,然后将该移动轨迹点与查找到的预设道路轨迹点之间的距离确定为该移动轨迹点与预设道路轨迹之间的距离。
对于该第二移动轨迹中包括的其他每一个移动轨迹点,同样执行上述操作,如此得到该第二移动轨迹包括的每一个移动轨迹点分别与预设道路轨迹之间的距离。
然后根据每一个移动轨迹点分别与预设道路轨迹之间的距离获取该第二移动轨迹与预设道路轨迹之间的相似度。例如,可以计算每一个移动轨迹点分别与预设道路轨迹之间的距离的加权平均值,并作为第二移动轨迹与预设道路轨迹之间的相似度。
对于其他每一个第二移动轨迹,同样执行上述操作,如此得到每一个第二移动轨迹分别与预设道路轨迹之间的相似度。
在步骤S302中,将与预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹确定为第三移动轨迹。并根据与预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹的视觉尺度确定第三移动轨迹的视觉尺度。
可以与预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹进行加权平均运算,得到第三移动轨迹。
例如,在与预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹中,每一个第二移动轨迹包括的移动轨迹点的数量都相同,且第二移动轨迹中的每一个移动轨迹点都具备先后顺序,对于这些第二移动轨迹中任意先后顺序相同的移动轨迹点,根据这些移动轨迹点的位置之间的平均位置,对于这些第二移动轨迹中其他每两个先后顺序相同的移动轨迹点,同样执行上述操作,如此得到每一个先后顺序对应的平均位置,并在每一个先后顺序对应的平均位置上分别确定一个目标移动轨迹点,然后将目标移动轨迹点按照先后顺序组成第三移动轨迹。
然后计算与预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹的视觉尺度的平均值,作为第三移动轨迹的视觉尺度。
预设数量可以为1、2或5等等,本申请对此不做限定。
通过本实施例的方法,由于可移动设备是在预设道路上移动的,如此将与预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹确定为第三移动轨迹,可以更加准确地确定出可移动设备的真实的移动轨迹,进而可以更加精准地校正生成的地图。
在一个实施例中,参见图7,步骤S104可以通过如下流程实现,包括:
在步骤S401中,对于每一个第二移动轨迹,计算该第二移动轨迹与预设道路轨迹之间的相似度。
在本申请中,每一个第二移动轨迹都包括多个移动轨迹点,每一个移动轨迹点都具备各自的位置信息,且预设道路轨迹也包括多个预设道路轨迹点,每一个预设道路轨迹点都具备各自的位置信息。
其中,预设道路轨迹包括的预设道路轨迹点是事先设置好的,以及每一个预设道路轨迹点各自具备的位置信息也是事先设置好的。
对于任意一个第二移动轨迹,可以获取该第二移动轨迹包括的每一个移动轨迹点的位置信息。然后获取预设道路轨迹中包括的每一个预设道路轨迹点的位置信息。
然后对于该第二移动轨迹中包括的任意一个移动轨迹点,根据该移动轨迹点的位置信息与每一个预设道路轨迹点的位置信息,在多个预设道路轨迹点中,查找距离该移动轨迹点距离最近的预设道路轨迹点,其中,可以移动轨迹点的位置信息与预设道路轨迹点的位置信息计算移动轨迹点与预设道路轨迹点之间的距离,然后将该移动轨迹点与查找到的预设道路轨迹点之间的距离确定为该移动轨迹点与预设道路轨迹之间的距离。
对于该第二移动轨迹中包括的其他每一个移动轨迹点,同样执行上述操作,如此得到该第二移动轨迹包括的每一个移动轨迹点分别与预设道路轨迹之间的距离。
然后根据每一个移动轨迹点分别与预设道路轨迹之间的距离获取该第二移动轨迹与预设道路轨迹之间的相似度。例如,可以计算每一个移动轨迹点分别与预设道路轨迹之间的距离的加权平均值,并作为第二移动轨迹与预设道路轨迹之间的相似度。
对于其他每一个第二移动轨迹,同样执行上述操作,如此得到每一个第二移动轨迹分别与预设道路轨迹之间的相似度。
在步骤S402中,根据与预设道路轨迹之间的相似度最高的至少两个第二移动轨迹生成第三移动轨迹,并根据至少两个第二移动轨迹的视觉尺度确定第三移动轨迹的视觉尺度。
可以对至少两个第二移动轨迹进行加权平均运算,得到第三移动轨迹。
例如,在这两个第二移动轨迹中,每一个第二移动轨迹包括的移动轨迹点的数量都相同,且第二移动轨迹中的每一个移动轨迹点都具备先后顺序,对于这两个第二移动轨迹中任意两个先后顺序相同的移动轨迹点,根据这两个移动轨迹点的位置之间的平均位置,对于这两个第二移动轨迹中其他每两个先后顺序相同的移动轨迹点,同样执行上述操作,如此得到每一个先后顺序对应的平均位置,并在每一个先后顺序对应的平均位置上分别确定一个目标移动轨迹点,然后将目标移动轨迹点按照先后顺序组成第三移动轨迹。
然后计算至少两个第二移动轨迹的视觉尺度的平均值,作为第三移动轨迹的视觉尺度。
通过本实施例的方法,由于可移动设备是在预设道路上移动的,如此根据与预设道路轨迹之间的相似度最高的至少两个第二移动轨迹生成第三移动轨迹,可以更加准确地确定出可移动设备的真实的移动轨迹,进而可以更加精准地校正生成的地图。
示例性装置
下面,参考图8来描述根据本申请实施例的地图校正装置。
图8图示了根据本申请实施例的地图校正装置的框图。
如图8所示,根据本申请实施例的所述地图校正装置可以包括:
第一确定模块501,用于确定可移动设备的第一移动轨迹以及预设视觉尺度;
生成模块502,用于根据所述第一移动轨迹和所述预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹;
获取模块503,用于从数字地图中获取所述第一移动轨迹所在的位置区域内的预设道路轨迹;
第二确定模块504,用于根据所述预设道路轨迹以及所述至少一条第二移动轨迹确定所述可移动设备的、具有视觉尺度的第三移动轨迹;
校正模块505,用于根据所述第三移动轨迹的视觉尺度校正所述可移动设备移动时生成的地图。
参见图9,在一个实例中,所述生成模块502包括:
生成单元5021,用于根据所述第一移动轨迹生成至少一条第四移动轨迹;
第一确定单元5022,用于根据所述预设视觉尺度确定至少一个视觉尺度;
转换单元5023,用于对于每一个第四移动轨迹,根据确定的视觉尺度将所述第四移动轨迹转换为至少一条第二移动轨迹。
在一个实例中,所述第一移动轨迹中包括具有先后顺序的多个移动轨迹点;
所述生成单元5021包括:
第一获取子单元,用于对于所述第一移动轨迹中包括的每一个移动轨迹点,获取与所述移动轨迹点之间的距离小于预设距离的虚拟轨迹点;
生成子单元,用于根据每一个移动轨迹点分别对应的虚拟轨迹点生成多个第四移动轨迹。
在一个实例中,所述获取子单元具体用于:
确定所述移动轨迹点相对于参考轨迹点的方向,所述参考轨迹点位于所述第一移动轨迹中,所述参考轨迹点与所述移动轨迹点相邻且位于所述移动轨迹点之前;
在所述参考轨迹点的所述方向上获取与所述移动轨迹点之间的距离小于预设距离的多个虚拟轨迹点。
在一个示例中所述第二确定模块504包括:
计算单元5041,用于对于每一个第二移动轨迹,计算所述第二移动轨迹与所述预设道路轨迹之间的相似度;
第二确定单元5042,用于将与所述预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹确定为所述第三移动轨迹;并根据与所述预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹的视觉尺度确定所述第三移动轨迹的视觉尺度。
在一个示例中所述第二确定模块504包括:包括:
计算单元5041,用于对于每一个第二移动轨迹,计算所述第二移动轨迹与所述预设道路轨迹之间的相似度;
第三确定单元5043,用于根据与所述预设道路轨迹之间的相似度最高的至少两个第二移动轨迹生成所述第三移动轨迹,并根据所述至少两个第二移动轨迹的视觉尺度确定所述第三移动轨迹的视觉尺度。
在一个示例中所述计算单元包括:
第二获取子单元,用于获取所述预设道路轨迹中包括的每一个预设道路轨迹点的位置信息;
第三获取子单元,用于获取所述第二移动轨迹中包括的每一个移动轨迹点的位置信息;
确定子单元,用于对于所述第二移动轨迹中包括的每一个移动轨迹点,根据所述移动轨迹点的位置信息与每一个预设道路轨迹点的位置信息,在多个预设道路轨迹点中,查找距离所述移动轨迹点距离最近的预设道路轨迹点,将所述移动轨迹点与所述查找到的预设道路轨迹点之间的距离确定为所述移动轨迹点与所述预设道路轨迹之间的距离;
第四获取子单元,用于根据每一个移动轨迹点分别与所述预设道路轨迹之间的距离获取所述第二移动轨迹与所述预设道路轨迹之间的相似度。
在一个示例中所述根第四获取子单元具体用于:
计算每一个移动轨迹点分别与所述预设道路轨迹之间的距离的加权平均值,并作为所述第二移动轨迹与所述预设道路轨迹之间的相似度。
在现有技术中,通过一些定位设备定位出的可移动设备的移动轨迹与可移动设备的真实移动之间往往存在误差,导致可移动设备在移动过程中生成的地图并不是客观标准的。而在本申请中,确定可移动设备的第一移动轨迹以及预设视觉尺度,根据第一移动轨迹和预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹。例如,在第一移动轨迹周边确定出与第一移动轨迹相似的至少一条具有视觉尺度的第二移动轨迹,然后从数字地图中获取第一移动轨迹所在的位置区域内的预设道路轨迹。根据预设道路轨迹以及至少一条第二移动轨迹确定可移动设备的、具有视觉尺度的第三移动轨迹。第三移动轨迹包括与预设道路轨迹相似一条移动轨迹,由于可移动设备往往是在预设道路轨迹上移动的,如此可以得到可移动设备在预设道路轨迹上的真实的移动轨迹,也即第三移动轨迹,之后根据第三移动轨迹的视觉尺度校正可移动设备移动时生成的地图,从而可以使得校正后的地图是客观标准的。
示例性电子设备
下面,参考图10来描述根据本申请实施例的电子设备。
图10图示了根据本申请实施例的电子设备的框图。
如图10所示,电子设备10包括一个或多个处理器11和存储器12。
处理器11可以是中央处理单元(CPU)或者具有数据处理能力和/或指令执行能力的其他形式的处理单元,并且可以控制电子设备10中的其他组件以执行期望的功能。
存储器12可以包括一个或多个计算机程序产品,所述计算机程序产品可以包括各种形式的计算机可读存储介质,例如易失性存储器和/或非易失性存储器。所述易失性存储器例如可以包括随机存取存储器(RAM)和/或高速缓冲存储器(cache)等。所述非易失性存储器例如可以包括只读存储器(ROM)、硬盘、闪存等。在所述计算机可读存储介质上可以存储一个或多个计算机程序指令,处理器11可以运行所述程序指令,以实现上文所述的本申请的各个实施例的地图校正方法以及/或者其他期望的功能。在所述计算机可读存储介质中还可以存储诸如输入信号、信号分量、噪声分量等各种内容。
在一个示例中,电子设备10还可以包括:输入装置13和输出装置14,这些组件通过总线系统和/或其他形式的连接机构(未示出)互连。
此外,该输入设备13还可以包括例如键盘、鼠标等等。
该输出装置14可以向外部输出各种信息,包括确定出的距离信息、方向信息等。该输出设备14可以包括例如显示器、扬声器、打印机、以及通信网络及其所连接的远程输出设备等等。
当然,为了简化,图10中仅示出了该电子设备10中与本申请有关的组件中的一些,省略了诸如总线、输入/输出接口等等的组件。除此之外,根据具体应用情况,电子设备10还可以包括任何其他适当的组件。
示例性计算机程序产品和计算机可读存储介质
除了上述方法和设备以外,本申请的实施例还可以是计算机程序产品,其包括计算机程序指令,所述计算机程序指令在被处理器运行时使得所述处理器执行本说明书上述“示例性方法”部分中描述的根据本申请各种实施例的地图校正方法中的步骤。
所述计算机程序产品可以以一种或多种程序设计语言的任意组合来编写用于执行本申请实施例操作的程序代码,所述程序设计语言包括面向对象的程序设计语言,诸如Java、C++等,还包括常规的过程式程序设计语言,诸如“C”语言或类似的程序设计语言。程序代码可以完全地在用户计算设备上执行、部分地在用户设备上执行、作为一个独立的软件包执行、部分在用户计算设备上部分在远程计算设备上执行、或者完全在远程计算设备或服务器上执行。
此外,本申请的实施例还可以是计算机可读存储介质,其上存储有计算机程序指令,所述计算机程序指令在被处理器运行时使得所述处理器执行本说明书上述“示例性方法”部分中描述的根据本申请各种实施例的地图校正方法中的步骤。
所述计算机可读存储介质可以采用一个或多个可读介质的任意组合。可读介质可以是可读信号介质或者可读存储介质。可读存储介质例如可以包括但不限于电、磁、光、电磁、红外线、或半导体的系统、装置或器件,或者任意以上的组合。可读存储介质的更具体的例子(非穷举的列表)包括:具有一个或多个导线的电连接、便携式盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。
以上结合具体实施例描述了本申请的基本原理,但是,需要指出的是,在本申请中提及的优点、优势、效果等仅是示例而非限制,不能认为这些优点、优势、效果等是本申请的各个实施例必须具备的。另外,上述公开的具体细节仅是为了示例的作用和便于理解的作用,而非限制,上述细节并不限制本申请为必须采用上述具体的细节来实现。
本申请中涉及的器件、装置、设备、系统的方框图仅作为例示性的例子并且不意图要求或暗示必须按照方框图示出的方式进行连接、布置、配置。如本领域技术人员将认识到的,可以按任意方式连接、布置、配置这些器件、装置、设备、系统。诸如“包括”、“包含”、“具有”等等的词语是开放性词汇,指“包括但不限于”,且可与其互换使用。这里所使用的词汇“或”和“和”指词汇“和/或”,且可与其互换使用,除非上下文明确指示不是如此。这里所使用的词汇“诸如”指词组“诸如但不限于”,且可与其互换使用。
还需要指出的是,在本申请的装置、设备和方法中,各部件或各步骤是可以分解和/或重新组合的。这些分解和/或重新组合应视为本申请的等效方案。
提供所公开的方面的以上描述以使本领域的任何技术人员能够做出或者使用本申请。对这些方面的各种修改对于本领域技术人员而言是非常显而易见的,并且在此定义的一般原理可以应用于其他方面而不脱离本申请的范围。因此,本申请不意图被限制到在此示出的方面,而是按照与在此公开的原理和新颖的特征一致的最宽范围。
为了例示和描述的目的已经给出了以上描述。此外,此描述不意图将本申请的实施例限制到在此公开的形式。尽管以上已经讨论了多个示例方面和实施例,但是本领域技术人员将认识到其某些变型、修改、改变、添加和子组合。
Claims (11)
1.一种地图校正方法,包括:
确定可移动设备的第一移动轨迹以及预设视觉尺度;
根据所述第一移动轨迹和所述预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹;
从数字地图中获取所述第一移动轨迹所在的位置区域内的预设道路轨迹;
根据所述预设道路轨迹以及所述至少一条第二移动轨迹确定所述可移动设备的、具有视觉尺度的第三移动轨迹;
根据所述第三移动轨迹的视觉尺度校正所述可移动设备移动时生成的地图。
2.根据权利要求1所述的方法,其中,所述根据所述第一移动轨迹和所述预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹,包括:
根据所述第一移动轨迹生成至少一条第四移动轨迹;
根据所述预设视觉尺度确定至少一个视觉尺度;
对于每一个第四移动轨迹,根据确定的视觉尺度将所述第四移动轨迹转换为至少一条第二移动轨迹。
3.根据权利要求2所述的方法,其中,所述第一移动轨迹中包括具有先后顺序的多个移动轨迹点;
所述根据所述第一移动轨迹生成至少一条第四移动轨迹,包括:
对于所述第一移动轨迹中包括的每一个移动轨迹点,获取与所述移动轨迹点之间的距离小于预设距离的虚拟轨迹点;
根据每一个移动轨迹点分别对应的虚拟轨迹点生成多个第四移动轨迹。
4.根据权利要求3所述的方法,其中,所述获取与所述移动轨迹点之间的距离小于预设距离的虚拟轨迹点,包括:
确定所述移动轨迹点相对于参考轨迹点的方向,所述参考轨迹点位于所述第一移动轨迹中,所述参考轨迹点与所述移动轨迹点相邻且位于所述移动轨迹点之前;
在所述移动轨迹点相对于参考轨迹点的方向上获取与所述移动轨迹点之间的距离小于预设距离的多个虚拟轨迹点。
5.根据权利要求1所述的方法,其中,所述根据所述预设道路轨迹以及所述至少一条第二移动轨迹确定所述可移动设备的、具有视觉尺度的第三移动轨迹,包括:
对于每一个第二移动轨迹,计算所述第二移动轨迹与所述预设道路轨迹之间的相似度;
将与所述预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹确定为所述第三移动轨迹;并根据与所述预设道路轨迹之间的相似度最高的预设数量个第二移动轨迹的视觉尺度确定所述第三移动轨迹的视觉尺度。
6.根据权利要求1所述的方法,其中,所述根据所述预设道路轨迹、所述至少一条第二移动轨迹确定所述可移动设备的、具有视觉尺度的第三移动轨迹,包括:
对于每一个第二移动轨迹,计算所述第二移动轨迹与所述预设道路轨迹之间的相似度;
根据与所述预设道路轨迹之间的相似度最高的至少两个第二移动轨迹生成所述第三移动轨迹,并根据所述至少两个第二移动轨迹的视觉尺度确定所述第三移动轨迹的视觉尺度。
7.根据权利要求5或6所述的方法,其中,所述计算所述第二移动轨迹与所述预设道路轨迹之间的相似度,包括:
获取所述预设道路轨迹中包括的每一个预设道路轨迹点的位置信息;
获取所述第二移动轨迹中包括的每一个移动轨迹点的位置信息;
对于所述第二移动轨迹中包括的每一个移动轨迹点,根据所述移动轨迹点的位置信息与每一个预设道路轨迹点的位置信息,在多个预设道路轨迹点中,查找距离所述移动轨迹点距离最近的预设道路轨迹点,将所述移动轨迹点与所述查找到的预设道路轨迹点之间的距离确定为所述移动轨迹点与所述预设道路轨迹之间的距离;
根据每一个移动轨迹点分别与所述预设道路轨迹之间的距离获取所述第二移动轨迹与所述预设道路轨迹之间的相似度。
8.根据权利要求7所述的方法,其中,所述根据每一个移动轨迹点分别与所述预设道路轨迹之间的距离获取所述第二移动轨迹与所述预设道路轨迹之间的相似度,包括:
计算每一个移动轨迹点分别与所述预设道路轨迹之间的距离的加权平均值,并作为所述第二移动轨迹与所述预设道路轨迹之间的相似度。
9.一种地图校正装置,包括:
第一确定模块,用于确定可移动设备的第一移动轨迹以及预设视觉尺度;
生成模块,用于根据所述第一移动轨迹和所述预设视觉尺度生成具有视觉尺度的至少一条第二移动轨迹;
获取模块,用于从数字地图中获取所述第一移动轨迹所在的位置区域内的预设道路轨迹;
第二确定模块,用于根据所述预设道路轨迹以及所述至少一条第二移动轨迹确定所述可移动设备的、具有视觉尺度的第三移动轨迹;
校正模块,用于根据所述第三移动轨迹的视觉尺度校正所述可移动设备移动时生成的地图。
10.一种电子设备,包括:
处理器;
存储器;以及
存储在所述存储器中的计算机程序指令,所述计算机程序指令在被所述处理器运行时使得所述处理器执行如权利要求1-8中任一项所述的方法。
11.一种计算机可读存储介质,其上存储有计算机程序指令,所述计算机程序指令在被处理器运行时使得所述处理器执行如权利要求1-8中任一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811163160.2A CN110967027B (zh) | 2018-09-30 | 2018-09-30 | 地图校正方法、装置和电子设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811163160.2A CN110967027B (zh) | 2018-09-30 | 2018-09-30 | 地图校正方法、装置和电子设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110967027A CN110967027A (zh) | 2020-04-07 |
CN110967027B true CN110967027B (zh) | 2021-12-03 |
Family
ID=70028318
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811163160.2A Active CN110967027B (zh) | 2018-09-30 | 2018-09-30 | 地图校正方法、装置和电子设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110967027B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114363821B (zh) * | 2020-09-30 | 2023-08-08 | 华为技术有限公司 | 轨迹纠偏方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5899954A (en) * | 1995-04-21 | 1999-05-04 | Xanavi Informatics Corporation | Current position calculating system having a function for correcting a distance factor |
CN101743454A (zh) * | 2007-05-16 | 2010-06-16 | 星克跃尔株式会社 | 匹配虚拟地图的方法及其系统 |
CN105976402A (zh) * | 2016-05-26 | 2016-09-28 | 同济大学 | 一种单目视觉里程计的真实尺度获取方法 |
CN107167130A (zh) * | 2017-05-18 | 2017-09-15 | 上海谦尊升网络科技有限公司 | 地图匹配定位方法及系统 |
CN107516326A (zh) * | 2017-07-14 | 2017-12-26 | 中国科学院计算技术研究所 | 融合单目视觉和编码器信息的机器人定位方法和系统 |
CN107860399A (zh) * | 2017-09-22 | 2018-03-30 | 北京机械设备研究所 | 一种基于地图匹配的车载捷联惯导行进间精对准方法 |
-
2018
- 2018-09-30 CN CN201811163160.2A patent/CN110967027B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5899954A (en) * | 1995-04-21 | 1999-05-04 | Xanavi Informatics Corporation | Current position calculating system having a function for correcting a distance factor |
CN101743454A (zh) * | 2007-05-16 | 2010-06-16 | 星克跃尔株式会社 | 匹配虚拟地图的方法及其系统 |
CN105976402A (zh) * | 2016-05-26 | 2016-09-28 | 同济大学 | 一种单目视觉里程计的真实尺度获取方法 |
CN107167130A (zh) * | 2017-05-18 | 2017-09-15 | 上海谦尊升网络科技有限公司 | 地图匹配定位方法及系统 |
CN107516326A (zh) * | 2017-07-14 | 2017-12-26 | 中国科学院计算技术研究所 | 融合单目视觉和编码器信息的机器人定位方法和系统 |
CN107860399A (zh) * | 2017-09-22 | 2018-03-30 | 北京机械设备研究所 | 一种基于地图匹配的车载捷联惯导行进间精对准方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110967027A (zh) | 2020-04-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6830139B2 (ja) | 3次元データの生成方法、3次元データの生成装置、コンピュータ機器及びコンピュータ読み取り可能な記憶媒体 | |
EP3627181A1 (en) | Multi-sensor calibration method, multi-sensor calibration device, computer device, medium and vehicle | |
CN109410735B (zh) | 反射值地图构建方法和装置 | |
CN109613543B (zh) | 激光点云数据的修正方法、装置、存储介质和电子设备 | |
US10875178B2 (en) | Motion target direction angle obtaining method, apparatus and robot using the same | |
US11363192B2 (en) | Method, and apparatus for clock synchronization, device, storage medium and vehicle | |
US11822340B2 (en) | Method and system for obstacle avoidance in robot path planning using depth sensors | |
JP2019145085A (ja) | 点群データ収集軌跡を調整するための方法、装置、およびコンピュータ読み取り可能な媒体 | |
JP2017526083A (ja) | 位置特定およびマッピングの装置ならびに方法 | |
CN110967027B (zh) | 地图校正方法、装置和电子设备 | |
US11034028B2 (en) | Pose determining method for mobile robot and apparatus and mobile robot thereof | |
JP2022130588A (ja) | 自動運転車両の位置合わせ方法、装置、電子機器及び車両 | |
CN112946612B (zh) | 外参标定方法、装置、电子设备及存储介质 | |
CN111275769B (zh) | 一种单目视觉参数的校正方法及装置 | |
CN110967990B (zh) | 轨迹确定方法、装置和电子设备 | |
CN111209353A (zh) | 一种视觉定位地图加载方法、装置、系统和存储介质 | |
CN111368860A (zh) | 重定位方法及终端设备 | |
CN111583338B (zh) | 用于无人设备的定位方法、装置、介质及无人设备 | |
CN112419739A (zh) | 车辆定位方法、装置和电子设备 | |
CN116734891A (zh) | 交会成像敏感器测量数据的有效性判断方法和装置 | |
CN114080626A (zh) | 确定第一图像区域在对应图像中的位置的方法、执行该方法的SoC和控制设备和系统以及计算机程序 | |
US20210201011A1 (en) | Data processing method for multi-sensor fusion, positioning apparatus and virtual reality device | |
KR102187112B1 (ko) | 성능 기반 확률 분석을 통한 탐색기 및 관성 측정기를 선정하는 장치 및 그 방법 | |
CN114299147A (zh) | 一种定位方法、装置、存储介质及电子设备 | |
CN111488419B (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 |