CN115201773B - 基于点云速度的车载毫米波雷达安装角度误差校正方法 - Google Patents
基于点云速度的车载毫米波雷达安装角度误差校正方法 Download PDFInfo
- Publication number
- CN115201773B CN115201773B CN202211108403.9A CN202211108403A CN115201773B CN 115201773 B CN115201773 B CN 115201773B CN 202211108403 A CN202211108403 A CN 202211108403A CN 115201773 B CN115201773 B CN 115201773B
- Authority
- CN
- China
- Prior art keywords
- theta
- point cloud
- speed
- radar
- installation angle
- 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
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/40—Means for monitoring or calibrating
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
Description
技术领域
本发明属于雷达技术领域,尤其涉及基于点云速度的车载毫米波雷达安装角度误差校正方法。
背景技术
当前车载毫米波雷达安装角度误差的校准方式主要有如下2种:公开号CN113702929A与公开号CN113702930A的中国专利申请使用的方法,该方法在特定环境下(如存在呈一条直线的护栏),将雷达探测到的特定目标来拟合成一条直线,通过直线的斜率来计算实际安装角度。此方法依赖于特定环境,如果环境中不存在呈一条直线的目标,或存在这类目标但被道路上的其他车辆遮挡,将难以发挥作用。公开号CN111624566B的中国专利使用的方法,该方法通过对相邻帧之间探测到的同一静止目标的坐标对应的三角形夹角来确定实际安装角度。此方法无法有效判断目标是否静止,且受限于雷达的距离分辨率,精度难以保证。
发明内容
有鉴于此,本发明提出了基于点云速度的车载毫米波雷达安装角度误差校正方法。
具体的,本发明公开的基于点云速度的车载毫米波雷达安装角度误差校正方法,包括以下步骤:
S1:雷达获取当前车辆的车速与转向角信息,当车速大于预设车速且转向角小于预设转向角时,进行安装角度误差校正;
S3:计算所有点云的纵向远离速度之差,选出的值小于×coef的点云,coef为与车速的最大允许比例,当为正与为负的点云数量均大于预设阈值num时,分别对为正与为负的点云执行步骤S4~S5,否则执行步骤S1-S3;
S5:以预设值为半径对所有的做聚类,计算每个角度类中所有点云的x、y坐标与其均值之差的平方和SST x 与SST y ;计算所有角度类的SST x 与SST y 之和SST x+y ,按从大到小的顺序进行排序,记录前m个值:将为正得到的m个值记录为,为负得到的m个值记录为;
当前帧的实际安装角度计算如下:
本发明的有益效果如下:
1)通过车速信息与雷达测量的相对地面静止的点云在纵向上的速度,反推雷达的实际安装角度,不依赖于特定环境与工具,雷达整个运行期间均可执行校准操作,校准精度高。
2)将所有可能的安装角度做精细的聚类,根据每一个角度类中点云的离散程度来设定不同的权重。对正负半轴权重较高的角度类做匹配来消除可能存在的非静止点云的影响。
附图说明
图1本发明的部分流程图;
图2本发明的部分流程图。
具体实施方式
下面结合附图对本发明作进一步的说明,但不以任何方式对本发明加以限制,基于本发明教导所作的任何变换或替换,均属于本发明的保护范围。
参考图1和图2,本发明提供了一种基于点云速度的车载雷达安装角度误差校正方法,包括以下步骤:
S2:雷达朝后安装时,首先遍历当前帧所有远离的点云,将雷达设定的初始安装角度与点云在雷达坐标系内的角度相加得到,当的绝对值在一定范围时(如20~80°),根据雷达输出的原始速度,计算此点云在纵向上的远离速度:;
S3:计算所有点云的纵向远离速度与当前车速之差,选出的值小于×coef的点云,根据其对应的的正负,分别记录横坐标x、纵坐标y、、、、的值。当为正与为负的点云数量均大于num时,分别对为正与为负的点云执行步骤S4~S5;示例性的,coef 的设置范围为0≤coef≤0.2,num设置为10。
本发明的有益效果如下:
1)通过车速信息与雷达测量的相对地面静止的点云在纵向上的速度,反推雷达的实际安装角度,不依赖于特定环境与工具,雷达整个运行期间均可执行校准操作,校准精度高。
2)将所有可能的安装角度做精细的聚类,根据每一个角度类中点云的离散程度来设定不同的权重。对正负半轴权重较高的角度类做匹配来消除可能存在的非静止点云的影响。
本文所使用的词语“优选的”意指用作实例、示例或例证。本文描述为“优选的”任意方面或设计不必被解释为比其他方面或设计更有利。相反,词语“优选的”的使用旨在以具体方式提出概念。如本申请中所使用的术语“或”旨在意指包含的“或”而非排除的“或”。即,除非另外指定或从上下文中清楚,“X使用A或B”意指自然包括排列的任意一个。即,如果X使用A;X使用B;或X使用A和B二者,则“X使用A或B”在前述任一示例中得到满足。
而且,尽管已经相对于一个或实现方式示出并描述了本公开,但是本领域技术人员基于对本说明书和附图的阅读和理解将会想到等价变型和修改。本公开包括所有这样的修改和变型,并且仅由所附权利要求的范围限制。特别地关于由上述组件(例如元件等)执行的各种功能,用于描述这样的组件的术语旨在对应于执行所述组件的指定功能(例如其在功能上是等价的)的任意组件(除非另外指示),即使在结构上与执行本文所示的本公开的示范性实现方式中的功能的公开结构不等同。此外,尽管本公开的特定特征已经相对于若干实现方式中的仅一个被公开,但是这种特征可以与如可以对给定或特定应用而言是期望和有利的其他实现方式的一个或其他特征组合。而且,就术语“包括”、“具有”、“含有”或其变形被用在具体实施方式或权利要求中而言,这样的术语旨在以与术语“包含”相似的方式包括。
本发明实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以多个或多个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。所述集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。上述提到的存储介质可以是只读存储器,磁盘或光盘等。上述的各装置或***,可以执行相应方法实施例中的存储方法。
综上所述,上述实施例为本发明的一种实施方式,但本发明的实施方式并不受所述实施例的限制,其他的任何背离本发明的精神实质与原理下所做的改变、修饰、代替、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
Claims (3)
1.基于点云速度的车载毫米波雷达安装角度误差校正方法,其特征在于,包括以下步骤:
S1:雷达获取当前车辆的车速与转向角信息,当车速大于预设车速且转向角小于预设转向角时,进行安装角度误差校正;
S2:遍历当前帧所有远离的点云,将雷达设定的初始安装角度θ0与点云在雷达坐标系内的角度θ1相加得到θ2,当θ2的绝对值在预设范围内时,根据雷达输出的原始速度V1,计算此点云在纵向上的远离速度V2;
S3:计算所有点云的纵向远离速度V2与当前车速Vcar_cur之差Verr,选出Verr的值小于Vcar_cur×coef的点云,coef为Verr与车速的最大允许比例,当θ2为正与为负的点云数量均大于预设阈值num时,分别对θ2为正与θ2为负的点云执行步骤S4~S5,否则执行步骤S1-S3;
S4:对于与地面相对静止的点云目标,反推雷达的实际安装角度θ3;所述雷达的实际安装角度θ3根据以下公式反推:
Vcar_cur=V1/cos(θ1+θ3);
如果当前选择的点云中存在非静止目标,多个点云得到多个不同的θ3值,则继续执行步骤S5~S6;
S5:以预设值θerr为半径对所有的θ3做聚类,计算每个角度类中所有点云的x、y坐标与其均值之差的平方和SSTx与SSTy;计算所有角度类的SSTx与SSTy之和SSTx+y,按从大到小的顺序进行排序,记录前m个值:将θ2为正得到的m个θ3值记录为θp1~θpm,θ2为负得到的m个θ3值记录为θn1~θnm;
S6:判断|θp1-θn1|是否小于预设值θerr,如果不满足,继续判断|θp1-θn2|是否小于θerr...直至|θpm-θnm|,将第一个满足条件的θpi与θnj在m个值中所处的顺序给予不同的权重,0<i<m,0<j<m,并计算当前帧的权重;计算当前帧的实际安装角度θset1;
S7:在下一帧继续执行上述步骤得到下一帧的实际安装角度θset2,如果|θset1-θset2|的值小于θerr,将当前帧权重与上一帧的权重累加;否则,丢弃上一帧的θset1,将θset2的值赋值给θset1;
当连续n帧的权重之和Wsum大于阈值Wthr时,使用当前帧θset2替换初始设定的安装角度θ0。
2.根据权利要求1所述的基于点云速度的车载毫米波雷达安装角度误差校正方法,其特征在于,根据雷达输出的原始速度V1,计算此点云在纵向上的远离速度V2,公式如下:
V2=V1/cos(θ2)。
3.根据权利要求1所述的基于点云速度的车载毫米波雷达安装角度误差校正方法,其特征在于,如果满足条件的θp在m个值中所处的顺序为i,则θp的权重为1/i;如果满足条件的θn在m个值中所处的顺序为j,则θn的权重为1/j,当前帧的权重w=1/i+1/j;
当前帧的实际安装角度计算如下:
θset1=(θpi+θnj)/2。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211108403.9A CN115201773B (zh) | 2022-09-13 | 2022-09-13 | 基于点云速度的车载毫米波雷达安装角度误差校正方法 |
PCT/CN2023/118560 WO2024055991A1 (zh) | 2022-09-13 | 2023-09-13 | 基于点云速度的车载毫米波雷达安装角度误差校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211108403.9A CN115201773B (zh) | 2022-09-13 | 2022-09-13 | 基于点云速度的车载毫米波雷达安装角度误差校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115201773A CN115201773A (zh) | 2022-10-18 |
CN115201773B true CN115201773B (zh) | 2022-12-13 |
Family
ID=83572979
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211108403.9A Active CN115201773B (zh) | 2022-09-13 | 2022-09-13 | 基于点云速度的车载毫米波雷达安装角度误差校正方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN115201773B (zh) |
WO (1) | WO2024055991A1 (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115201773B (zh) * | 2022-09-13 | 2022-12-13 | 长沙莫之比智能科技有限公司 | 基于点云速度的车载毫米波雷达安装角度误差校正方法 |
CN116359865B (zh) * | 2023-06-02 | 2023-08-04 | 上海几何伙伴智能驾驶有限公司 | 毫米波雷达水平安装角估计方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016136857A1 (ja) * | 2015-02-25 | 2016-09-01 | 株式会社デンソー | 車載レーダ装置の搭載角度誤差検出方法および装置、並びに車載レーダ装置 |
CN111398924A (zh) * | 2020-04-29 | 2020-07-10 | 上海英恒电子有限公司 | 雷达安装角度标定方法及*** |
CN111624566A (zh) * | 2020-07-30 | 2020-09-04 | 北汽福田汽车股份有限公司 | 雷达安装角度校准方法及装置 |
CN112881989A (zh) * | 2019-11-29 | 2021-06-01 | 上海海拉电子有限公司 | 一种车辆上毫米波雷达的自校准方法、电子设备及存储介质 |
CN113552546A (zh) * | 2021-07-23 | 2021-10-26 | 北京经纬恒润科技股份有限公司 | 一种车载雷达安装角度的标定方法及装置 |
CN114791591A (zh) * | 2022-03-09 | 2022-07-26 | 北京经纬恒润科技股份有限公司 | 雷达标定方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6778873B2 (ja) * | 2016-08-10 | 2020-11-04 | パナソニックIpマネジメント株式会社 | レーダ設置角度算出装置、レーダ装置およびレーダ設置角度算出方法 |
CN111679256B (zh) * | 2020-07-23 | 2023-09-19 | 杭州智波科技有限公司 | 汽车毫米波雷达的角度校准方法、装置、***及存储介质 |
CN113126046A (zh) * | 2021-04-09 | 2021-07-16 | 安庆楚航电子科技有限公司 | 一种车载前向毫米波雷达安装误差自校准方法 |
CN115201773B (zh) * | 2022-09-13 | 2022-12-13 | 长沙莫之比智能科技有限公司 | 基于点云速度的车载毫米波雷达安装角度误差校正方法 |
-
2022
- 2022-09-13 CN CN202211108403.9A patent/CN115201773B/zh active Active
-
2023
- 2023-09-13 WO PCT/CN2023/118560 patent/WO2024055991A1/zh unknown
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016136857A1 (ja) * | 2015-02-25 | 2016-09-01 | 株式会社デンソー | 車載レーダ装置の搭載角度誤差検出方法および装置、並びに車載レーダ装置 |
CN112881989A (zh) * | 2019-11-29 | 2021-06-01 | 上海海拉电子有限公司 | 一种车辆上毫米波雷达的自校准方法、电子设备及存储介质 |
CN111398924A (zh) * | 2020-04-29 | 2020-07-10 | 上海英恒电子有限公司 | 雷达安装角度标定方法及*** |
CN111624566A (zh) * | 2020-07-30 | 2020-09-04 | 北汽福田汽车股份有限公司 | 雷达安装角度校准方法及装置 |
CN113552546A (zh) * | 2021-07-23 | 2021-10-26 | 北京经纬恒润科技股份有限公司 | 一种车载雷达安装角度的标定方法及装置 |
CN114791591A (zh) * | 2022-03-09 | 2022-07-26 | 北京经纬恒润科技股份有限公司 | 雷达标定方法 |
Non-Patent Citations (2)
Title |
---|
A novel method for calibration and verification of roadside millimetre-wave radar;Changlong Zhang 等;《IET Intelligent Transport Systems》;20211029;第16卷(第3期);408-419 * |
汽车后视毫米波雷达安装角标定***设计研究;朱子甲 等;《汽车实用技术》;20170930(第18期);88-91 * |
Also Published As
Publication number | Publication date |
---|---|
WO2024055991A1 (zh) | 2024-03-21 |
CN115201773A (zh) | 2022-10-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115201773B (zh) | 基于点云速度的车载毫米波雷达安装角度误差校正方法 | |
CN110596694B (zh) | 一种复杂环境雷达多目标跟踪和道路行驶环境预测方法 | |
EP2867696B1 (en) | Misalignment estimation of a vehicle radar system | |
CN114660330B (zh) | 确定估计速度的不确定性估计的方法 | |
EP2400270A1 (en) | Track information generating device, track information generating method, and computer-readable storage medium | |
CN113495272B (zh) | 生成动态占用网格的方法 | |
CN110298307B (zh) | 一种基于深度学习的异常停车实时检测方法 | |
Homm et al. | Fusion of laserscannner and video based lanemarking detection for robust lateral vehicle control and lane change maneuvers | |
US20200363809A1 (en) | Method and system for fusing occupancy maps | |
WO2018212292A1 (ja) | 情報処理装置、制御方法、プログラム及び記憶媒体 | |
CN115327501B (zh) | 水平安装角自标定方法、装置、电子设备及存储介质 | |
CN107480592B (zh) | 一种多车道检测方法及跟踪方法 | |
CN111190150A (zh) | 车载雷达自学习标定方法及*** | |
CN110413942B (zh) | 车道线方程筛选方法及其筛选模块 | |
CN113552546B (zh) | 一种车载雷达安装角度的标定方法及装置 | |
KR102398084B1 (ko) | 도로 상황에 따라 조정된 가중치를 이용한 정밀지도 기반의 맵 매칭을 통해 이동체를 측위하는 방법 및 이를 이용한 이동체 위치 측정 장치 | |
Zhihua et al. | A new approach to map-matching and parameter correcting for vehicle navigation system in the area of shadow of GPS signal | |
CN111148023B (zh) | 基于多个uwb标签的定位方法及装置 | |
JP4506163B2 (ja) | 前方物体検出装置及び前方物体検出方法 | |
CN110866554A (zh) | 一种基于卫星定位数据的不良驾驶行为多发区域检测方法 | |
CN110967040B (zh) | 一种传感器水平偏差角度的识别方法及*** | |
JP4069769B2 (ja) | 道路形状認識装置 | |
JP2001116569A (ja) | 距離係数算出方法と、移動距離算出装置 | |
CN114779235A (zh) | 基于车载毫米波雷达的道路边界检测方法和*** | |
CN114495483A (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 |