发明名称 一种防追尾碰撞的前方车辆有效目标确定方法
摘要 本发明公开了一种防追尾碰撞的前方车辆有效目标确定方法,首先根据获取的周边车辆和自车的相对运动信息和绝对运动信息,初选出本车道内除自车外的周边车辆,然后计算出周边车辆与自车的相对距离、周边车辆与自车车体坐标系纵轴方向的夹角,并与初选出的本车道内周边车辆信息进行验证匹配,剔除不可靠目标,得到本车道内所有的可靠车辆,最后根据最小纵向距离原则确定有效目标。本发明方法可以有效地解决雷达虚假目标过多的问题,同时提高雷达对目标搜索的可靠性,对环境的适应性也更强。
申请公布号 CN103761889A 申请公布日期 2014.04.30
申请号 CN201410053377.3 申请日期 2014.02.17
申请人 东南大学 发明人 李旭;严思宁;宋翔;张为公
分类号 G08G1/16(2006.01)I 主分类号 G08G1/16(2006.01)I
代理机构 江苏永衡昭辉律师事务所 32250 代理人 王斌
主权项 1.一种防追尾碰撞的前方车辆有效目标确定方法,其特征在于,该方法首先根据获取的周边车辆和自车的相对运动信息和绝对运动信息,初选出本车道内除自车外的周边车辆,然后计算出周边车辆与自车的相对距离、周边车辆与自车车体坐标系纵轴方向的夹角,并与初选出的本车道内周边车辆信息进行验证匹配,剔除不可靠目标,得到本车道内所有的可靠车辆,最后根据最小纵向距离原则确定有效目标;具体步骤为:1)接收自车和周边车辆的相对运动信息和绝对运动信息,所述相对运动信息包括目标与自车的相对速度v<sub>k</sub>、相对距离d<sub>k</sub>,目标与自车车体坐标系纵轴方向的夹角α<sub>k</sub>,所述绝对运动信息包括自车的绝对位置坐标x<sub>0</sub>,y<sub>0</sub>和绝对速度v<sub>0</sub>,周边车辆的绝对位置坐标x<sub>l</sub>,y<sub>l</sub>,其中k为获取相对运动信息时的目标序号,k=1,2,3...i,i为获取相对运动信息时能够接收到的最大目标数,l表示获取绝对运动信息时的周边车辆序号,l=1,2,3,4...j,j为获取绝对运动信息时自车能够接收到的最大周边车辆数量;2)初选出本车道内除自车外的周边车辆,具体流程为:首先,根据下式确定本车道的初选目标:sin(α<sub>k</sub>)·d<sub>k</sub>≤2米根据下式确定静止目标,然后将所述静止目标从初选目标中剔除:<img file="FDA0000466369920000011.GIF" wi="538" he="162" />将满足以下任一条件的目标确定为无效目标,然后将所述无效目标从初选目标中剔除:目标信号连续出现的次数小于5次;|α<sub>k</sub>(n+1)-α<sub>k</sub>(n)|≥3(°);|d<sub>k</sub>(n+1)-d<sub>k</sub>(n)|≥5米;|v<sub>k</sub>(n+1)-v<sub>k</sub>(n)|≥5米/秒;其中n代表获取相对运动信息时的采样点序号,n=1,2,3,4...;3)根据下式计算出周边车辆与自车的相对距离d'<sub>l</sub>:<maths num="0001"><![CDATA[<math><mrow><msub><msup><mi>d</mi><mo>&prime;</mo></msup><mi>l</mi></msub><mo>=</mo><msqrt><msup><mrow><mo>(</mo><msub><mi>x</mi><mi>l</mi></msub><mo>-</mo><msub><mi>x</mi><mn>0</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>y</mi><mi>l</mi></msub><mo>-</mo><msub><mi>y</mi><mn>0</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></msqrt></mrow></math>]]></maths>同时根据下式计算出周边车辆与自车车体坐标系纵轴方向的夹角α'<sub>l</sub>:<maths num="0002"><![CDATA[<math><mrow><msub><msup><mi>&alpha;</mi><mo>&prime;</mo></msup><mi>l</mi></msub><mo>=</mo><mi>arctan</mi><mrow><mo>(</mo><mfrac><mrow><mo>|</mo><msub><mi>x</mi><mi>l</mi></msub><mo>-</mo><msub><mi>x</mi><mn>0</mn></msub><mo>|</mo></mrow><mrow><mo>|</mo><msub><mi>y</mi><mi>l</mi></msub><mo>-</mo><msub><mi>y</mi><mn>0</mn></msub><mo>|</mo></mrow></mfrac><mo>)</mo></mrow></mrow></math>]]></maths>4)按照如下方法进行验证匹配,剔除不可靠目标,得到本车道内所有的可靠车辆:将各周边车辆与自车的相对距离d'<sub>l</sub>,同所述步骤2)中初选出的各周边车辆与自车的相对距离d<sub>k</sub>逐一进行对比,将各周边车辆与自车车体坐标系纵轴方向的夹角α'<sub>l</sub>,同所述步骤2)中初选出的各周边车辆与自车车体坐标系纵轴方向的夹角α<sub>k</sub>逐一进行对比;若存在一组<maths num="0003"><![CDATA[<math><mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>d</mi><mi>k</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&alpha;</mi><mi>k</mi></msub></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths>满足下式:<maths num="0004"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><msub><msup><mi>d</mi><mo>&prime;</mo></msup><mi>l</mi></msub><mo>=</mo><msub><mi>d</mi><mi>k</mi></msub><mo>+</mo><mi>&Delta;</mi><msub><msup><mi>d</mi><mo>&prime;</mo></msup><mi>l</mi></msub></mtd></mtr><mtr><mtd><msub><msup><mi>&alpha;</mi><mo>&prime;</mo></msup><mi>l</mi></msub><mo>=</mo><msub><mi>&alpha;</mi><mi>k</mi></msub><mo>+</mo><mi>&Delta;</mi><msub><msup><mi>&alpha;</mi><mo>&prime;</mo></msup><mi>l</mi></msub></mtd></mtr></mtable></mfenced></math>]]></maths>则判定该组<maths num="0005"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><msup><msub><mi>d</mi><mi>l</mi></msub><mo>&prime;</mo></msup></mtd></mtr><mtr><mtd><msup><msub><mi>&alpha;</mi><mi>l</mi></msub><mo>&prime;</mo></msup></mtd></mtr></mtable></mfenced></math>]]></maths>对应的周边车辆是本车道内的可靠车辆,其中Δd'<sub>l</sub>为计算周边车辆与自车的相对距离时的微小误差,Δα'<sub>l</sub>为计算周边车辆与自车车体坐标系纵轴方向的夹角时的微小误差;5)根据下式分别计算本车道内各可靠车辆与自车的纵向距离s:s=cos(α'<sub>l</sub>)·d'<sub>l</sub>,然后将与自车的纵向距离最小的可靠车辆确定为有效目标。
地址 210096 江苏省南京市四牌楼2号