发明名称 无人飞行器对地面目标运动轨迹预测的装置及其方法
摘要 本发明公开了一种无人飞行器对地面目标运动轨迹预测的装置及其方法,其移动目标数据采集模块通过无人飞行器的机载装置中的机载传感器系统采集地面移动目标的数据;移动目标数据处理模块将地面移动目标轨迹三维极坐标换算成三维直角坐标,并对目标轨迹数据进行标准化处理后进行分析预测;移动目标轨迹生成模块调用预测方法库中的地面移动目标轨迹预测的方法,对移动目标的轨迹标准化数据进行分析预测,并生成预测结果;移动目标轨迹推荐模块结合标准化数据和预测结果计算出当前移动目标轨迹预测结果的推荐度。本发明的地面目标运动轨迹预测的装置及其方法,具有可有效的预测地面移动目标的轨迹、为无人机任务规划系统提供可靠信息等优点。
申请公布号 CN103995968B 申请公布日期 2017.01.25
申请号 CN201410221759.2 申请日期 2014.05.22
申请人 合肥工业大学 发明人 罗贺;曹杰;孙锦波;胡笑旋;马华伟;靳鹏;夏维;王国强;张冰洁;朱默宁
分类号 G06F19/00(2011.01)I;G05D1/12(2006.01)I 主分类号 G06F19/00(2011.01)I
代理机构 安徽省合肥新安专利代理有限责任公司 34101 代理人 何梅生
主权项 无人飞行器对地面目标运动轨迹预测的装置,其特征是,设置在无人飞行器的机载装置之中,包括移动目标数据采集模块、移动目标数据处理模块、移动目标轨迹生成模块和移动目标轨迹推荐模块;所述移动目标数据采集模块,用于通过所述无人飞行器的机载装置中的机载传感器系统采集地面移动目标的数据;所述移动目标数据处理模块,用于通过将所述地面移动目标轨迹三维极坐标换算成三维直角坐标,并根据具体的数据类型选择对应的预处理方法对地面移动目标轨迹数据进行标准化处理,从而便于对地面移动目标轨迹数据进行分析预测;所述标准化处理的过程包括地面移动目标轨迹原始数据的累加的步骤;所要预测的地面移动目标轨迹原始X坐标值经标准化处理后得到的序列为:x<sup>(0)</sup>={x<sup>(0)</sup>(1),x<sup>(0)</sup>(2),x<sup>(0)</sup>(3),…,x<sup>(0)</sup>(n)};所述地面移动目标轨迹原始数据的累加,即对地面移动目标轨迹原始X坐标值序列进行累加处理,构造地面移动目标轨迹X坐标值背景值节点序列<img file="FDA0001118507270000011.GIF" wi="325" he="87" />令<img file="FDA0001118507270000012.GIF" wi="1518" he="151" />公式(1)中,x<sup>(1)</sup>(k)是将地面移动目标轨迹原始X坐标上离散的随机数经过依次累加,削弱其随机性,得到生成数,即:<img file="FDA0001118507270000013.GIF" wi="693" he="119" />在对所述移动目标处理模块得到的移动目标的轨迹标准化数据进行分析预测过程中,包括地面移动目标轨迹的背景值生成的步骤;所述地面移动目标轨迹的背景值生成公式为:<img file="FDA0001118507270000014.GIF" wi="1508" he="104" />公式(2)中,k=1,2,...,n‑1;公式(2)中的h(x)就是所构造的唯一存在的埃尔米特插值多项式,即:<maths num="0001"><math><![CDATA[<mrow><mi>h</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><munderover><mo>&Sigma;</mo><mrow><mi>k</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><mi>f</mi><mrow><mo>(</mo><msub><mi>x</mi><mi>k</mi></msub><mo>)</mo></mrow><msub><mi>&alpha;</mi><mi>k</mi></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>+</mo><munderover><mo>&Sigma;</mo><mrow><mi>k</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msup><mi>f</mi><mo>&prime;</mo></msup><mrow><mo>(</mo><msub><mi>x</mi><mi>k</mi></msub><mo>)</mo></mrow><msub><mi>&beta;</mi><mi>k</mi></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001118507270000015.GIF" wi="1438" he="119" /></maths>公式(3)中,f′(x<sub>k</sub>)=S′(x<sub>k</sub>),<img file="FDA0001118507270000016.GIF" wi="766" he="157" />β<sub>k</sub>(x)=(x‑x<sub>k</sub>)l<sup>2</sup>(x<sub>k</sub>),<img file="FDA0001118507270000021.GIF" wi="1288" he="126" />S′(x<sub>k</sub>)就是利用三次样条插值生成的地面移动目标轨迹X坐标背景值节点的一阶导数值,即:<maths num="0002"><math><![CDATA[<mrow><msup><mi>S</mi><mo>&prime;</mo></msup><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><mo>-</mo><msub><mi>M</mi><mrow><mi>i</mi><mo>-</mo><mn>1</mn></mrow></msub><mfrac><msup><mrow><mo>(</mo><msub><mi>x</mi><mi>i</mi></msub><mo>-</mo><mi>x</mi><mo>)</mo></mrow><mn>2</mn></msup><mn>2</mn></mfrac><mo>+</mo><msub><mi>M</mi><mi>i</mi></msub><mfrac><msup><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>-</mo><mi>x</mi><mo>)</mo></mrow><mn>2</mn></msup><mn>2</mn></mfrac><mo>+</mo><msub><mi>A</mi><mi>i</mi></msub><mo>,</mo><mi>x</mi><mo>&Element;</mo><mo>&lsqb;</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>,</mo><msub><mi>x</mi><mi>i</mi></msub><mo>&rsqb;</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001118507270000022.GIF" wi="1581" he="127" /></maths>公式(4)中,M<sub>i</sub>=S″(x<sub>i</sub>),M<sub>1</sub>=M<sub>n</sub>=0,<img file="FDA0001118507270000023.GIF" wi="966" he="118" />在对所述移动目标处理模块得到的移动目标的轨迹标准化数据进行分析预测过程中,包括建立地面移动目标轨迹预测的灰色预测模型的步骤;所述地面移动目标轨迹预测的灰色预测模型为灰色系统GM(1,1)模型;即:<maths num="0003"><math><![CDATA[<mrow><mover><msup><mi>x</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msup><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>&lsqb;</mo><mover><msup><mi>x</mi><mrow><mo>(</mo><mn>0</mn><mo>)</mo></mrow></msup><mo>^</mo></mover><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mfrac><mi>u</mi><mi>a</mi></mfrac><mo>&rsqb;</mo><msup><mi>e</mi><mrow><mo>-</mo><mi>a</mi><mi>t</mi></mrow></msup><mo>+</mo><mfrac><mi>u</mi><mi>a</mi></mfrac><mo>,</mo><mi>t</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2...</mn><mi>n</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001118507270000024.GIF" wi="1566" he="150" /></maths>式(5)中:a,u均为估计参数;a为发展系数,u为灰色作用量;估计参数a,u是由最小二乘法拟合求取的;即:<maths num="0004"><math><![CDATA[<mrow><mfenced open = "[" close = "]"><mtable><mtr><mtd><mi>a</mi></mtd></mtr><mtr><mtd><mi>u</mi></mtd></mtr></mtable></mfenced><mo>=</mo><msup><mrow><mo>(</mo><msup><mi>B</mi><mi>T</mi></msup><mi>B</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><msup><mi>B</mi><mi>T</mi></msup><mi>Y</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001118507270000025.GIF" wi="1294" he="144" /></maths>式(6)中:<maths num="0005"><math><![CDATA[<mrow><mi>B</mi><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mo>-</mo><msup><mi>z</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msup><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mo>...</mo></mtd><mtd><mo>...</mo></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msup><mi>z</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msup><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow></mrow></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001118507270000026.GIF" wi="374" he="231" /></maths>Y=[x<sup>(0)</sup>(2),x<sup>(0)</sup>(3),…,x<sup>(0)</sup>(n)]<maths num="0006"><math><![CDATA[<mrow><mi>u</mi><mo>=</mo><mfrac><mrow><msup><mi>dx</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow><mrow><mi>d</mi><mi>t</mi></mrow></mfrac><mo>+</mo><msup><mi>ax</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msup><mo>;</mo></mrow>]]></math><img file="FDA0001118507270000027.GIF" wi="382" he="149" /></maths>所述移动目标轨迹生成模块:用于调用预测方法库中的地面移动目标轨迹预测的方法,对所述移动目标处理模块得到的移动目标的轨迹标准化数据进行分析预测,并生成地面移动目标轨迹的预测结果;所述移动目标轨迹推荐模块:用于结合地面移动目标轨迹的标准化数据和移动目标轨迹的预测结果计算出当前所述移动目标轨迹预测结果的推荐度,然后判断所述推荐度是否小于或等于系统设定的推荐阈值。
地址 230009 安徽省合肥市包河区屯溪路193号