CN113538674A - 一种基于自主建图的路线检测方法、装置以及电子设备 - Google Patents
一种基于自主建图的路线检测方法、装置以及电子设备 Download PDFInfo
- Publication number
- CN113538674A CN113538674A CN202110728027.2A CN202110728027A CN113538674A CN 113538674 A CN113538674 A CN 113538674A CN 202110728027 A CN202110728027 A CN 202110728027A CN 113538674 A CN113538674 A CN 113538674A
- Authority
- CN
- China
- Prior art keywords
- track point
- detected
- curvature
- point
- track
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
- G06T17/05—Geographic models
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
-
- 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/30—Subject of image; Context of image processing
- G06T2207/30241—Trajectory
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Geometry (AREA)
- Software Systems (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Remote Sensing (AREA)
- Computer Graphics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Navigation (AREA)
Abstract
本发明实施例涉及自动驾驶技术领域,特别是涉及一种基于自主建图的路线检测方法、装置以及电子设备。该方法包括:获取待测轨迹点的曲率;获取与所述待测轨迹点相邻的第一轨迹点的曲率;获取与所述待测轨迹点相邻的第二轨迹点的曲率;根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分;判断所述待测轨迹点的得分是否大于预设值;若是,则确定所述待测轨迹点是跳变轨迹点;否则,确定所述待测轨迹点不是跳变轨迹点,通过所述基于自主建图的路线检测方法,可快速确定待测轨迹点是否为跳变轨迹点,方便后续对待测轨迹点的处理。
Description
技术领域
本发明实施例涉及自动驾驶技术领域,特别是涉及一种基于自主建图的路线检测方法、装置以及电子设备。
背景技术
随着社会科技的进步,自动驾驶汽车由于不需要人们驾驶车辆,因此,自动驾驶汽车成为近年来的研究热点。自动驾驶汽车在执行自动驾驶任务时需要一些信息的支持。打点地图是自主建图的一种,是一种轻量化的地图,打点地图能够表示各种自动驾驶任务中需要的信息。打点地图定义了一系列轨迹点的位置朝向、一些附加信息以及各个轨迹点间的连接关系。
在进行打点地图的轨迹点的采集形成路线时,容易因为采集轨迹点数据的采集车抖动、路上突遇不常见障碍物等的原因,从而导致打点地图的轨迹点出现较大跳变,形成跳变轨迹点的情况,这些跳变轨迹点需要被去掉或者被修正,从而保障打点地图的路线的准确性。
但是,在实现本发明实施例的过程中,发明人发现:目前,尚没有一种能够在打点地图中的各个轨迹点中检测出跳变轨迹点的方法。
发明内容
鉴于上述问题,本发明实施例提供了一种基于自主建图的路线检测方法、装置以及电子设备,克服了上述问题或者至少部分地解决了上述问题。
根据本发明实施例的一个方面,提供了一种基于自主建图的路线检测方法,包括:获取待测轨迹点的曲率;获取与所述待测轨迹点相邻的第一轨迹点的曲率;获取与所述待测轨迹点相邻的第二轨迹点的曲率;根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分;判断所述待测轨迹点的得分是否大于预设值;若是,则确定所述待测轨迹点是跳变轨迹点;否则,确定所述待测轨迹点不是跳变轨迹点。
在一种可选的方式中,所述获取待测轨迹点的曲率的步骤,进一步包括:拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程;根据所述轨迹方程,获取所述待测轨迹点的曲率。
在一种可选的方式中,所述拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程的步骤,进一步包括:获取所述待测轨迹点的横纵坐标;获取所述第二轨迹点的横纵坐标;获取所述第一轨迹点的横纵坐标;获取与所述第二轨迹点相邻的第三轨迹点的横纵坐标,其中,所述第三轨迹点远离所述待测轨迹点;根据所述待测轨迹点的横纵坐标、第二轨迹点的横纵坐标、第一轨迹点的横纵坐标和第三轨迹点的横纵坐标,拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程。
在一种可选的方式中,所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程为:
P(t)=A+Bt+Ct2+Dt3;
其中,所述t为参数,t∈[0,1];其中,所述A、B、C和D可根据四个约束条件求解;所述四个约束条件包括:t=0时,P(0)等于所述待测轨迹点的纵坐标;t=1时,P(1)等于所述第二轨迹点的纵坐标;t=0时,P′(0)等于第二轨迹点的纵坐标与第一轨迹点的纵坐标的差值,再乘以预设参数;t=1时,P′(1)等于第三轨迹点的纵坐标与待测轨迹点的纵坐标的差值,再乘以所述预设参数。
在一种可选的方式中,所述根据所述轨迹方程,获取所述待测轨迹点的曲率的步骤,进一步包括:获取所述待测轨迹点和第二轨迹点所在的曲线上的各个点的横坐标关于参数t的参数方程X(t);获取所述待测轨迹点和第二轨迹点所在的曲线上的各个点的纵坐标关于参数t的参数方程Y(t);所述待测轨迹点和第二轨迹点所在的曲线上的各个点的曲率公式为:
其中,t=0时,K(0)即为所述待测轨迹点的曲率。
在一种可选的方式中,所述根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分的公式为:
scorei=|Ki-Ki-1|+|Ki+1-Ki|;
其中,所述scorei为所述待测轨迹点的得分,所述Ki为所述待测轨迹点的曲率,所述Ki-1为所述第一轨迹点的曲率,所述Ki+1为所述第二轨迹点的曲率。
在一种可选的方式中,所述方法还包括:标记所述跳变轨迹点。
根据本发明实施例的一个方面,提供了一种基于自主建图的路线检测装置,包括:第一获取模块,用于获取待测轨迹点的曲率;第二获取模块,用于获取与所述待测轨迹点相邻的第一轨迹点的曲率;第三获取模块,用于获取与所述待测轨迹点相邻的第二轨迹点的曲率;计算模块,用于根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分;判断模块,用于判断所述待测轨迹点的得分是否大于预设值;第一确定模块,用于若所述待测轨迹点的得分大于所述预设值,则确定所述待测轨迹点是跳变轨迹点;第二确定模块,用于若所述待测轨迹点的得分不大于所述预设值,则确定所述待测轨迹点不是跳变轨迹点。
在一种可选的方式中,所述第一获取模块包括:拟合单元,用于拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程;获取单元,用于根据所述轨迹方程,获取所述待测轨迹点的曲率。
在一种可选的方式中,所述拟合单元具体用于:获取所述待测轨迹点的横纵坐标;获取所述第二轨迹点的横纵坐标;获取所述第一轨迹点的横纵坐标;获取与所述第二轨迹点相邻的第三轨迹点的横纵坐标,其中,所述第三轨迹点远离所述待测轨迹点;根据所述待测轨迹点的横纵坐标、第二轨迹点的横纵坐标、第一轨迹点的横纵坐标和第三轨迹点的横纵坐标,拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程。
在一种可选的方式中,所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程为:
P(t)=A+Bt+Ct2+Dt3;
其中,所述t为参数,t∈[0,1];其中,所述A、B、C和D可根据四个约束条件求解;所述四个约束条件包括:t=0时,P(0)等于所述待测轨迹点的纵坐标;t=1时,P(1)等于所述第二轨迹点的纵坐标;t=0时,P′(0)等于第二轨迹点的纵坐标与第一轨迹点的纵坐标的差值,再乘以预设参数;t=1时,P′(1)等于第三轨迹点的纵坐标与待测轨迹点的纵坐标的差值,再乘以所述预设参数。
在一种可选的方式中,所述获取单元具体用于:获取所述待测轨迹点和第二轨迹点所在的曲线上的各个点的横坐标关于参数t的参数方程X(t);获取所述待测轨迹点和第二轨迹点所在的曲线上的各个点的纵坐标关于参数t的参数方程Y(t);所述待测轨迹点和第二轨迹点所在的曲线上的各个点的曲率公式为:
其中,t=0时,K(0)即为所述待测轨迹点的曲率。
在一种可选的方式中,所述根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分的公式为:
scorei=|Ki-Ki-1|+|Ki+1-Ki|;
其中,所述scorei为所述待测轨迹点的得分,所述Ki为所述待测轨迹点的曲率,所述Ki-1为所述第一轨迹点的曲率,所述Ki+1为所述第二轨迹点的曲率。
在一种可选的方式中,所述装置还包括:标记模块,用于标记所述跳变轨迹点。
根据本发明实施例的一个方面,提供了一种电子设备,该电子设备包括:至少一个处理器,以及存储器,所述存储器与所述至少一个处理器通信连接,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行如上所述的方法。
根据本发明实施例的一个方面,提供了一种非易失性计算机可读存储介质,所述计算机可读存储介质存储有计算机可执行指令,当所述计算机可执行指令被电子设备执行时,使所述电子设备执行如上所述的方法。
本发明实施例的有益效果是:通过根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分,判断所述待测轨迹点的得分是否大于预设值,若是,则确定所述待测轨迹点是跳变轨迹点的方法,其中,所述待测轨迹点的得分表示所述待测轨迹点的曲率相对于与待测轨迹点相邻的第一轨迹点的曲率、第二轨迹点的曲率的变化情况,当所述待测轨迹点的得分大于预设值,则表示待测轨迹点的曲率相对于与待测轨迹点相邻的第一轨迹点的曲率、第二轨迹点的曲率的变化大,则确定所述待测轨迹点是跳变轨迹点,从而可方便快速的检测出跳变轨迹点,方便后续对跳变轨迹点的处理。
附图说明
一个或多个实施例通过与之对应的附图中的图片进行示例性说明,这些示例性说明并不构成对实施例的限定,附图中具有相同参考数字标号的元件表示为类似的元件,除非有特别申明,附图中的图不构成比例限制。
图1是本发明实施例提供的一种基于自主建图的路线检测方法的流程示意图;
图2是本发明实施例提供的一种获取待测轨迹点的曲率的流程示意图;
图3是本发明实施例提供的四个相邻的轨迹点的示意图;
图4是本发明实施例提供的一种基于自主建图的路线检测装置的示意图;
图5是本发明实施例提供的执行基于自主建图的路线检测方法的电子设备的硬件结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整的描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,当元件被表述“固定于”另一个元件,它可以直接在另一个元件上、或者其间可以存在一个或多个居中的元件。当一个元件被表述“连接”另一个元件,它可以是直接连接到另一个元件、或者其间可以存在一个或多个居中的元件。本说明书所使用的术语“垂直的”、“水平的”、“左”、“右”以及类似的表述只是为了说明的目的。
此外,下面所描述的本发明各个实施例中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
实施例一
请参阅图1,图1是本发明实施例提供的一种基于自主建图的路线检测方法的流程示意图,该方法包括以下步骤:
步骤S10,获取待测轨迹点的曲率。
其中,待测轨迹点可以是待检测打点地图中的任意一个轨迹点。本申请检测跳变轨迹点时,需要对待检测打点地图中的每个轨迹点分别进行检测。对于打点地图中的任意一个轨迹点,均可采用本申请提供的基于自主建图的路线检测方法,从而判断其是否为跳变轨迹点。
其中,曲率表示曲线的弯曲程度,对于特定的曲线,曲线上的各个点的曲率即可获得。
在一些实施例中,所述获取待测轨迹点的曲率的方法,具体的,请参阅图2,步骤S10包括一下步骤:
步骤S101,拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程。
在一些实施例中,所述第二轨迹点与所述待测轨迹点相邻。
请参阅图3,例如,P1为待测轨迹点,P2为第二轨迹点,则第二轨迹点P2为所述待测轨迹点P1后方的轨迹点。
在一些实施例中,在拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程的时候,需要用到相邻的四个轨迹点。请继续参阅图3,使用相邻的四个轨迹点P0、P1、P2和P3的横纵坐标,可以获得P1和P2两个轨迹点所述在的曲线的轨迹方程。令P1为待测轨迹点,P2为第二轨迹点,P0为第一轨迹点,第一轨迹点P0为所述待测轨迹点P1前方的轨迹点,P3为第三轨迹点,第三轨迹点P3为与所述第二轨迹点P2相邻的轨迹点,第三轨迹点P3远离待测轨迹点P1,通过第一轨迹点P0、待测轨迹点P1、第二轨迹点P2和第三轨迹点P3可实现步骤S101,即拟合处待测轨迹点和第二轨迹点所在的曲线的轨迹方程。
步骤S101具体包括:获取所述待测轨迹点的横纵坐标;获取所述第二轨迹点的横纵坐标;获取所述第一轨迹点的横纵坐标;获取与所述第二轨迹点相邻的第三轨迹点的横纵坐标,其中,所述第三轨迹点远离所述待测轨迹点;根据所述待测轨迹点的横纵坐标、第二轨迹点的横纵坐标、第一轨迹点的横纵坐标和第三轨迹点的横纵坐标,拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程。
其中,待测轨迹点的横纵坐标、第二轨迹点的横纵坐标、第一轨迹点的横纵坐标,以及第三轨迹点的横纵坐标在采集车采集数据时即已经获得。
所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程为:
P(t)=A+Bt+Ct2+Dt3;
其中,所述t为参数,t∈[0,1];其中,所述A、B、C和D可根据四个约束条件求解;所述四个约束条件包括:t=0时,P(0)等于所述待测轨迹点的纵坐标;t=1时,P(1)等于所述第二轨迹点的纵坐标;t=0时,P′(0)等于第二轨迹点的纵坐标与第一轨迹点的纵坐标的差值,再乘以预设参数;t=1时,P′(1)等于第三轨迹点的纵坐标与待测轨迹点的纵坐标的差值,再乘以所述预设参数。
其中,P′(0)为轨迹方程P(t)在t=0时的一阶导数。
其中,P′(1)为轨迹方程P(t)在t=1时的一阶导数。
其中,所述预设参数为s,s∈[0,1],所述s表示待测轨迹点和第二轨迹点所在的曲线的松紧程度,所述s越大,待测轨迹点和第二轨迹点所在的曲线越紧,所述s越小,待测轨迹点和第二轨迹点所在的曲线越松。
所述s的数值可根据实际情况进行选择,例如,可选择s为0.5。
通过上述四个约束条件,则可求解所述A、B、C和D,进而可求解所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程。
其中,P(t)∈R2,其中,R为实数域,R2表示P(t)所在的平面。
步骤S102,根据所述轨迹方程,获取所述待测轨迹点的曲率。
步骤S102具体包括:获取所述待测轨迹点和第二轨迹点所在的曲线上的各个点的横坐标关于参数t的参数方程X(t);获取所述待测轨迹点和第二轨迹点所在的曲线上的各个点的纵坐标关于参数t的参数方程Y(t);所述待测轨迹点和第二轨迹点所在的曲线上的各个点的曲率公式为:
其中,t=0时,K(0)即为所述待测轨迹点的曲率。
其中,所述X(t)为所述待测轨迹点和第二轨迹点所在的曲线上的各个点的横坐标关于参数t的参数方程,所述X(t)与参数t的一种可选的关系为:
其中,所述X1为所述待测轨迹点的横坐标,所述X2为所述第二轨迹点的横坐标,因此,所述X(t)的一种可选的公式为:
X(t)=(X2-X1)t+X1;
其中,所述Y(t)为所述待测轨迹点和第二轨迹点所在的曲线上的各个点的纵坐标关于参数t的参数方程,所述X(t)与参数t的一种可选的关系为:
Y(t)=P(t)。
其中,X′(t)为参数方程X(t)的一阶导数,X″(t)为参数方程X(t)的二阶导数,Y′(t)为参数方程Y(t)的一阶导数,Y″(t)为参数方程Y(t)的二阶导数。
步骤S20,获取与所述待测轨迹点相邻的第一轨迹点的曲率。
获取第一轨迹点的曲率时,可根据第一轨迹点前方的一个轨迹点的横纵坐标、第一轨迹点的横纵坐标、待测轨迹点的横纵坐标以及第二轨迹点的横纵坐标获得,具体的方法可参考步骤S10中待测轨迹点的曲率的获取方法,此处不再赘述。
步骤S30,获取与所述待测轨迹点相邻的第二轨迹点的曲率。
获取第二轨迹点的曲率时,可根据待测轨迹点的横纵坐标、第二轨迹点的横纵坐标、第三轨迹点的横纵坐标以及第三轨迹点后方的另一个轨迹点的横纵坐标获得,具体的方法可参考步骤S10中待测轨迹点的曲率的获取方法,此处不再赘述。
步骤S40,根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分。
待测轨迹点的得分表示待测轨迹点的曲率相对于与待测轨迹点相邻的第一轨迹点的曲率、第二轨迹点的曲率的变化情况。
在一些实施例中,所述根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分的公式为:
scorei=|Ki-Ki-1|+|Ki+1-Ki|;
其中,所述scorei为所述待测轨迹点的得分,所述Ki为所述待测轨迹点的曲率,所述Ki-1为所述第一轨迹点的曲率,所述Ki+1为所述第二轨迹点的曲率。
可以理解的是,计算所述待测轨迹点的得分的公式不限于上述形式,还是可以是其他形式,例如,
其中,所述scorei为所述待测轨迹点的得分,所述Ki为所述待测轨迹点的曲率,所述Ki-1和Ki+1分别为与所述待测轨迹点相邻的两个轨迹点的曲率,在本申请中,所述Ki-1为所述第一轨迹点的曲率,所述Ki+1为所述第二轨迹点的曲率。
步骤S50,判断所述待测轨迹点的得分是否大于预设值,若是,则执行步骤S60,否则,执行步骤S70。
由于曲率表示的是曲线的弯曲程度,在理想的情况下,即待测轨迹点,与待测轨迹点相邻的第一轨迹点和第二轨迹点均不是跳变轨迹点的情况下,待测轨迹点的曲率、第一轨迹点的曲率和第二轨迹点的曲率相差不大,若表示待测轨迹点的曲率相对于与待测轨迹点相邻的第一轨迹点的曲率、第二轨迹点的曲率的变化情况的待测轨迹点的得分大于预设值,则说明待测轨迹点为跳变轨迹点,否则确定待测轨迹点不是跳变轨迹点。
其中,预设值可根据实际情况进行选择,例如,预设值可选择为1。或者,在对打点地图中的轨迹点的要求比较高时,可将预设值设置的小一些,例如,预设值可选择为0.2。或者,在对打点地图中的轨迹点的要求不高时,可将预设值设置的大一些,例如,预设值可选择为1.2。
步骤S60,确定所述待测轨迹点是跳变轨迹点。
在一些实施例中,在确定处所述待测轨迹点是跳变轨迹点时,可标记所述跳变轨迹点,从而方便后续对跳变轨迹点的剔除或修正等。
步骤S70,确定所述待测轨迹点不是跳变轨迹点。
在本发明实施例中,通过获取待测轨迹点的曲率;获取与所述待测轨迹点相邻的第一轨迹点的曲率;获取与所述待测轨迹点相邻的第二轨迹点的曲率;根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分;判断所述待测轨迹点的得分是否大于预设值;若是,则确定所述待测轨迹点是跳变轨迹点;否则,确定所述待测轨迹点不是跳变轨迹点,通过所述基于自主建图的路线检测方法,可快速确定待测轨迹点是否为跳变轨迹点,方便后续对待测轨迹点的处理。
实施例二
请参阅图4,图4是本发明实施例提供的一种基于自主建图的路线检测装置的示意图,该装置400包括:第一获取模块401,用于获取待测轨迹点的曲率;第二获取模块402,用于获取与所述待测轨迹点相邻的第一轨迹点的曲率;第三获取模块403,用于获取与所述待测轨迹点相邻的第二轨迹点的曲率;计算模块404,用于根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分;判断模块405,用于判断所述待测轨迹点的得分是否大于预设值;第一确定模块406,用于若所述待测轨迹点的得分大于所述预设值,则确定所述待测轨迹点是跳变轨迹点;第二确定模块407,用于若所述待测轨迹点的得分不大于所述预设值,则确定所述待测轨迹点不是跳变轨迹点。
在一些实施例中,所述第一获取模块401包括:拟合单元4011,用于拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程;获取单元4012,用于根据所述轨迹方程,获取所述待测轨迹点的曲率。
在一些实施例中,所述拟合单元4011具体用于:获取所述待测轨迹点的横纵坐标;获取所述第二轨迹点的横纵坐标;获取所述第一轨迹点的横纵坐标;获取与所述第二轨迹点相邻的第三轨迹点的横纵坐标,其中,所述第三轨迹点远离所述待测轨迹点;根据所述待测轨迹点的横纵坐标、第二轨迹点的横纵坐标、第一轨迹点的横纵坐标和第三轨迹点的横纵坐标,拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程。
在一些实施例中,所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程为:
P(t)=A+Bt+Ct2+Dt3;
其中,所述t为参数,t∈[0,1];其中,所述A、B、C和D可根据四个约束条件求解;所述四个约束条件包括:t=0时,P(0)等于所述待测轨迹点的纵坐标;t=1时,P(1)等于所述第二轨迹点的纵坐标;t=0时,P′(0)等于第二轨迹点的纵坐标与第一轨迹点的纵坐标的差值,再乘以预设参数;t=1时,P′(1)等于第三轨迹点的纵坐标与待测轨迹点的纵坐标的差值,再乘以所述预设参数。
在一些实施例中,所述获取单元4012具体用于:获取所述待测轨迹点和第二轨迹点所在的曲线上的各个点的横坐标关于参数t的参数方程X(t);获取所述待测轨迹点和第二轨迹点所在的曲线上的各个点的纵坐标关于参数t的参数方程Y(t);所述待测轨迹点和第二轨迹点所在的曲线上的各个点的曲率公式为:
其中,t=0时,K(0)即为所述待测轨迹点的曲率。
在一些实施例中,所述根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分的公式为:
scorei=|Ki-Ki-1|+|Ki+1-Ki|;
其中,所述scorei为所述待测轨迹点的得分,所述Ki为所述待测轨迹点的曲率,所述Ki-1为所述第一轨迹点的曲率,所述Ki+1为所述第二轨迹点的曲率。
在一些实施例中,所述装置400还包括:标记模块408,用于标记所述跳变轨迹点。
在本发明实施例中,通过第一获取模块401获取待测轨迹点的曲率,第二获取模块402获取与所述待测轨迹点相邻的第一轨迹点的曲率,第三获取模块403获取与所述待测轨迹点相邻的第二轨迹点的曲率,计算模块404根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分,判断模块405判断所述待测轨迹点的得分是否大于预设值,若所述待测轨迹点的得分大于所述预设值,则通过第一确定模块406确定所述待测轨迹点是跳变轨迹点,若所述待测轨迹点的得分不大于所述预设值,则通过第二确定模块407确定所述待测轨迹点不是跳变轨迹点,可快速确定待测轨迹点是否为跳变轨迹点,方便后续对待测轨迹点的处理。
实施例三
请参阅图5,图5是是本发明实施例提供的执行基于自主建图的路线检测方法的电子设备的硬件结构示意图。该电子设备50包括:一个或多个处理器51以及存储器52,图5中以一个存储器为例。
处理器51和存储器52可以通过总线或者其他方式连接,本发明实施例中以通过总线连接为例。
存储器52作为一种非易失性计算机可读存储介质,可用于存储非易失性软件程序、非易失性计算机可执行程序以及模块,如本发明实施例中的基于自主建图的路线检测方法对应的程序指令/模块(例如,附图4所示的各个模块)。处理器51通过运行存储在存储器52中的非易失性软件程序、指令以及模块,从而执行基于自主建图的路线检测装置的各种功能应用以及数据处理,即实现上述方法实施例的基于自主建图的路线检测方法。
存储器52可以包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需要的应用程序;存储数据区可存储根据基于自主建图的路线检测装置的使用所创建的数据等。此外,存储器52可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件。在一些实施例中,存储器52可选包括相对于处理器51远程设置的存储器,这些远程存储器可以通过网络连接至检测跳变轨迹点装置。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
所述一个或者多个模块存储在所述存储器52中,当被所述一个或者多个处理器51执行时,执行上述任意方法实施例中的基于自主建图的路线检测方法。
上述产品可执行本发明实施例所提供的方法,具备执行方法相应的功能模块和有益效果。未在本实施例中详尽描述的技术细节,可参见本发明实施例所提供的方法。
本发明实施例提供了一种非易失性计算机可读存储介质,所述非易失性计算机可读存储介质存储有计算机可执行指令,该计算机可执行指令被电子设备执行上述任意方法实施例中的基于自主建图的路线检测方法。
本发明实施例提供了一种计算机程序产品,包括存储在非易失性计算机可读存储介质上的计算程序,所述计算机程序包括程序指令,当所述程序指令被计算机执行时时,使所述计算机执行上述任意方法实施例中的基于自主建图的路线检测方法。
以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。
通过以上的实施方式的描述,本领域普通技术人员可以清楚地了解到各实施方式可借助软件加通用硬件平台的方式来实现,当然也可以通过硬件来实现。本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random Access Memory,RAM)等。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;在本发明的思路下,以上实施例或者不同实施例中的技术特征之间也可以进行组合,步骤可以以任意顺序实现,并存在如上所述的本发明的不同方面的许多其它变化,为了简明,它们没有在细节中提供;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (10)
1.一种基于自主建图的路线检测方法,其特征在于,包括:
获取待测轨迹点的曲率;
获取与所述待测轨迹点相邻的第一轨迹点的曲率;
获取与所述待测轨迹点相邻的第二轨迹点的曲率;
根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分;
判断所述待测轨迹点的得分是否大于预设值;
若是,则确定所述待测轨迹点是跳变轨迹点;
否则,确定所述待测轨迹点不是跳变轨迹点。
2.根据权利要求1所述的方法,其特征在于,所述获取待测轨迹点的曲率的步骤,进一步包括:
拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程;
根据所述轨迹方程,获取所述待测轨迹点的曲率。
3.根据权利要求2所述的方法,其特征在于,所述拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程的步骤,进一步包括:
获取所述待测轨迹点的横纵坐标;
获取所述第二轨迹点的横纵坐标;
获取所述第一轨迹点的横纵坐标;
获取与所述第二轨迹点相邻的第三轨迹点的横纵坐标,其中,所述第三轨迹点远离所述待测轨迹点;
根据所述待测轨迹点的横纵坐标、第二轨迹点的横纵坐标、第一轨迹点的横纵坐标和第三轨迹点的横纵坐标,拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程。
4.根据权利要求3所述的方法,其特征在于,所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程为:
P(t)=A+Bt+Ct2+Dt3;
其中,所述t为参数,t∈[0,1];
其中,所述A、B、C和D可根据四个约束条件求解;
所述四个约束条件包括:
t=0时,P(0)等于所述待测轨迹点的纵坐标;
t=1时,P(1)等于所述第二轨迹点的纵坐标;
t=0时,P′(0)等于第二轨迹点的纵坐标与第一轨迹点的纵坐标的差值,再乘以预设参数;
t=1时,P′(1)等于第三轨迹点的纵坐标与待测轨迹点的纵坐标的差值,再乘以所述预设参数。
6.根据权利要求1-5任意一项所述的方法,其特征在于,所述根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分的公式为:
scorei=|Ki-Ki-1|+|Ki+1-Ki|;
其中,所述scorei为所述待测轨迹点的得分,所述Ki为所述待测轨迹点的曲率,所述Ki-1为所述第一轨迹点的曲率,所述Ki+1为所述第二轨迹点的曲率。
7.根据权利要求1-5任意一项所述的方法,其特征在于,所述方法还包括:标记所述跳变轨迹点。
8.一种基于自主建图的路线检测装置,其特征在于,包括:
第一获取模块,用于获取待测轨迹点的曲率;
第二获取模块,用于获取与所述待测轨迹点相邻的第一轨迹点的曲率;
第三获取模块,用于获取与所述待测轨迹点相邻的第二轨迹点的曲率;
计算模块,用于根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分;
判断模块,用于判断所述待测轨迹点的得分是否大于预设值;
第一确定模块,用于若所述待测轨迹点的得分大于所述预设值,则确定所述待测轨迹点是跳变轨迹点;
第二确定模块,用于若所述待测轨迹点的得分不大于所述预设值,则确定所述待测轨迹点不是跳变轨迹点。
9.一种电子设备,其特征在于,包括:
至少一个处理器;以及
存储器,所述存储器与所述至少一个处理器通信连接,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行权利要求1-7中任一项所述的方法。
10.一种非易失性计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机可执行指令,当所述计算机可执行指令被电子设备执行时,使所述电子设备执行权利要求1-7中任一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110728027.2A CN113538674A (zh) | 2021-06-29 | 2021-06-29 | 一种基于自主建图的路线检测方法、装置以及电子设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110728027.2A CN113538674A (zh) | 2021-06-29 | 2021-06-29 | 一种基于自主建图的路线检测方法、装置以及电子设备 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113538674A true CN113538674A (zh) | 2021-10-22 |
Family
ID=78126195
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110728027.2A Pending CN113538674A (zh) | 2021-06-29 | 2021-06-29 | 一种基于自主建图的路线检测方法、装置以及电子设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113538674A (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108242145A (zh) * | 2016-12-26 | 2018-07-03 | 高德软件有限公司 | 异常轨迹点检测方法和装置 |
CN109033176A (zh) * | 2018-06-25 | 2018-12-18 | 腾讯科技(深圳)有限公司 | 道路曲率的确定方法、装置、存储介质和计算机设备 |
CN112764415A (zh) * | 2019-11-05 | 2021-05-07 | 北京新能源汽车股份有限公司 | 一种生成自动驾驶规划轨迹的方法、装置及汽车 |
-
2021
- 2021-06-29 CN CN202110728027.2A patent/CN113538674A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108242145A (zh) * | 2016-12-26 | 2018-07-03 | 高德软件有限公司 | 异常轨迹点检测方法和装置 |
CN109033176A (zh) * | 2018-06-25 | 2018-12-18 | 腾讯科技(深圳)有限公司 | 道路曲率的确定方法、装置、存储介质和计算机设备 |
CN112764415A (zh) * | 2019-11-05 | 2021-05-07 | 北京新能源汽车股份有限公司 | 一种生成自动驾驶规划轨迹的方法、装置及汽车 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111009153B (zh) | 一种轨迹预测模型的训练方法、装置和设备 | |
JP6538547B2 (ja) | 道路曲率計測装置 | |
KR20220115796A (ko) | 정상 상태 횡방향 편차 제거 방법, 장치 및 저장 매체 | |
CN110287828B (zh) | 信号灯的检测方法、装置及电子设备 | |
CN110466505B (zh) | 自动垂直泊车方法、介质、设备及装置 | |
JP2018036067A (ja) | 自車位置認識装置 | |
CN112257698B (zh) | 环视图车位检测结果的处理方法、装置、设备和存储介质 | |
CN111376895A (zh) | 一种环视泊车感知方法、装置、自动泊车系统和车辆 | |
CN110341621B (zh) | 一种障碍物检测方法及装置 | |
CN111750881A (zh) | 一种基于路灯杆的车辆位姿的修正方法和装置 | |
CN114280582A (zh) | 激光雷达的标定校准方法、装置、存储介质及电子设备 | |
CN106228531B (zh) | 基于地平线搜索的自动灭点标定方法及系统 | |
CN112348035A (zh) | 车辆关键点检测方法、装置及电子设备 | |
CN114754761A (zh) | 高精地图车道线的优化方法、装置及电子设备、存储介质 | |
CN112902911B (zh) | 基于单目相机的测距方法、装置、设备及存储介质 | |
CN113538674A (zh) | 一种基于自主建图的路线检测方法、装置以及电子设备 | |
CN109710594B (zh) | 地图数据的有效性判断方法、装置及可读存储介质 | |
JP5559650B2 (ja) | 車線推定装置 | |
CN108120450B (zh) | 一种静止状态的判断方法及装置 | |
CN112330977B (zh) | 一种自动泊车的方法和装置 | |
CN112277934B (zh) | 一种自动泊车的方法和装置 | |
CN115507815A (zh) | 一种目标测距方法、装置及车辆 | |
CN113566837A (zh) | 一种基于自主建图的路线修正方法、装置以及电子设备 | |
JP4225242B2 (ja) | 走行路認識装置 | |
CN113643359A (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 |