CN110967040A - 一种传感器水平偏差角度的识别方法及系统 - Google Patents
一种传感器水平偏差角度的识别方法及系统 Download PDFInfo
- Publication number
- CN110967040A CN110967040A CN201911301108.3A CN201911301108A CN110967040A CN 110967040 A CN110967040 A CN 110967040A CN 201911301108 A CN201911301108 A CN 201911301108A CN 110967040 A CN110967040 A CN 110967040A
- Authority
- CN
- China
- Prior art keywords
- sensor
- target
- target output
- output
- reference sensor
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 49
- 238000012360 testing method Methods 0.000 claims description 8
- 238000004364 calculation method Methods 0.000 claims description 7
- 238000010586 diagram Methods 0.000 description 10
- 230000006870 function Effects 0.000 description 7
- 238000005259 measurement Methods 0.000 description 4
- 230000032683 aging Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- 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
- G01S7/4052—Means for monitoring or calibrating by simulation of echoes
-
- 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
- G01S7/4052—Means for monitoring or calibrating by simulation of echoes
- G01S7/4082—Means for monitoring or calibrating by simulation of echoes using externally generated reference signals, e.g. via remote reflector or transponder
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Manufacturing & Machinery (AREA)
- Radar Systems Or Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种传感器水平偏差角度的识别方法及系统,方法包括:获取参考传感器输出的目标和被测传感器输出的目标,将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度。本发明无需被测传感器自身具备水平偏差角度的识别功能,对道路环境特征没有要求,通过对比参考传感器和被测传感器探测到的目标信息,即可得到被测传感器的水平偏差角度。
Description
技术领域
本发明涉及车辆技术领域,尤其涉及一种传感器水平偏差角度的识别方法及系统。
背景技术
当前车辆智能驾驶或辅助驾驶系统中一般配备了摄像头或毫米波雷达等传感器,用于探测道路环境中的车辆、行人等目标。这些传感器的角度偏差也直接影响到智能驾驶或辅助驾驶功能的性能表现,严重的角度偏差甚至会影响相关功能的安全性,后果非常严重。因此,对传感器角度偏差的识别尤为重要。
一般情况下,正确的安装及标定可以将传感器的角度偏差校准至较小范围内。但由于车辆的长时间使用,机械振动、支架老化甚至是碰撞等原因,可能会造成传感器严重的角度偏差。此时,即需要对传感器角度偏差进行准确的识别。目前,主要方法是通过单传感器自身的识别机制完成。例如,摄像头利用清晰的平直的车道线进行识别,毫米波雷达利用平直的规则的道路护栏进行识别等。这既要求传感器具备识别功能,会提高传感器的成本;同时识别过程对道路环境特征也有较高的要求,如清晰平直的车道线或平直规则的道路护栏等。
因此,如何更加有效的对传感器的水平偏差角度进行识别,是一项亟待解决的问题。
发明内容
有鉴于此,本发明提供了一种传感器水平偏差角度的识别方法及系统,无需被测传感器自身具备水平偏差角度的识别功能,且对识别过程中的道路环境特征没有要求,通过对比参考传感器和被测传感器探测到的目标信息,即可得到被测传感器的水平偏差角度。
本发明提供了一种传感器水平偏差角度的识别方法,应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述方法包括:
获取所述参考传感器输出的目标和所述被测传感器输出的目标;
将所述参考传感器和所述被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到所述被测传感器的水平偏差角度;N为大于等于1的整数。
优选地,所述获取所述参考传感器输出的目标和所述被测传感器输出的目标,包括:
获取所述车辆车速大于第一预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
优选地,所述获取所述参考传感器输出的目标和所述被测传感器输出的目标,包括:
获取所述车辆横摆角速度的绝对值小于第二预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
优选地,所述获取所述参考传感器输出的目标和所述被测传感器输出的目标,包括:
获取所述车辆车速大于第一预设阈值,且车辆横摆角速度的绝对值小于第二预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
优选地,所述分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,包括:
通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,其中,匹配的目标对中参考传感器输出的目标ai和被测传感器输出的目标bj在车辆坐标系下的坐标分别为(xai,yai)和(xbj,ybj),δk为目标ai和目标bj的水平偏差角度。
一种传感器水平偏差角度的识别系统,应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述系统包括:
获取模块,用于获取所述参考传感器输出的目标和所述被测传感器输出的目标;
匹配模块,用于将所述参考传感器和所述被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
第一计算模块,用于分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
第二计算模块,用于计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到所述被测传感器的水平偏差角度,N为大于等于1的整数。
优选地,所述获取模块在执行获取所述参考传感器输出的目标和所述被测传感器输出的目标时,具体用于:
获取所述车辆车速大于第一预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
优选地,所述获取模块在执行获取所述参考传感器输出的目标和所述被测传感器输出的目标时,具体用于:
获取所述车辆横摆角速度的绝对值小于第二预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
优选地,所述获取模块在执行获取所述参考传感器输出的目标和所述被测传感器输出的目标时,具体用于:
获取所述车辆车速大于第一预设阈值,且车辆横摆角速度的绝对值小于第二预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
优选地,所述第一计算模块在执行分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度时,具体用于:
通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,其中,匹配的目标对中参考传感器输出的目标ai和被测传感器输出的目标bj在车辆坐标系下的坐标分别为(xai,yai)和(xbj,ybj),δk为目标ai和目标bj的水平偏差角度。
综上所述,本发明公开了一种传感器水平偏差角度的识别方法,当需要识别被测传感器的水平偏差角度时,首先获取参考传感器输出的目标和被测传感器输出的目标,然后将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度。本发明通过计算匹配的目标对中参考传感器和被测传感器探测到的目标的水平偏差角度,即可得到被测传感器的水平偏差角度,无需被测传感器自身具备水平偏差角度的识别功能,且对识别过程中的道路环境特征没有要求,更加有效的实现了传感器的水平偏差角度的识别。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明公开的一种传感器水平偏差角度的识别方法实施例1的方法流程图;
图2为本发明公开的一种传感器水平偏差角度的识别方法实施例2的方法流程图;
图3为本发明公开的一种传感器水平偏差角度的识别方法实施例3的方法流程图;
图4为本发明公开的一种传感器水平偏差角度的识别方法实施例4的方法流程图;
图5为本发明公开一种传感器目标匹配示意图;
图6为本发明公开的一种传感器水平偏差角度的识别系统实施例1的结构示意图;
图7为本发明公开的一种传感器水平偏差角度的识别系统实施例2的结构示意图;
图8为本发明公开的一种传感器水平偏差角度的识别系统实施例3的结构示意图;
图9为本发明公开的一种传感器水平偏差角度的识别系统实施例4的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1所示,为本发明公开的一种传感器水平偏差角度的识别方法实施例1的方法流程图,所述方法应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;例如,传感器A为经正确安装、标定及校准的摄像头,传感器B为无角度偏差识别功能的毫米波雷达,其角度偏差未经校准。所述方法可以包括以下步骤:
S101、获取参考传感器输出的目标和被测传感器输出的目标;
当需要对被测传感器B的水平偏差角度进行识别时,首先分别获取参考传感器A输出的目标和被测传感器B输出的目标,即,分别获取参考传感器A和被测传感器B检测范围中识别得到的物体,其中,识别得到的物体可以为静止或运动物体。获取到的目标包含的信息有目标的纵向位置、横向位置、纵向速度、横向速度等运动学信息。
S102、将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
再进行具体的校准之前,需要首先统一参考传感器A和被测传感器B的坐标系,即将参考传感器A和被测传感器B输出的目标的位置坐标转换到同一坐标系下。例如,可以将参考传感器A和被测传感器B的坐标都转换至车辆坐标系。设车辆坐标系定义为:车辆前保中心为坐标原点,车辆正前方为x轴正方向,车辆左侧为y轴正方向。设传感器(参考传感器A或被测传感器B)的坐标系的定义为:坐标系原点在车辆坐标系的位置为(X0,Y0),传感器坐标系x轴正方向与车辆坐标系x轴夹角为θ。则在传感器坐标系中任一点的(x_a,y_a)转换至车辆坐标系,坐标如下:
在将参考传感器A输出的目标和被测传感器B输出的目标转换到同一坐标系下后,进一步将被测传感器B输出的目标与参考传感器A输出的目标进行匹配,得到匹配的目标对。例如,如图5所示,Vehicle代表目标,Ego Vehicle代表所述安装有传感器A和B的车辆;参考传感器A输出的目标有{a1,a2......am},被测传感器B输出的目标有{b1,b2......bm}。其中,a1与b3匹配,a2与b2匹配,而a3与b1没有匹配,不能匹配的目标即舍弃。
需要说明的是,在对目标进行匹配时,可以采用最近邻算法、全局最近邻算法、联合概率关联算法等。例如,分别计算目标ai与被测传感器B输出的所有目标{b1,b2......bm}的距离,并确定出与目标ai距离最小的目标(如,目标bj),然后进一步判断目标ai与目标bj的距离是否小于预设的距离阈值,当目标ai与目标bj的距离小于距离阈值时,则认为目标ai和目标bj匹配成功。需要说明的是,上述距离,可以是广义的距离,包括但不限于欧氏距离、马氏距离等等。
S103、分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
在获取到匹配的目标对后,分别对每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度进行计算。
具体的,可通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,其中,匹配的目标对中参考传感器输出的目标ai和被测传感器输出的目标bj在车辆坐标系下的坐标分别为(xai,yai)和(xbj,ybj),δk为目标ai和目标bj的水平偏差角度。
S104、计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度;N为大于等于1的整数。
在分别计算出每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度后,统计N个目标对的水平偏差角度,然后求平均值,得到参考传感器A输出的目标和被测传感器B的水平偏差角度:
由于参考传感器A为经正确安装、标定以及校准的传感器,可认为其角度偏差很小,可以忽略。则被测传感器B的水平偏差角度即为:
δB=δ。
综上所述,在上述实施例中,当需要识别被测传感器的水平偏差角度时,首先获取参考传感器输出的目标和被测传感器输出的目标,然后将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度。通过计算匹配的目标对中参考传感器和被测传感器探测到的目标的水平偏差角度,即可得到被测传感器的水平偏差角度,无需被测传感器自身具备水平偏差角度的识别功能,且对识别过程中的道路环境特征没有要求,更加有效的实现了传感器的水平偏差角度的识别。
如图2所示,为本发明公开的一种传感器水平偏差角度的识别方法实施例2的方法流程图,所述方法应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述方法可以包括以下步骤:
S201、获取车辆车速大于第一预设阈值时,参考传感器输出的目标和被测传感器输出的目标;
当需要对被测传感器B的水平偏差角度进行识别时,为进一步提高识别到的被测传感器B水平偏差角度的准确性,分别获取车辆车速大于第一预设阈值时,参考传感器A输出的目标和被测传感器B输出的目标。例如,去除车辆停车情况下参考传感器A和被测传感器B输出的目标,仅保留车辆正常行驶状态下参考传感器A和被测传感器B输出的目标,即仅获取在车速v大于第一预设阈值vmin时,参考传感器A输出的目标和被测传感器B输出的目标。其中,第一预设阈值vmin可以按需选取。例如,一般包括城市道路正常行驶,可选择30km/h,仅包括高速公路正常行驶,可选择60km/h。其中,获取到的目标包含的信息有目标的纵向位置、横向位置、纵向速度、横向速度等运动学信息。
S202、将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
然后,统一参考传感器A和被测传感器B的坐标系,即将参考传感器A和被测传感器B输出的目标转换到同一坐标系下。例如,可以将参考传感器A和被测传感器B的坐标系都转换至车辆坐标系。设车辆坐标系定义为:车辆前保中心为坐标原点,车辆正前方为x轴正方向,车辆左侧为y轴正方向。设传感器(参考传感器A或被测传感器B)的坐标系的定义为:坐标系原点在车辆坐标系的位置为(X0,Y0),传感器坐标系x轴正方向与车辆坐标系x轴夹角为θ。则在传感器坐标系中的(x_a,y_a)转换至车辆坐标系,坐标如下:
车辆车速大于第一预设阈值vmin时,参考传感器A输出的目标和被测传感器B输出的目标。
在将参考传感器A输出的目标和被测传感器B输出的目标转换到同一坐标系下后,进一步将被测传感器B输出的目标与参考传感器A输出的目标进行匹配,得到匹配的目标对。例如,如图5所示,获取到的参考传感器A输出的目标有{a1,a2......am},被测传感器B输出的目标有{b1,b2......bm}。其中,a1与b3匹配,a2与b2匹配,而a3与b1没有匹配,不能匹配的目标即舍弃。
需要说明的是,在对目标进行匹配时,可以采用最近邻算法、全局最近邻算法、联合概率关联算法等。例如,分别计算目标ai与被测传感器输出的所有目标{b1,b2......bm}的距离,并确定出与目标ai距离最小的目标(如,目标bj),然后进一步判断目标ai与目标bj的距离是否小于距离阈值,当目标ai与目标bj的距离小于距离阈值时,则认为目标ai和目标bj匹配成功。需要说明的是,上述距离,可以是广义的距离,包括但不限于欧氏距离、马氏距离等等。
S203、分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
在获取到匹配的目标对后,分别对每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度进行计算。
具体的,可通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,其中,匹配的目标对中参考传感器输出的目标ai和被测传感器输出的目标bj在车辆坐标系下的坐标分别为(xai,yai)和(xbj,ybj),通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)计算得到目标ai和目标bj的水平偏差角度。
S204、计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度;N为大于等于1的整数。
在分别计算出每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度后,统计N个目标对的水平偏差角度,然后求平均值,得到参考传感器A输出的目标和被测传感器B的水平偏差角度:
由于参考传感器A为经正确安装、标定以及校准的传感器,可认为其角度偏差很小,可以忽略。则被测传感器B的水平偏差角度即为:
δB=δ。
综上所述,本实施例在上述方法实施例1的基础上,仅获取车辆车速大于第一预设阈值时,参考传感器输出的目标和被测传感器输出的目标,进一步提高了传感器水平偏差角度的识别效率和准确率。
如图3所示,为本发明公开的一种传感器水平偏差角度的识别方法实施例3的方法流程图,所述方法应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述方法可以包括以下步骤:
S301、获取车辆横摆角速度的绝对值小于第二预设阈值时,参考传感器输出的目标和被测传感器输出的目标;
当需要对被测传感器B的水平偏差角度进行识别时,为避免车辆急转弯时传感器测量误差较大的影响,进一步提高识别到的被测传感器B水平偏差角度的准确性,分别获取车辆横摆角速度的绝对值小于第二预设阈值时,参考传感器A输出的目标和被测传感器B输出的目标。例如,仅在车辆横摆角速度的绝对值|ω|小于第二预设阈值ωmax时工作。其中,第二预设阈值ωmax可以按需选取。举例,一般车辆在单一车道直行的第二预设阈值可选择0.01rad/s。其中,获取到的目标包含的信息有目标的纵向位置、横向位置、纵向速度、横向速度等运动学信息。
S302、将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
然后,统一参考传感器A和被测传感器B的坐标系,即将参考传感器A和被测传感器B输出的目标转换到同一坐标系下。例如,可以将参考传感器A和被测传感器B的坐标系都转换至车辆坐标系。设车辆坐标系定义为:车辆前保中心为坐标原点,车辆正前方为x轴正方向,车辆左侧为y轴正方向。设传感器(参考传感器A或被测传感器B)的坐标系的定义为:坐标系原点在车辆坐标系的位置为(X0,Y0),传感器坐标系x轴正方向与车辆坐标系x轴夹角为θ。则在传感器坐标系中的(x_a,y_a)转换至车辆坐标系,坐标如下:
当车辆的横摆角速度的绝对值小于第二预设阈值ωmax时进被测传感器B的水平偏差角度校准。其中,第二预设阈值ωmax可以按需选取。举例,一般车辆在单一车道直行的第二预设阈值可选择0.01rad/s。其中,获取到的目标包含的信息有目标的纵向位置、横向位置、纵向速度、横向速度等运动学信息。
在将参考传感器A输出的目标和被测传感器B输出的目标转换到同一坐标系下后,进一步将被测传感器B输出的目标与参考传感器A输出的目标进行匹配,得到匹配的目标对。例如,如图5所示,获取到的参考传感器A输出的目标有{a1,a2......am},被测传感器B输出的目标有{b1,b2......bm}。其中,a1与b3匹配,a2与b2匹配,而a3与b1没有匹配,不能匹配的目标即舍弃。
需要说明的是,在对目标进行匹配时,可以采用最近邻算法、全局最近邻算法、联合概率关联算法等。例如,分别计算目标ai与被测传感器输出的所有目标{b1,b2......bm}的距离,并确定出与目标ai距离最小的目标(如,目标bj),然后进一步判断目标ai与目标bj的距离是否小于距离阈值,当目标ai与目标bj的距离小于距离阈值时,则认为目标ai和目标bj匹配成功。需要说明的是,上述距离,可以是广义的距离,包括但不限于欧氏距离、马氏距离等等。
S303、分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
在获取到匹配的目标对后,分别对每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度进行计算。
具体的,可通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,其中,匹配的目标对中参考传感器输出的目标ai和被测传感器输出的目标bj在车辆坐标系下的坐标分别为(xai,yai)和(xbj,ybj),通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)计算得到目标ai和目标bj的水平偏差角度。
S304、计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度。
在分别计算出每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度后,统计N个目标对的水平偏差角度,然后求平均值,得到参考传感器A输出的目标和被测传感器B的水平偏差角度:
由于参考传感器A为经正确安装、标定以及校准的传感器,可认为其角度偏差很小,可以忽略。则被测传感器B的水平偏差角度即为:
δB=δ。
综上所述,本实施例在上述方法实施例1的基础上,仅获取车辆横摆角速度的绝对值小于第二预设阈值时,参考传感器输出的目标和被测传感器输出的目标,避免了车辆急转弯时传感器测量误差较大的影响,进一步提高了传感器水平偏差角度的识别效率和准确率。
如图4所示,为本发明公开的一种传感器水平偏差角度的识别方法实施例4的方法流程图,所述方法应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述方法可以包括以下步骤:
S401、获取车辆车速大于第一预设阈值且车辆横摆角速度的绝对值小于第二预设阈值时,参考传感器输出的目标和所述被测传感器输出的目标;
当需要对被测传感器B的水平偏差角度进行识别时,为避免车辆急转弯时传感器测量误差较大的影响,以及进一步提高识别到的被测传感器B水平偏差角度的准确性,分别获取车辆车速大于第一预设阈值且车辆横摆角速度的绝对值小于第二预设阈值时,参考传感器A输出的目标和被测传感器B输出的目标。例如,仅获取在车速v大于第一预设阈值vmin且车辆横摆角速度的绝对值|ω|小于第二预设阈值ωmax时,参考传感器A输出的目标和被测传感器B输出的目标。其中,其中,第一预设阈值vmin可以按需选取。例如,一般包括城市道路正常行驶,可选择30km/h,仅包括高速公路正常行驶,可选择60km/h。第二预设阈值ωmax可以按需选取。举例,一般车辆在单一车道直行的第二预设阈值可选择0.01rad/s。其中,获取到的目标包含的信息有目标的纵向位置、横向位置、纵向速度、横向速度等运动学信息。
S402、将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;然后,统一参考传感器A和被测传感器B的坐标系,即将参考传感器A和被测传感器B输出的目标转换到同一坐标系下。例如,可以将参考传感器A和被测传感器B的坐标系都转换至车辆坐标系。设车辆坐标系定义为:车辆前保中心为坐标原点,车辆正前方为x轴正方向,车辆左侧为y轴正方向。设传感器(参考传感器A或被测传感器B)的坐标系的定义为:坐标系原点在车辆坐标系的位置为(X0,Y0),传感器坐标系x轴正方向与车辆坐标系x轴夹角为θ。则在传感器坐标系中的(x_a,y_a)转换至车辆坐标系,坐标如下:
第一预设阈值vmin可以按需选取。例如,一般包括城市道路正常行驶,可选择30km/h,仅包括高速公路正常行驶,可选择60km/h。第二预设阈值ωmax可以按需选取。举例,一般车辆在单一车道直行的第二预设阈值可选择0.01rad/s。其中,获取到的目标包含的信息有目标的纵向位置、横向位置、纵向速度、横向速度等运动学信息。
在将参考传感器A输出的目标和被测传感器B输出的目标转换到同一坐标系下后,进一步将被测传感器B输出的目标与参考传感器A输出的目标进行匹配,得到匹配的目标对。例如,如图5所示,获取到的参考传感器A输出的目标有{a1,a2......am},被测传感器B输出的目标有{b1,b2......bm}。其中,a1与b3匹配,a2与b2匹配,而a3与b1没有匹配,不能匹配的目标即舍弃。
需要说明的是,在对目标进行匹配时,可以采用最近邻算法、全局最近邻算法、联合概率关联算法等。例如,分别计算目标ai与被测传感器输出的所有目标{b1,b2......bm}的距离,并确定出与目标ai距离最小的目标(如,目标bj),然后进一步判断目标ai与目标bj的距离是否小于距离阈值,当目标ai与目标bj的距离小于距离阈值时,则认为目标ai和目标bj匹配成功。需要说明的是,上述距离,可以是广义的距离,包括但不限于欧氏距离、马氏距离等等。
S403、分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
在获取到匹配的目标对后,分别对每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度进行计算。
具体的,可通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,其中,匹配的目标对中参考传感器输出的目标ai和被测传感器输出的目标bj在车辆坐标系下的坐标分别为(xai,yai)和(xbj,ybj),通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)计算得到目标ai和目标bj的水平偏差角度。
S404、计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度。
在分别计算出每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度后,统计N个目标对的水平偏差角度,然后求平均值,得到参考传感器A输出的目标和被测传感器B的水平偏差角度:
由于参考传感器A为经正确安装、标定以及校准的传感器,可认为其角度偏差很小,可以忽略。则被测传感器B的水平偏差角度即为:
δB=δ。
综上所述,本实施例在上述方法实施例1的基础上,仅获取车辆车速大于第一预设阈值且车辆横摆角速度的绝对值小于第二预设阈值时,参考传感器输出的目标和被测传感器输出的目标,避免了车辆急转弯时传感器测量误差较大的影响,进一步提高了传感器水平偏差角度的识别效率和准确率。
如图6所示,为本发明公开的一种传感器水平偏差角度的识别系统实施例1的结构示意图,所述系统应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述系统可以包括:
获取模块601,用于获取参考传感器输出的目标和被测传感器输出的目标;
匹配模块602,用于将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
第一计算模块603,用于分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
第二计算模块604,用于计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度。
本实施例公开的传感器水平偏差角度的识别系统的工作原理与上述传感器水平偏差角度的识别方法实施例1公开的原理相同,在此不再赘述。
如图7所示,为本发明公开的一种传感器水平偏差角度的识别系统实施例2的结构示意图,所述系统应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述系统可以包括:
获取模块701,用于获取车辆车速大于第一预设阈值时,参考传感器输出的目标和被测传感器输出的目标;
匹配模块702,用于将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
第一计算模块703,用于分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
第二计算模块704,用于计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度。
本实施例公开的传感器水平偏差角度的识别系统的工作原理与上述传感器水平偏差角度的识别方法实施例2公开的原理相同,在此不再赘述。
如图8所示,为本发明公开的一种传感器水平偏差角度的识别系统实施例3的结构示意图,所述系统应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述系统可以包括:
获取模块801,用于获取车辆横摆角速度的绝对值小于第二预设阈值时,参考传感器输出的目标和所述被测传感器输出的目标;
匹配模块802,用于将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
第一计算模块803,用于分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
第二计算模块804,用于计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度。
本实施例公开的传感器水平偏差角度的识别系统的工作原理与上述传感器水平偏差角度的识别方法实施例3公开的原理相同,在此不再赘述。
如图9所示,为本发明公开的一种传感器水平偏差角度的识别系统实施例4的结构示意图,所述系统应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述系统可以包括:
获取模块901,用于获取车辆车速大于第一预设阈值且车辆横摆角速度的绝对值小于第二预设阈值时,参考传感器输出的目标和所述被测传感器输出的目标;
匹配模块902,用于将参考传感器和被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
第一计算模块903,用于分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
第二计算模块904,用于计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到被测传感器的水平偏差角度。
本实施例公开的传感器水平偏差角度的识别系统的工作原理与上述传感器水平偏差角度的识别方法实施例4公开的原理相同,在此不再赘述。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
专业人员还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以直接用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机存储器(RAM)、内存、只读存储器(ROM)、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其它形式的存储介质中。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (10)
1.一种传感器水平偏差角度的识别方法,其特征在于,应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述方法包括:
获取所述参考传感器输出的目标和所述被测传感器输出的目标;
将所述参考传感器和所述被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到所述被测传感器的水平偏差角度;N为大于等于1的整数。
2.根据权利要求1所述的方法,其特征在于,所述获取所述参考传感器输出的目标和所述被测传感器输出的目标,包括:
获取所述车辆车速大于第一预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
3.根据权利要求1所述的方法,其特征在于,所述获取所述参考传感器输出的目标和所述被测传感器输出的目标,包括:
获取所述车辆横摆角速度的绝对值小于第二预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
4.根据权利要求1所述的方法,其特征在于,所述获取所述参考传感器输出的目标和所述被测传感器输出的目标,包括:
获取所述车辆车速大于第一预设阈值,且所述车辆横摆角速度的绝对值小于第二预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
5.根据权利要求1所述的方法,其特征在于,所述分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,包括:
通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,其中,匹配的目标对中参考传感器输出的目标ai和被测传感器输出的目标bj在车辆坐标系下的坐标分别为(xai,yai)和(xbj,ybj),δk为目标ai和目标bj的水平偏差角度。
6.一种传感器水平偏差角度的识别系统,其特征在于,应用于车辆,所述车辆上安装有参考传感器和被测传感器,其中,所述参考传感器为经正确安装、标定以及校准的传感器;所述系统包括:
获取模块,用于获取所述参考传感器输出的目标和所述被测传感器输出的目标;
匹配模块,用于将所述参考传感器和所述被测传感器输出的目标转换到同一坐标系下,并进行匹配,得到匹配的目标对;
第一计算模块,用于分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度;
第二计算模块,用于计算N个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度的平均值,得到所述被测传感器的水平偏差角度;N为大于等于1的整数。
7.根据权利要求6所述的系统,其特征在于,所述获取模块在执行获取所述参考传感器输出的目标和所述被测传感器输出的目标时,具体用于:
获取所述车辆车速大于第一预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
8.根据权利要求6所述的系统,其特征在于,所述获取模块在执行获取所述参考传感器输出的目标和所述被测传感器输出的目标时,具体用于:
获取所述车辆横摆角速度的绝对值小于第二预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
9.根据权利要求6所述的系统,其特征在于,所述获取模块在执行获取所述参考传感器输出的目标和所述被测传感器输出的目标时,具体用于:
获取所述车辆车速大于第一预设阈值,且所述车辆横摆角速度的绝对值小于第二预设阈值时,所述参考传感器输出的目标和所述被测传感器输出的目标。
10.根据权利要求6所述的系统,其特征在于,所述第一计算模块在执行分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度时,具体用于:
通过公式δk=atan2(ybj,xbj)-atan2(yai,xai)分别计算每个匹配的目标对中被测传感器输出的目标与参考传感器输出的目标的水平偏差角度,其中,匹配的目标对中参考传感器输出的目标ai和被测传感器输出的目标bj在车辆坐标系下的坐标分别为(xai,yai)和(xbj,ybj),δk为目标ai和目标bj的水平偏差角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911301108.3A CN110967040B (zh) | 2019-12-17 | 2019-12-17 | 一种传感器水平偏差角度的识别方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911301108.3A CN110967040B (zh) | 2019-12-17 | 2019-12-17 | 一种传感器水平偏差角度的识别方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110967040A true CN110967040A (zh) | 2020-04-07 |
CN110967040B CN110967040B (zh) | 2021-11-23 |
Family
ID=70034628
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911301108.3A Active CN110967040B (zh) | 2019-12-17 | 2019-12-17 | 一种传感器水平偏差角度的识别方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110967040B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112731317A (zh) * | 2020-12-25 | 2021-04-30 | 北京百度网讯科技有限公司 | 车辆雷达标定方法、装置、设备、介质和自动驾驶车辆 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101013158A (zh) * | 2006-02-03 | 2007-08-08 | 通用汽车环球科技运作公司 | 用于车载对象跟踪系统的校准和定向的方法和设备 |
CN105738877A (zh) * | 2014-12-31 | 2016-07-06 | 现代摩比斯株式会社 | 雷达对准装置及其控制方法 |
CN106054191A (zh) * | 2015-04-06 | 2016-10-26 | 通用汽车环球科技运作有限责任公司 | 车轮检测和其在物体跟踪以及传感器配准中的应用 |
CN107179530A (zh) * | 2016-03-11 | 2017-09-19 | 罗伯特·博世有限公司 | 用于求取固定在车辆上的探测设备的失调的装置 |
CN109901123A (zh) * | 2018-12-24 | 2019-06-18 | 文远知行有限公司 | 传感器标定方法、装置、计算机设备和存储介质 |
CN109975773A (zh) * | 2018-12-28 | 2019-07-05 | 文远知行有限公司 | 毫米波雷达标定方法、装置、设备和存储介质 |
US20190293756A1 (en) * | 2018-03-21 | 2019-09-26 | Zoox, Inc. | Sensor calibration |
-
2019
- 2019-12-17 CN CN201911301108.3A patent/CN110967040B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101013158A (zh) * | 2006-02-03 | 2007-08-08 | 通用汽车环球科技运作公司 | 用于车载对象跟踪系统的校准和定向的方法和设备 |
CN105738877A (zh) * | 2014-12-31 | 2016-07-06 | 现代摩比斯株式会社 | 雷达对准装置及其控制方法 |
CN106054191A (zh) * | 2015-04-06 | 2016-10-26 | 通用汽车环球科技运作有限责任公司 | 车轮检测和其在物体跟踪以及传感器配准中的应用 |
CN107179530A (zh) * | 2016-03-11 | 2017-09-19 | 罗伯特·博世有限公司 | 用于求取固定在车辆上的探测设备的失调的装置 |
US20190293756A1 (en) * | 2018-03-21 | 2019-09-26 | Zoox, Inc. | Sensor calibration |
CN109901123A (zh) * | 2018-12-24 | 2019-06-18 | 文远知行有限公司 | 传感器标定方法、装置、计算机设备和存储介质 |
CN109975773A (zh) * | 2018-12-28 | 2019-07-05 | 文远知行有限公司 | 毫米波雷达标定方法、装置、设备和存储介质 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112731317A (zh) * | 2020-12-25 | 2021-04-30 | 北京百度网讯科技有限公司 | 车辆雷达标定方法、装置、设备、介质和自动驾驶车辆 |
CN112731317B (zh) * | 2020-12-25 | 2024-03-19 | 北京百度网讯科技有限公司 | 车辆雷达标定方法、装置、设备、介质和自动驾驶车辆 |
Also Published As
Publication number | Publication date |
---|---|
CN110967040B (zh) | 2021-11-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109031272B (zh) | 确定目标的去混叠距离变化率的方法 | |
CN111398924B (zh) | 雷达安装角度标定方法及系统 | |
EP2926330B1 (en) | Vehicle location estimation apparatus and vehicle location estimation method | |
US10830885B2 (en) | Parking mode determining system | |
US9645236B2 (en) | Target detection apparatus and program | |
US20160209211A1 (en) | Method for determining misalignment of an object sensor | |
CN112415502B (zh) | 雷达装置 | |
CN111624566B (zh) | 雷达安装角度校准方法及装置 | |
US11300415B2 (en) | Host vehicle position estimation device | |
US20140032078A1 (en) | Apparatus and method for calculating inter-vehicle distance | |
CN112083441B (zh) | 激光雷达和毫米波雷达深度融合的障碍物检测方法及系统 | |
JP2015525873A (ja) | 車両用レーダセンサのミスアライメント処理 | |
WO2018212292A1 (ja) | 情報処理装置、制御方法、プログラム及び記憶媒体 | |
US11500080B2 (en) | Axis deviation detection device for on-board LIDAR | |
US20240053468A1 (en) | Vehicle-mounted bsd millimeter wave radar based method for obstacle recognition at low speed | |
US11408989B2 (en) | Apparatus and method for determining a speed of a vehicle | |
CN109597037B (zh) | 一种雷达标定方法及装置 | |
JP2011043387A (ja) | 車載レーダシステム | |
US11307292B2 (en) | ODM information reliability determination system and method and vehicle using the same | |
CN110967040B (zh) | 一种传感器水平偏差角度的识别方法及系统 | |
JP4850531B2 (ja) | 車載レーダ装置 | |
CN110095776B (zh) | 用于确定对象的存在和/或特性的方法和周围环境识别设备 | |
CN113625234A (zh) | 一种车辆雷达的安装角度校正方法及一种车辆雷达 | |
CN111959515A (zh) | 一种基于视觉检测的前向目标选择方法、装置及系统 | |
JP2006275748A (ja) | レーダの軸ずれ量決定装置 |
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 | ||
CB02 | Change of applicant information |
Address after: 4 / F, building 1, No.14 Jiuxianqiao Road, Chaoyang District, Beijing 100020 Applicant after: Beijing Jingwei Hirain Technologies Co.,Inc. Address before: 8 / F, block B, No. 11, Anxiang Beili, Chaoyang District, Beijing 100101 Applicant before: Beijing Jingwei HiRain Technologies Co.,Ltd. |
|
CB02 | Change of applicant information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |