CN110717141B - 一种车道线优化方法、装置及存储介质 - Google Patents
一种车道线优化方法、装置及存储介质 Download PDFInfo
- Publication number
- CN110717141B CN110717141B CN201910896234.1A CN201910896234A CN110717141B CN 110717141 B CN110717141 B CN 110717141B CN 201910896234 A CN201910896234 A CN 201910896234A CN 110717141 B CN110717141 B CN 110717141B
- Authority
- CN
- China
- Prior art keywords
- lane line
- differential
- original
- model
- optimization
- 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
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/588—Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Theoretical Computer Science (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Data Mining & Analysis (AREA)
- Computational Mathematics (AREA)
- Operations Research (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Multimedia (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
本发明提供一种车道线优化方法、装置及存储介质。该方法包括:获取原始车道线,对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型;将所述差分模型代入泰勒公式中,求取车道线的观测方程;基于车道线前后位置的观测方程通过BA图优化算法优化车道线参数。通过该方案解决传统优化算法优化效率低的问题,提升优化效率,并保证提高原始车道线精度。
Description
技术领域
本发明涉及数据处理领域,尤其涉及一种车道线优化方法、装置及存储介质。
背景技术
自动驾驶中的高精度地图制作是实现自动驾驶中的必要前提,在当前大数据应用的环境下,众包更新进行高精度地图制作将成为后续主要发展方向。由于众包数据中车道线精度不一,为精度要求要达到自动驾驶的标准,需要对车道线进行优化。
目前,针对众包采集的的车道线数据,通常会基于相机参数或以交通标志为参考物,通过既定的优化算法对车道线进行优化或重构,此方法可以较好的对车道线进行优化重绘,但对于由众包车采集得到大量车道线数据,现有的优化算法难以满足速度要求,优化处理效率较低。
发明内容
有鉴于此,本发明实施例提供了一种车道线优化方法、装置及存储介质,以解决现有优化算法获取并优化车道线效率较低的问题。
在本发明实施例的第一方面,提供了一种车道线优化方法,包括:
获取原始车道线,对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型;
将所述差分模型代入泰勒公式中,求取车道线的观测方程;
基于车道线前后位置的观测方程通过BA图优化算法优化车道线参数。
在本发明实施例的第二方面,提供了一种装置,包括:
构建模块,用于获取原始车道线,对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型;
计算模块,用于将所述差分模型代入泰勒公式中,求取车道线的观测方程;
优化模块,用于基于车道线前后位置的观测方程通过BA图优化算法优化车道线参数。
在本发明实施例的第三方面,提供了一种装置,包括存储器、处理器以及存储在所述存储器中并可在所述处理器运行的计算机程序,所述处理器执行所述计算机程序时实现如本发明实施例第一方面所述方法的步骤。
在本发明实施例的第四方面,提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现本发明实施例第一方面提供的所述方法的步骤。
本发明实施例中,对原始车道线参数化后,建立差分方程,基于差分方程和泰勒方程,求取观测方程,基于车道线当前位置对下一位置的观测,通过BA图优化算法优化车道线。解决了传统车道线优化算法优化效率较低的问题,根据构建的观测方程及BA图优化,可以对大量级的车道线数据进行优化,提升车道线精度,同时保障优化效率,具有较强实用性。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单介绍,显而易见地,下面描述的附图仅仅是本发明的一些实施例,对本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获取其他附图。
图1为本发明实施例一提供的车道线优化方法的流程示意图;
图2为本发明实施例二提供的车道线优化装置的结构示意图;
具体实施方式
为使得本发明的发明目的、特征、优点能够更加的明显和易懂,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,下面所描述的实施例仅仅是本发明一部分实施例,而非全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
实施例一:
请参阅图1,本发明实施例提供的一种车道线优化方法的流程示意图,包括:
S101、获取原始车道线,对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型;
所述原始车道线为从采集车辆采集的众包数据中提取的车道线数据,一般为基于车道线图像提取的车道线,在所述原始车道线中基于车道线采集位置及采集车辆航向角,可以建立车道线的平面坐标系,计算车道线方向角。
优选的,对所述原始车道线分类并序列化,得到具有预定顺序的原始车道线。收集同一区域的车道线,对各车道线分类,并以此编号排序,排序可以可根据车道线采集时间或车道线位置,或其他可以对车道线序列化的排列方法,在此不作限定。
对所述原始车道线参数化,简化为一个向量,示例性的,车道线向量包括起点坐标(xs,ys)、终点坐标(xe,ye)、车道线方向角θ,取车道线向量的中点及tan(θ)表示车道线。
可选的,分别设定k-1时车道线位置为(xk-1,yk-1)、设定k时车道线位置为(xk,yk)、设定k+1时车道线位置为(xk+1,yk+1);
根据k到k+1时刻的车道线位置变化,建立n阶前差分模型为:
根据k到k-1时刻的车道线位置变化,建立n阶后差分模型为:
根据k-1到k+1时刻的车道线位置变化,建立n阶中心差分模型为:
S102、将所述差分模型代入泰勒公式中,求取车道线的观测方程;
所述泰勒公式,可以用以一个函数在某点的信息,描述该点附近取值的信息,一般n阶泰勒公式形式为:
观测量设为平面坐标系y轴上坐标位置,将差分模型公式代入泰勒公式中,根据泰勒级数对应的几级求导,可以得到不同阶的车道线观测方程。
S103、基于车道线前后位置的观测方程通过BA图优化算法优化车道线参数。
所述BA(bundle adjustment)图优化算法,即光束平差法(或称束调整、捆集调整),用于减少观测图像的点和参考图像的点之间位置投影变换误差。通过BA算法,在图优化的基础上,基于观测值与预测值的误差,对车道线待优化变量(x,y,θ)进行优化。
具体的,根据当前车道线采集位置对下一车道线采集位置的观测,建立观测方程;通过BA图优化算法建立图优化模型后,通过非线性最小二乘法得到优化参数变量。
本实施例提供的方法,建立差分方程并代入泰勒公式,得到车道线当前位置对不同位置的观测方程,进而利用BA图优化算法优化车道线参数。该方法基于建立的优化模型,可以对大量的车道线进行优化,保障效率与准确度。
应理解,上述实施例中各步骤的序号大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本发明实施例的实施过程构成任何限定,
实施例二:
图2为本发明实施例二提供的一种车道线优化装置的结构示意图,该装置包括:
构建模块210,用于获取原始车道线,对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型;
可选的,所述构建模块210还包括:
预处理模块,用于对所述原始车道线分类并序列化,得到具有预定顺序的原始车道线。
计算模块220,用于将所述差分模型代入泰勒公式中,求取车道线的观测方程;
可选的,所述对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型包括:
分别设定k-1时车道线位置为(xk-1,yk-1)、设定k时车道线位置为(xk,yk)、设定k+1时车道线位置为(xk+1,yk+1);
根据k到k+1时刻的车道线位置变化,建立n阶前差分模型为:
根据k到k-1时刻的车道线位置变化,建立n阶后差分模型为:
根据k-1到k+1时刻的车道线位置变化,建立n阶中心差分模型为:
优化模块230,用于基于车道线前后位置的观测方程通过BA图优化算法优化车道线参数。
可选的,所述优化模块230还包括:
建立单元,用于根据当前车道线采集位置对下一车道线采集位置的观测,建立观测方程;
求解单元,用于通过BA图优化算法建立图优化模型后,通过非线性最小二乘法得到优化参数变量。
通过本实施例的装置,利用构建模块、计算模块及优化模块相互配合,可以提升车道线优化效率,解决传统优化算法效率低的问题。
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述或记载的部分,可以参见其它实施例的相关描述。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,所述的程序可以存储于一计算机可读取存储介质中,该程序在执行时,包括步骤S101至S103,所述的存储介质包括如:ROM/RAM、磁碟、光盘等。
以上所述,以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (8)
1.一种车道线优化方法,其特征在于,包括:
获取原始车道线,对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型;
其中,所述对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型包括:
分别设定k-1时车道线位置为(xk-1,yk-1)、设定k时车道线位置为(xk,yk)、设定k+1时车道线位置为(xk+1,yk+1);
根据k到k+1时刻的车道线位置变化,建立n阶前差分模型为:
根据k到k-1时刻的车道线位置变化,建立n阶后差分模型为:
根据k-1到k+1时刻的车道线位置变化,建立n阶中心差分模型为:
将所述差分模型代入泰勒公式中,求取车道线的观测方程;
其中,将观测量设为平面坐标系y轴上坐标位置,将差分模型公式代入泰勒公式中,根据泰勒级数对应的几级求导,得到不同阶的车道线观测方程;
基于车道线前后位置的观测方程通过BA图优化算法优化车道线参数。
2.根据权利要求1所述的方法,其特征在于,所述获取原始车道线,对所述原始车道线参数化还包括:
对所述原始车道线分类并序列化,得到具有预定顺序的原始车道线。
3.根据权利要求1所述的方法,其特征在于,所述基于车道线前后位置的观测值通过BA图优化算法优化车道线参数包括:
根据当前车道线采集位置对下一车道线采集位置的观测,建立观测方程;
通过BA图优化算法建立图优化模型后,通过非线性最小二乘法得到优化参数变量。
4.一种车道线优化装置,其特征在于,包括:
构建模块,用于获取原始车道线,对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型;
其中,所述对所述原始车道线参数化,并分别建立所述原始车道线的前差分、后差分及中心差分的差分模型包括:
分别设定k-1时车道线位置为(xk-1,yk-1)、设定k时车道线位置为(xk,yk)、设定k+1时车道线位置为(xk+1,yk+1);
根据k到k+1时刻的车道线位置变化,建立n阶前差分模型为:
根据k到k-1时刻的车道线位置变化,建立n阶后差分模型为:
根据k-1到k+1时刻的车道线位置变化,建立n阶中心差分模型为:
计算模块,用于将所述差分模型代入泰勒公式中,求取车道线的观测方程;
其中,将观测量设为平面坐标系y轴上坐标位置,将差分模型公式代入泰勒公式中,根据泰勒级数对应的几级求导,得到不同阶的车道线观测方程;
优化模块,用于基于车道线前后位置的观测方程通过BA图优化算法优化车道线参数。
5.根据权利要求4所述的装置,其特征在于,所述构建模块还包括:
预处理模块,用于对所述原始车道线分类并序列化,得到具有预定顺序的原始车道线。
6.根据权利要求4所述的装置,其特征在于,所述优化模块还包括:
建立单元,用于根据当前车道线采集位置对下一车道线采集位置的观测,建立观测方程;
求解单元,用于通过BA图优化算法建立图优化模型后,通过求解最小二乘法得到优化参数变量。
7.一种设备,还包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至3中任一项所述车道线优化方法的步骤。
8.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至3任一项所述车道线优化方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910896234.1A CN110717141B (zh) | 2019-09-22 | 2019-09-22 | 一种车道线优化方法、装置及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910896234.1A CN110717141B (zh) | 2019-09-22 | 2019-09-22 | 一种车道线优化方法、装置及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110717141A CN110717141A (zh) | 2020-01-21 |
CN110717141B true CN110717141B (zh) | 2023-08-04 |
Family
ID=69210713
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910896234.1A Active CN110717141B (zh) | 2019-09-22 | 2019-09-22 | 一种车道线优化方法、装置及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110717141B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112507857B (zh) * | 2020-12-03 | 2022-03-15 | 腾讯科技(深圳)有限公司 | 一种车道线更新方法、装置、设备及存储介质 |
CN113435427B (zh) * | 2021-08-27 | 2021-11-09 | 湖北亿咖通科技有限公司 | 车道线的聚合方法和装置 |
CN116580373B (zh) * | 2023-07-11 | 2023-09-26 | 广汽埃安新能源汽车股份有限公司 | 一种车道线优化方法、装置、电子设备和存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102722705A (zh) * | 2012-06-12 | 2012-10-10 | 武汉大学 | 一种基于ransac算法的多车道线检测方法 |
CN106023611A (zh) * | 2016-06-20 | 2016-10-12 | 大连理工大学 | 一种两段式干线协调信号控制优化方法 |
JP2017043279A (ja) * | 2015-08-28 | 2017-03-02 | 株式会社デンソー | 車両制御装置、及び走路信頼度判定方法 |
CN109117866A (zh) * | 2018-07-17 | 2019-01-01 | 芯启源(南京)半导体科技有限公司 | 车道识别算法评估方法、计算机设备及存储介质 |
CN109916416A (zh) * | 2019-01-29 | 2019-06-21 | 腾讯科技(深圳)有限公司 | 车道线数据处理与更新方法、装置及设备 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7171343B2 (en) * | 2002-07-16 | 2007-01-30 | Sun Microsystems, Inc. | Computing interval parameter bounds from fallible measurements using systems of nonlinear equations |
US8776002B2 (en) * | 2011-09-06 | 2014-07-08 | Variable Z0, Ltd. | Variable Z0 antenna device design system and method |
US10885467B2 (en) * | 2016-04-28 | 2021-01-05 | Qualcomm Incorporated | Differentially private iteratively reweighted least squares |
-
2019
- 2019-09-22 CN CN201910896234.1A patent/CN110717141B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102722705A (zh) * | 2012-06-12 | 2012-10-10 | 武汉大学 | 一种基于ransac算法的多车道线检测方法 |
JP2017043279A (ja) * | 2015-08-28 | 2017-03-02 | 株式会社デンソー | 車両制御装置、及び走路信頼度判定方法 |
CN106023611A (zh) * | 2016-06-20 | 2016-10-12 | 大连理工大学 | 一种两段式干线协调信号控制优化方法 |
CN109117866A (zh) * | 2018-07-17 | 2019-01-01 | 芯启源(南京)半导体科技有限公司 | 车道识别算法评估方法、计算机设备及存储介质 |
CN109916416A (zh) * | 2019-01-29 | 2019-06-21 | 腾讯科技(深圳)有限公司 | 车道线数据处理与更新方法、装置及设备 |
Non-Patent Citations (1)
Title |
---|
张亚岐 ; 周辰雨 ; 李健 ; .车辆识别技术.北京汽车.2012,(第04期),第18-21页. * |
Also Published As
Publication number | Publication date |
---|---|
CN110717141A (zh) | 2020-01-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110717141B (zh) | 一种车道线优化方法、装置及存储介质 | |
CN108871353B (zh) | 路网地图生成方法、系统、设备及存储介质 | |
CN108279670B (zh) | 用于调整点云数据采集轨迹的方法、设备以及计算机可读介质 | |
CN106908052B (zh) | 用于智能机器人的路径规划方法及装置 | |
CN113377888B (zh) | 训练目标检测模型和检测目标的方法 | |
CN112086010B (zh) | 地图生成方法、装置、设备及存储介质 | |
CN110543473B (zh) | 一种众包数据融合优化方法、装置及存储介质 | |
WO2022213632A1 (zh) | 用于标定毫米波雷达的方法、装置、电子设备及路侧设备 | |
CN112198878B (zh) | 一种即时地图构建方法、装置、机器人及存储介质 | |
CN110782774A (zh) | 一种众包道路数据的分布式处理方法及装置 | |
CN112861595A (zh) | 数据点的识别方法、装置和计算机可读存储介质 | |
JP7145770B2 (ja) | 車間距離測定装置、誤差モデル生成装置および学習モデル生成装置とこれらの方法およびプログラム | |
CN115097419A (zh) | 一种激光雷达到imu的外参标定方法及装置 | |
CN110927743A (zh) | 一种基于多线激光点云极化表征的智能车定位方法 | |
CN114387410A (zh) | 道路数据融合的地图生成方法、装置以及电子设备 | |
CN114170188A (zh) | 一种俯视图像的目标计数方法、系统及存储介质 | |
CN111260722B (zh) | 车辆定位方法、设备及存储介质 | |
CN112733971A (zh) | 扫描设备的位姿确定方法、装置、设备及存储介质 | |
US11792514B2 (en) | Method and apparatus for stabilizing image, roadside device and cloud control platform | |
CN115937449A (zh) | 高精地图生成方法、装置、电子设备和存储介质 | |
CN111736137B (zh) | LiDAR外部参数标定方法、系统、计算机设备及可读存储介质 | |
CN116188587A (zh) | 定位方法、装置及车辆 | |
CN111462321B (zh) | 点云地图处理方法、处理装置、电子装置和车辆 | |
CN114064680A (zh) | 一种语义地图增量更新方法及系统 | |
CN114299192A (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 |