CN116359865A - 毫米波雷达水平安装角估计方法 - Google Patents

毫米波雷达水平安装角估计方法 Download PDF

Info

Publication number
CN116359865A
CN116359865A CN202310643693.5A CN202310643693A CN116359865A CN 116359865 A CN116359865 A CN 116359865A CN 202310643693 A CN202310643693 A CN 202310643693A CN 116359865 A CN116359865 A CN 116359865A
Authority
CN
China
Prior art keywords
installation angle
millimeter wave
horizontal installation
radar
wave radar
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.)
Granted
Application number
CN202310643693.5A
Other languages
English (en)
Other versions
CN116359865B (zh
Inventor
潘松
陆新飞
薛旦
史颂华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Geometry Partner Intelligent Driving Co ltd
Original Assignee
Shanghai Geometry Partner Intelligent Driving Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Geometry Partner Intelligent Driving Co ltd filed Critical Shanghai Geometry Partner Intelligent Driving Co ltd
Priority to CN202310643693.5A priority Critical patent/CN116359865B/zh
Publication of CN116359865A publication Critical patent/CN116359865A/zh
Application granted granted Critical
Publication of CN116359865B publication Critical patent/CN116359865B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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

毫米波雷达水平安装角估计方法
技术领域
本发明涉及智能驾驶技术领域，尤其涉及毫米波雷达技术领域，具体是指一种毫米波雷达水平安装角估计方法、装置、处理器及其计算机可读存储介质。
背景技术
毫米波雷达具有全天时、全天候的工作特性，是智能驾驶领域必须的传感器之一。毫米波雷达相对汽车的安装精度对被检出目标相对汽车的位置估计具有重要影响。特别地，毫米波雷达相对汽车的水平安转角对被检出目标相对汽车的横向位置有显著影响，而目标的横向位置又显著影响汽车的各项驾驶辅助功能如自适应巡航、自动紧急刹车等的正常运作。因此，获取高精度的雷达水平安装角度十分必要。
现有技术CN202110380413.7提出了一种车载前向毫米波雷达安装误差自校准方法。该方法要求在测试道路两旁放置一定数量的雷达角放射器，并借助雷达对角放射器的测量结果来估计雷达安装角度。从而，雷达安装角度的估计结果依赖于对角放射器的正确检测。
现有技术CN202010098426.0提出了一种车载毫米波雷达安装角度自校准方法。该方法要求在测试道路中两侧设置多个平行的直线围栏作为静止标定目标。该方法对校准环境有较高的要求。
上述两种方法均对校准环境有一定的要求，因此无法实现在雷达工作过程中的偏转监测。
现有技术CN202211250693.0提出了一种水平安装角自标定方法。该方法要求对每个自标定角度进行静态目标的轨迹预测和帧间匹配的相似度计算。该方法由于复杂度较高，并且帧间匹配结果的准确性会影响雷达标定结果的准确性。
发明内容
本发明的目的是克服了上述现有技术的缺点，提供了一种高精准度且技术简便的毫米波雷达水平安装角估计方法、装置、处理器及其计算机可读存储介质。
为了实现上述目的，本发明的该毫米波雷达水平安装角估计方法、装置、处理器及其计算机可读存储介质如下：
该毫米波雷达水平安装角估计方法，其主要特点是，所述的方法包括以下步骤：
（1）获取当前时刻车辆的车速和雷达点云，并以此判断当前所有的静态点；
（2）根据当前获取到的所有的静态点，计算出所有静态点的统计平均量；
（3）判断当前时刻累积的点云数和检测帧数是否达到预设阈值，若是，则进入步骤（4），否则，重新返回步骤（1）；
（4）用截止当前时刻求取出的所有静态点的统计平均量构建关于雷达水平安装角余弦值的方程，并计算出方程的每一个实数根作为备选结果；
（5）对步骤（4）得到的每个实数根，进一步计算得到两个对实数，将每个实数对依次带入损失函数中比较结果大小；
（6）最后基于损失函数最小值点估计出毫米波雷达的水平安装角。
较佳地，所述的步骤（1）具体包括以下步骤：
（1.1）从毫米波雷达和车速传感器分别获得雷达点云数据和车速；
（1.2）将获取到的当前时刻的车速反投影至雷达点云方位角上，并计算出投影速度与点云的径向速度的差值，若差值小于阈值，则将对应点判定为静态点，判别公式如下：
Figure SMS_1
；
其中，
Figure SMS_2
表示在第j时刻所测的车辆速度，/>
Figure SMS_3
表示在第j 时刻所测第i个雷达点云的径向速度，/>
Figure SMS_4
表示在第j时刻所测第i个雷达点云的方位角加上固定的初始水平安装角，/>
Figure SMS_5
表示预设的静态点判定阈值；
较佳地，所述的步骤（2）具体为：
按照以下方式计算出截止当前时刻j的所有静态点的统计平均量：
Figure SMS_6
；
Figure SMS_7
；
Figure SMS_8
；
Figure SMS_9
；
Figure SMS_10
；
Figure SMS_11
；
其中
Figure SMS_14
，/>
Figure SMS_17
，/>
Figure SMS_19
，/>
Figure SMS_12
，/>
Figure SMS_15
， />
Figure SMS_18
分别表示从0时刻累计至j时刻的各个静态点的统计平均量；/>
Figure SMS_20
表示从0时刻累计至j时刻的点云总数，/>
Figure SMS_13
，/>
Figure SMS_16
。
较佳地，所述的步骤（4）具体包括以下步骤：
（4.1）按照以下方式用当前所有静态点的统计平均量构建关于雷达水平安装角余 弦值
Figure SMS_21
的一元四次方程：
Figure SMS_22
；
（4.2）根据上述一元四次方程，获取对应的所有实数根
Figure SMS_23
;
较佳地，所述的步骤（5）具体包括以下步骤：
（5.1）对方程的每个根
Figure SMS_24
，计算对应的
Figure SMS_25
，得到两个实数对(
Figure SMS_26
,
Figure SMS_27
)；
（5.2）将获取到的每一对实数分别按照以下方式计算损失函数值：
Figure SMS_28
；
（5.3）将计算出的最小损失函数值对应的实数对设置为
Figure SMS_29
。
较佳地，所述的步骤（6）具体为：
将所述的最小损失函数值对应的实数对
Figure SMS_30
按照以下方式计算毫米波雷达水平安装角的估计值/>
Figure SMS_31
：
Figure SMS_32
；
将所述的估计值
Figure SMS_33
加上固定的初始水平安装角即可得到当前车辆最终的雷达水平安装角。
该实现毫米波雷达水平安装角估计的装置，其主要特点是，所述的装置包括：
处理器，被配置成执行计算机可执行指令；
存储器，存储一个或多个计算机可执行指令，所述的计算机可执行指令被所述的处理器执行时，实现上述所述的毫米波雷达水平安装角估计方法的步骤。
该实现毫米波雷达水平安装角估计的处理器，其主要特点是，所述的处理器被配置成执行计算机可执行指令，所述的计算机可执行指令被所述的处理器执行时，实现上述所述的毫米波雷达水平安装角估计方法的步骤。
该计算机可读存储介质，其主要特点是，其上存储有计算机程序，所述的计算机程序可被处理器执行以实现上述所述的毫米波雷达水平安装角估计方法的步骤。
采用了本发明的该毫米波雷达水平安装角估计方法、装置、处理器及其计算机可读存储介质，不依赖于特定的外部环境，仅需车速信息和雷达点云信息即可完成雷达水平安装角度的估计，可用于雷达出厂校准或在雷达使用过程中进行偏转监测。同时，本技术方案在累计点云数据时仅需保存6个统计平均量及累计点云数目，占用资源小，且理论上可无限累计数据。该方法提供的水平安装角估计结果在统计学意义上属于相合估计，当数据累计足够多时，可准确有效地估计前雷达或角雷达的水平安装角，从而提高雷达检测结果相对汽车的位置准确性，提高了行车安全性。
附图说明
图1为本发明的毫米波雷达水平安装角估计方法的流程图。
具体实施方式
为了能够更清楚地描述本发明的技术内容，下面结合具体实施例来进行进一步的描述。
在详细说明根据本发明的实施例前，应该注意到的是，在下文中，术语“包括”、“包含”或任何其他变体旨在涵盖非排他性的包含，由此使得包括一系列要素的过程、方法、物品或者设备不仅包含这些要素，而且还包含没有明确列出的其他要素，或者为这种过程、方法、物品或者设备所固有的要素。
请参阅图1所示，该毫米波雷达水平安装角估计方法，其中，所述的方法包括以下步骤：
（1）获取当前时刻车辆的车速和雷达点云，并以此判断当前所有的静态点；
（2）根据当前获取到的所有的静态点，计算出所有静态点的统计平均量；
（3）判断当前时刻累积的点云数和检测帧数是否达到预设阈值，若是，则进入步骤（4），否则，重新返回步骤（1）；
（4）用截止当前时刻求取出的所有静态点的统计平均量构建关于雷达水平安装角余弦值的方程，并计算出方程的每一个实数根作为备选结果；
（5）对步骤（4）得到的每个实数根，进一步计算得到两个实数对。将每个实数对依次带入损失函数中比较结果大小；
（6）最后基于损失函数最小值点估计出毫米波雷达的水平安装角。
作为本发明的优选实施方式，所述的步骤（1）具体包括以下步骤：
（1.1）从毫米波雷达和车速传感器分别获得雷达点云数据和车速；
（1.2）将获取到的当前时刻的车速反投影至雷达点云方位角上，并计算出投影速度与点云的径向速度的差值，若差值小于阈值，则将对应点判定为静态点，判别公式如下：
Figure SMS_34
；
其中，
Figure SMS_35
表示在第j时刻所测的车辆速度，/>
Figure SMS_36
表示在第j 时刻所测第i个雷达点云的径向速度，/>
Figure SMS_37
表示在第j时刻所测第i个雷达点云的方位角加上固定的初始水平安装角，/>
Figure SMS_38
表示预设的静态点判定阈值；
作为本发明的优选实施方式，所述的步骤（2）具体为：
按照以下方式计算出截止当前时刻j的所有静态点的统计平均量：
Figure SMS_39
；
Figure SMS_40
；
Figure SMS_41
；
Figure SMS_42
；
Figure SMS_43
；
Figure SMS_44
；
其中
Figure SMS_46
，/>
Figure SMS_49
，/>
Figure SMS_52
，/>
Figure SMS_47
，/>
Figure SMS_50
， />
Figure SMS_51
分别表示从0时刻累计至j时刻的各个静态点的统计平均量；/>
Figure SMS_53
表示从0时刻累计至j时刻的点云总数，/>
Figure SMS_45
，/>
Figure SMS_48
。
作为本发明的优选实施方式，所述的步骤（4）具体包括以下步骤：
（4.1）按照以下方式用当前所有静态点的统计平均量构建关于雷达水平安装角余 弦值
Figure SMS_54
的一元四次方程：
Figure SMS_55
；
（4.2）获取对应的所有实数根
Figure SMS_56
;
作为本发明的优选实施方式，所述的步骤（5）具体包括以下步骤：
（5.1）对方程的每个根
Figure SMS_57
，计算对应的
Figure SMS_58
，得到两个实数对(
Figure SMS_59
,
Figure SMS_60
)；
（5.2）将获取到的每一对实数分别按照以下方式计算损失函数值：
Figure SMS_61
；
（5.3）将计算出的最小损失函数值对应的实数对设置为
Figure SMS_62
。
作为本发明的优选实施方式，所述的步骤（6）具体为：
将所述的最小损失函数值对应的实数对
Figure SMS_63
按照以下方式计算毫米波雷达水平安装角的估计值/>
Figure SMS_64
：
Figure SMS_65
；
将所述的估计值
Figure SMS_66
加上固定的初始水平安装角即可得到当前车辆最终的雷达水平安装角。
下面，将进一步详细的说明本技术方案的该毫米波雷达水平安装角估计方法的基本原理：
首先，通过雷达所测静态点云的径向速度、方位角与车速需符合如下公式：
Figure SMS_67
；
其中，
Figure SMS_68
表示在第j时刻所测的车辆速度，/>
Figure SMS_69
表示在第j 时刻所测第i 个雷达点云的径向速度，/>
Figure SMS_70
表示在第j 时刻所测第i 个雷达点云的方位角加上固定的初始水平安装角，/>
Figure SMS_71
表示雷达实际水平安装角相对初始水平安装角的偏差。累计多个时刻的雷达静态点云，可构造如下损失函数：
Figure SMS_72
；
求出使损失函数达到最小的
Figure SMS_73
值即可得到雷达的水平安装角度。
进一步的，记
Figure SMS_74
, />
Figure SMS_75
, />
Figure SMS_76
, />
Figure SMS_77
，则损失函数可改写成：
Figure SMS_78
；
记
Figure SMS_79
，/>
Figure SMS_80
，/>
Figure SMS_81
，/>
Figure SMS_82
，/>
Figure SMS_83
，
Figure SMS_84
，则
Figure SMS_85
；
并有约束条件：
Figure SMS_86
；
利用拉格朗日乘子法，求上述带等式约束的优化问题，最后可化为求如下一元四次方程的根：
Figure SMS_87
；
解上述方程至多可得到4个
Figure SMS_88
的根，相应地至多可得到8对
Figure SMS_89
。将所有可能 的极值点代入损失函数比较结果大小，可得到最小值点。最后根据最小值点的
Figure SMS_90
求 得
Figure SMS_91
即可。此方法不会陷入局部最小值，且随着检测帧数和点云数的累计，估计结果在统计 学意义上将趋近真值，保证了算法结果的精度和可靠性。
基于上述基本原理，本技术方案的该毫米波雷达水平安装角估计方法，主要包括以下步骤：
1、获取当前时刻j的车速、雷达点云，将车速反投影至雷达点云方位角上，计算投影速度与点云的径向速度的差值，若差值小于阈值，则判定为静态点；
2、计算截止当前时刻j的所有静态点的下述统计平均量：
Figure SMS_92
；
Figure SMS_93
；
Figure SMS_94
；
Figure SMS_95
；
Figure SMS_96
；
Figure SMS_97
；
其中
Figure SMS_98
，/>
Figure SMS_99
，/>
Figure SMS_100
，/>
Figure SMS_101
，/>
Figure SMS_102
， />
Figure SMS_103
分别表示从0时刻累计至j时刻的各统计平均量；/>
Figure SMS_104
表示从0时刻累计至j时刻的点云总数。
3、如果累计的点云数和检测帧数超过预先设定的阈值，则求解一元四次方程：
Figure SMS_105
；
4、对方程的每个根
Figure SMS_106
，计算对应的
Figure SMS_107
。并计算每对
Figure SMS_108
损失 函数值：
Figure SMS_109
；
并取使损失函数最小的
Figure SMS_110
；
5、计算估计结果：
Figure SMS_111
；
将
Figure SMS_112
加上固定的初始水平安装角即可得到雷达水平安装角。
在本发明的一具体实施例中，该毫米波雷达水平安装角估计方法的详细处理方式如下：
步骤1：获取当前时刻的车速、雷达点云，将车速反投影至雷达点云方位角上，计算投影速度与点云的径向速度的差值，若差值小于阈值，在本实施例中将阈值选取为1m/s，则对应点判定为静态点。
步骤2：计算截止当前时刻的所有静态点的下述统计平均量：
Figure SMS_113
；
Figure SMS_114
；
Figure SMS_115
；
Figure SMS_116
；
Figure SMS_117
；
Figure SMS_118
；
步骤3：判断累积的点云数和检测帧数是否达到预设阈值。在本实施例中，将检测帧数阈值设置为10帧，总点云数阈值设置为1000。若达到预设阈值，则进入步骤（4），否则，重新返回步骤（1）；
步骤4：求解一元四次方程。在本实施例中，完成累积后的统计平均量各值如下：
Figure SMS_119
，/>
Figure SMS_120
，/>
Figure SMS_121
，/>
Figure SMS_122
，/>
Figure SMS_123
，
Figure SMS_124
，
构成的一元四次方程为：
Figure SMS_125
；
方程有4个实数根，分别为：
Figure SMS_126
，/>
Figure SMS_127
，/>
Figure SMS_128
，/>
Figure SMS_129
，
步骤5：根据每个根，计算对应的
Figure SMS_130
，并计算每对
Figure SMS_131
对应的损失函数 值，如下：
Figure SMS_132
，
损失函数值最小为0.0041，对应的
Figure SMS_133
。
步骤6：计算估计结果：
Figure SMS_134
；
在本实施例中，初始水平安装角度为0°，因此估计的雷达水平安装角为－6.46°。
该实现毫米波雷达水平安装角估计的装置，其中，所述的装置包括：
处理器，被配置成执行计算机可执行指令；
存储器，存储一个或多个计算机可执行指令，所述的计算机可执行指令被所述的处理器执行时，实现上述所述的毫米波雷达水平安装角估计方法的步骤。
该实现毫米波雷达水平安装角估计的处理器，其中，所述的处理器被配置成执行计算机可执行指令，所述的计算机可执行指令被所述的处理器执行时，实现上述所述的毫米波雷达水平安装角估计方法的步骤。
该计算机可读存储介质，其中，其上存储有计算机程序，所述的计算机程序可被处理器执行以实现上述所述的毫米波雷达水平安装角估计方法的步骤。
流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为，表示包括一个或更多个用于实现特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分，并且本发明的优选实施方式的范围包括另外的实现，其中可以不按所示出或讨论的顺序，包括根据所涉及的功能按基本同时的方式或按相反的顺序，来执行功能，这应被本发明的实施例所属技术领域的技术人员所理解。
应当理解，本发明的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中，多个步骤或方法可以用存储在存储器中且由合适的指令执行装置执行的软件或固件来实现。
本技术领域的普通技术人员可以理解实现上述实施例方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成的，程序可以存储于一种计算机可读存储介质中，该程序在执行时，包括方法实施例的步骤之一或其组合。
上述提到的存储介质可以是只读存储器，磁盘或光盘等。
在本说明书的描述中，参考术语“一实施例”、“一些实施例”、“示例”、“具体示例”、或“实施例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不一定指的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本发明的限制，本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
采用了本发明的该毫米波雷达水平安装角估计方法、装置、处理器及其计算机可读存储介质，不依赖于特定的外部环境，仅需车速信息和雷达点云信息即可完成雷达水平安装角度的估计，可用于雷达出厂校准或在雷达使用过程中进行偏转监测。同时，本技术方案在累计点云数据时仅需保存6个统计平均量及累计点云数目，占用资源小，且理论上可无限累计数据。该方法提供的水平安装角估计结果在统计学意义上属于相合估计，当数据累计足够多时，可准确有效地估计前雷达或角雷达的水平安装角，从而提高雷达检测结果相对汽车的位置准确性，提高了行车安全性。
在此说明书中，本发明已参照其特定的实施例作了描述。但是，很显然仍可以作出各种修改和变换而不背离本发明的精神和范围。因此，说明书和附图应被认为是说明性的而非限制性的。

Claims (9)

1.一种毫米波雷达水平安装角估计方法，其特征在于，所述的方法包括以下步骤：
（1）获取当前时刻车辆的车速和雷达点云，并以此判断当前所有的静态点；
（2）根据当前获取到的所有的静态点，计算出所有静态点的统计平均量；
（3）判断当前时刻累积的点云数和检测帧数是否达到预设阈值，若是，则进入步骤（4），否则，重新返回步骤（1）；
（4）用截止当前时刻求取出的所有静态点的统计平均量构建关于雷达水平安装角余弦值的方程，并计算出方程的每一个实数根作为备选结果；
（5）对步骤（4）得到的每个实数根，进一步计算得到两个实数对，将每个实数对依次带入损失函数中比较结果大小；
（6）最后基于损失函数最小值点估计出毫米波雷达的水平安装角。
2.根据权利要求1所述的毫米波雷达水平安装角估计方法，其特征在于，所述的步骤（1）具体包括以下步骤：
（1.1）从毫米波雷达和车速传感器分别获取雷达点云数据和车速；
（1.2）将获取到的当前时刻的车速反投影至雷达点云方位角上，并计算出投影速度与点云的径向速度的差值，若差值小于阈值，则将对应点判定为静态点，判别公式如下：
Figure QLYQS_1
；
其中，
Figure QLYQS_2
表示在第j时刻所测的车辆速度，/>
Figure QLYQS_3
表示在第j时刻所测第i个雷达点云的径向速度，/>
Figure QLYQS_4
表示在第j时刻所测第i个雷达点云的方位角加上固定的初始水平安装角，
Figure QLYQS_5
表示预设的静态点判定阈值。
3.根据权利要求2所述的毫米波雷达水平安装角估计方法，其特征在于，所述的步骤（2）具体为：
按照以下方式计算出截止当前时刻j的所有静态点的统计平均量：
Figure QLYQS_6
；
Figure QLYQS_7
；
Figure QLYQS_8
；
Figure QLYQS_9
；
Figure QLYQS_10
；
Figure QLYQS_11
；
其中
Figure QLYQS_12
，/>
Figure QLYQS_15
，/>
Figure QLYQS_19
，/>
Figure QLYQS_14
，/>
Figure QLYQS_16
，/>
Figure QLYQS_18
分别表示从0时刻累计至j时刻的各个静态点的统计平均量；
Figure QLYQS_20
表示从0时刻累计至j时刻的点云总数，/>
Figure QLYQS_13
，/>
Figure QLYQS_17
。
4.根据权利要求3所述的毫米波雷达水平安装角估计方法，其特征在于，所述的步骤（4）具体包括以下步骤：
（4.1）按照以下方式用当前所有静态点的统计平均量构建关于雷达水平安装角余弦值
Figure QLYQS_21
的一元四次方程：
Figure QLYQS_22
；
（4.2）根据上述一元四次方程，获取对应的所有实数根
Figure QLYQS_23
。
5.根据权利要求4所述的毫米波雷达水平安装角估计方法，其特征在于，所述的步骤（5）具体包括以下步骤：
（5.1）对方程的每个根
Figure QLYQS_24
，计算对应的/>
Figure QLYQS_25
，进而得到两个实数对(/>
Figure QLYQS_26
,/>
Figure QLYQS_27
)；
（5.2）将获取到的每一对实数分别按照以下方式计算损失函数值：
Figure QLYQS_28
；
（5.3）将计算出的最小损失函数值对应的实数对设置为
Figure QLYQS_29
。
6.根据权利要求5所述的毫米波雷达水平安装角估计方法，其特征在于，所述的步骤（6）具体为：
将所述的最小损失函数值对应的实数对
Figure QLYQS_30
按照以下方式计算毫米波雷达水平安装角的估计值/>
Figure QLYQS_31
：
Figure QLYQS_32
；
将所述的估计值
Figure QLYQS_33
加上固定的初始水平安装角即可得到当前车辆最终的雷达水平安装角。
7.一种实现毫米波雷达水平安装角估计的装置，其特征在于，所述的装置包括：
处理器，被配置成执行计算机可执行指令；
存储器，存储一个或多个计算机可执行指令，所述的计算机可执行指令被所述的处理器执行时，实现权利要求1～6中任一项所述的毫米波雷达水平安装角估计方法的步骤。
8.一种实现毫米波雷达水平安装角估计的处理器，其特征在于，所述的处理器被配置成执行计算机可执行指令，所述的计算机可执行指令被所述的处理器执行时，实现权利要求1～6中任一项所述的毫米波雷达水平安装角估计方法的步骤。
9.一种计算机可读存储介质，其特征在于，其上存储有计算机程序，所述的计算机程序可被处理器执行以实现权利要求1～6中任一项所述的毫米波雷达水平安装角估计方法的步骤。
CN202310643693.5A 2023-06-02 2023-06-02 毫米波雷达水平安装角估计方法 Active CN116359865B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310643693.5A CN116359865B (zh) 2023-06-02 2023-06-02 毫米波雷达水平安装角估计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310643693.5A CN116359865B (zh) 2023-06-02 2023-06-02 毫米波雷达水平安装角估计方法

Publications (2)

Publication Number Publication Date
CN116359865A true CN116359865A (zh) 2023-06-30
CN116359865B CN116359865B (zh) 2023-08-04

Family

ID=86928417

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310643693.5A Active CN116359865B (zh) 2023-06-02 2023-06-02 毫米波雷达水平安装角估计方法

Country Status (1)

Country Link
CN (1) CN116359865B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118671719A (zh) * 2024-08-15 2024-09-20 福瑞泰克智能系统有限公司 雷达的安装角度标定方法、装置和存储介质及电子设备

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012014298A (ja) * 2010-06-29 2012-01-19 Honda Motor Co Ltd 車両の進行路推定装置
US20150314785A1 (en) * 2014-04-30 2015-11-05 Mando Corporation Driver convenience system and method for determining vertical angle abnormality of radar therein
US20170307749A1 (en) * 2014-10-03 2017-10-26 Denso Corporation Radar apparatus
US20180120416A1 (en) * 2015-02-25 2018-05-03 Denso Corporation Mounting angle error detection method and apparatus for onboard radar apparatus, and onboard radar apparatus
US20200081119A1 (en) * 2018-09-07 2020-03-12 Baidu Online Network Technology (Beijing) Co., Ltd. Method and apparatus for determining relative pose, device and medium
WO2022061799A1 (zh) * 2020-09-27 2022-03-31 深圳市大疆创新科技有限公司 位姿估计的方法和装置
CN114325682A (zh) * 2021-04-29 2022-04-12 北京易航远智科技有限公司 基于车载4d毫米波雷达的车辆速度状态估计方法
CN114609609A (zh) * 2022-03-15 2022-06-10 浙江大学 Fmcw激光雷达随机采样提取静止点云的速度估计方法
US20220198806A1 (en) * 2020-12-21 2022-06-23 Beihang University Target detection method based on fusion of prior positioning of millimeter-wave radar and visual feature
WO2022153660A1 (ja) * 2021-01-15 2022-07-21 住友電気工業株式会社 レーダの設置角度調整方法
CN115201773A (zh) * 2022-09-13 2022-10-18 长沙莫之比智能科技有限公司 基于点云速度的车载毫米波雷达安装角度误差校正方法
CN115220041A (zh) * 2022-06-21 2022-10-21 华中科技大学 一种带有多普勒补偿的毫米波雷达尺度定位方法和系统
CN115327501A (zh) * 2022-10-13 2022-11-11 南京隼眼电子科技有限公司 水平安装角自标定方法、装置、电子设备及存储介质
CN115561719A (zh) * 2022-08-31 2023-01-03 上海几何伙伴智能驾驶有限公司 多雷达安装角度的标定方法、存储介质及电子设备

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012014298A (ja) * 2010-06-29 2012-01-19 Honda Motor Co Ltd 車両の進行路推定装置
US20150314785A1 (en) * 2014-04-30 2015-11-05 Mando Corporation Driver convenience system and method for determining vertical angle abnormality of radar therein
US20170307749A1 (en) * 2014-10-03 2017-10-26 Denso Corporation Radar apparatus
US20180120416A1 (en) * 2015-02-25 2018-05-03 Denso Corporation Mounting angle error detection method and apparatus for onboard radar apparatus, and onboard radar apparatus
US20200081119A1 (en) * 2018-09-07 2020-03-12 Baidu Online Network Technology (Beijing) Co., Ltd. Method and apparatus for determining relative pose, device and medium
WO2022061799A1 (zh) * 2020-09-27 2022-03-31 深圳市大疆创新科技有限公司 位姿估计的方法和装置
US20220198806A1 (en) * 2020-12-21 2022-06-23 Beihang University Target detection method based on fusion of prior positioning of millimeter-wave radar and visual feature
WO2022153660A1 (ja) * 2021-01-15 2022-07-21 住友電気工業株式会社 レーダの設置角度調整方法
CN114325682A (zh) * 2021-04-29 2022-04-12 北京易航远智科技有限公司 基于车载4d毫米波雷达的车辆速度状态估计方法
CN114609609A (zh) * 2022-03-15 2022-06-10 浙江大学 Fmcw激光雷达随机采样提取静止点云的速度估计方法
CN115220041A (zh) * 2022-06-21 2022-10-21 华中科技大学 一种带有多普勒补偿的毫米波雷达尺度定位方法和系统
CN115561719A (zh) * 2022-08-31 2023-01-03 上海几何伙伴智能驾驶有限公司 多雷达安装角度的标定方法、存储介质及电子设备
CN115201773A (zh) * 2022-09-13 2022-10-18 长沙莫之比智能科技有限公司 基于点云速度的车载毫米波雷达安装角度误差校正方法
CN115327501A (zh) * 2022-10-13 2022-11-11 南京隼眼电子科技有限公司 水平安装角自标定方法、装置、电子设备及存储介质

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
居鹏;杨序;徐海;: "机载有源相控阵雷达角度标校方法", 现代雷达, no. 06, pages 5 - 14 *
郭蓬;何佳;刘修知;张正奇;唐风敏;: "基于角毫米波雷达的目标筛选", 汽车实用技术, no. 11, pages 26 - 28 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118671719A (zh) * 2024-08-15 2024-09-20 福瑞泰克智能系统有限公司 雷达的安装角度标定方法、装置和存储介质及电子设备

Also Published As

Publication number Publication date
CN116359865B (zh) 2023-08-04

Similar Documents

Publication Publication Date Title
US11763568B2 (en) Ground plane estimation in a computer vision system
CN111157965B (zh) 车载毫米波雷达安装角度自校准方法、装置及存储介质
US11776217B2 (en) Method for planning three-dimensional scanning viewpoint, device for planning three-dimensional scanning viewpoint, and computer readable storage medium
CN109959919B (zh) 汽车及单目摄像头测距方法、装置
CN109738884B (zh) 对象检测方法、装置和计算机设备
JP6786676B2 (ja) 障害物の絶対速度の推定方法、システム、コンピュータ装置、記憶媒体、及びプログラム
CN112946623B (zh) 基于车辆上安装77g毫米波雷达的测速方法和装置
CN112731337B (zh) 地图构建方法、装置和设备
CN111038476B (zh) 车辆行驶的控制方法、装置和自动驾驶设备
CN105717491A (zh) 天气雷达回波图像的预测方法及预测装置
CN110426714B (zh) 一种障碍物识别方法
US11938952B2 (en) Traveling trajectory estimation system, traveling trajectory estimation program, and traveling trajectory estimating method
CN115097419A (zh) 一种激光雷达到imu的外参标定方法及装置
CN116359865B (zh) 毫米波雷达水平安装角估计方法
KR20210076412A (ko) 차량 센서 성능 평가 장치 및 그의 성능 평가 방법
CN116528279A (zh) 一种路侧测试时延的方法、装置、存储介质及电子设备
CN114646933B (zh) 一种4d毫米波雷达俯仰安装误差静态测量方法
CN112987010B (zh) 一种用于机器人的多雷达建图的系统及方法
JP7299007B2 (ja) 位置推定装置及び方法
CN112896070A (zh) 一种车位障碍物检测方法、装置及计算机可读存储介质
CN109581380B (zh) 基于雷达的车辆位置检测方法、装置和计算机设备
CN112924711B (zh) 一种车速检测方法、装置及计算机可读存储介质
US11790662B2 (en) Method and device for determining a motion state of at least one object in the surroundings of a vehicle, and method and device for activating a vehicle system of a vehicle
CN117075062A (zh) 针对车载4d毫米波雷达实现俯仰安装角估计处理的方法
CN118818518A (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