发明名称 一种交互式多车辆跟踪方法及装置
摘要 本发明提供了一种交互式多车辆跟踪方法及装置,所述方法包括:S1.建立多车辆交互的车辆跟踪模型;S2.利用传感器分别获取每个待跟踪车辆在第k时刻的测量信息;其中,一个传感器对应一个待跟踪车辆;S3.根据步骤S2获取的测量信息,以及步骤S1建立的车辆跟踪模型,利用非扩维方法估计待跟踪车辆的运动状态参数,实现对待跟踪车辆的跟踪。本发明提供的交互式多车辆跟踪方法,能够获得较为准确的车辆跟踪结果。
申请公布号 CN106228805A 申请公布日期 2016.12.14
申请号 CN201610509927.7 申请日期 2016.06.30
申请人 北京航空航天大学 发明人 李文玲;贾英民
分类号 G08G1/01(2006.01)I 主分类号 G08G1/01(2006.01)I
代理机构 北京路浩知识产权代理有限公司 11002 代理人 李相雨
主权项 一种交互式多车辆跟踪方法,其特征在于,包括以下步骤:S1:建立多车辆交互的车辆跟踪模型:<maths num="0001"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><msub><mi>x</mi><mrow><mi>i</mi><mo>,</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>=</mo><mi>f</mi><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>)</mo><mo>+</mo><mstyle><munderover><mo>&Sigma;</mo><mrow><mi>j</mi><mo>=</mo><mn>1</mn><mo>,</mo><mi>j</mi><mo>&NotEqual;</mo><mi>i</mi></mrow><mi>N</mi></munderover><mrow><msub><mi>w</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><mi>&Gamma;</mi><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>j</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>-</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>)</mo></mrow></mrow></mstyle><mo>+</mo><msub><mi>B</mi><mrow><mi>i</mi><mo>,</mo><mi>k</mi></mrow></msub><msub><mover><mi>w</mi><mo>&OverBar;</mo></mover><mrow><mi>i</mi><mo>,</mo><mi>k</mi></mrow></msub></mtd></mtr><mtr><mtd><mrow><msub><mi>y</mi><mrow><mi>i</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>=</mo><mi>h</mi><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>v</mi><mrow><mi>i</mi><mo>,</mo><mi>k</mi></mrow></msub></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0001037839630000011.GIF" wi="934" he="223" /></maths>其中,y<sub>i,k</sub>表示第k时刻第i个传感器获得的测量信息;x<sub>i,k+1</sub>表示第k+1时刻第i个待跟踪车辆的运动状态参数;f(x)函数与h(x)函数是状态方程与观测方程中的非线性函数;w<sub>ij</sub>表示第i个待跟踪车辆与第j个待跟踪车辆之间的交互强度;Γ表示第i个待跟踪车辆与第j个待跟踪车辆之间状态的耦合矩阵;<img file="FDA0001037839630000012.GIF" wi="70" he="61" />与v<sub>i,k</sub>表示第k时刻的系统噪声与观测噪声,B<sub>i,k</sub>表示第k时刻系统的适维矩阵;S2、利用传感器分别获取每个待跟踪车辆在第k时刻的测量信息,其中,一个传感器对应一个待跟踪车辆;S3、根据步骤S2获取的测量信息,以及步骤S1建立的车辆跟踪模型,利用非扩维方法估计待跟踪车辆的运动状态参数,实现对待跟踪车辆的跟踪。
地址 100191 北京市海淀区学院路37号北京航空航天大学