发明名称 一种航空器飞行轨迹跳变去除的方法
摘要 本发明公开了一种航空器飞行轨迹跳变去除的方法,包括以下步骤:构建一个对应类型的非固定时间间隔的三次多项式拟合算法,求出海拔、角度、地速、垂直速度对应的预测值并存储;在接收到经纬度值时,若集合中在当前时间之前1分钟范围内的经纬度元素数量小于3,则不进行计算并跳出;否则将当前时间经纬度分别与上一个时间点的经纬度、上上一个时间点的经纬度进行比对:计算预测距离和实际距离,比较预测距离与实际距离的差、预测距离与实际距离二者之中的较大者得出数据可信度权重;数据可信度权重<1,则视作可信数据进行存储。本发明能够解决定位经纬度或高度跳变的问题,使实时定位数据更准确,并以更平滑的数据展现航空器的飞行轨迹。
申请公布号 CN106530838A 申请公布日期 2017.03.22
申请号 CN201610931969.X 申请日期 2016.10.25
申请人 合肥飞友网络科技有限公司 发明人 张重阳;宣彤;郑洪峰
分类号 G08G5/00(2006.01)I 主分类号 G08G5/00(2006.01)I
代理机构 代理人
主权项 一种航空器飞行轨迹跳变去除的方法,其特征是,包括以下步骤:S1、在接收到经纬度<img file="dest_path_dest_path_image001.GIF" wi="36" he="31" />、海拔<img file="dest_path_676665dest_path_image002.GIF" wi="30" he="28" />、角度<img file="dest_path_769210dest_path_image003.GIF" wi="35" he="31" />、地速<img file="dest_path_163282dest_path_image004.GIF" wi="34" he="31" />、垂直速度<img file="dest_path_387590dest_path_image005.GIF" wi="41" he="32" />时,用t表示接收该数据的时间戳,将元数据记录到对应最近三分钟数据的集合<img file="dest_path_917929dest_path_image006.GIF" wi="16" he="14" />中;S2、在接收到<img file="dest_path_671121dest_path_image007.GIF" wi="254" he="37" />值时,构建一个对应类型的非固定时间间隔的三次多项式拟合算法运算对象<img file="dest_path_83648dest_path_image008.GIF" wi="14" he="13" />;<img file="dest_path_580488dest_path_image008.GIF" wi="12" he="12" />用于对一维的时序数据的每个时间区间进行插值,从而达到短时间内数据预测的目的;S3、求出<img file="dest_path_230913dest_path_image009.GIF" wi="251" he="37" />对应的预测值<img file="dest_path_420586dest_path_image010.GIF" wi="16" he="18" />:<img file="dest_path_789250dest_path_image011.GIF" wi="173" he="188" />并将<img file="dest_path_824202dest_path_image010.GIF" wi="16" he="18" />作为实际值进行存储;S4、在接收到<img file="dest_path_125870dest_path_image012.GIF" wi="35" he="29" />值时,若<img file="dest_path_453821dest_path_image013.GIF" wi="41" he="28" />中在当前时间之前1分钟范围内的元素数量小于3,则不进行计算并跳出;否则,将当前时间经纬度<img file="dest_path_309782dest_path_image014.GIF" wi="35" he="30" />分别与上一个时间点的经纬度<img file="dest_path_679583dest_path_image015.GIF" wi="41" he="32" />、上上一个时间点的经纬度<img file="dest_path_39020dest_path_image016.GIF" wi="42" he="32" />进行比对,比对过程包括以下步骤:S41、定义两个函数B和K,其中,B表示求两个经纬度之间的地球球面距离,K表示求两个航空器地速之间飞行的地球球面距离:<img file="dest_path_304917dest_path_image017.GIF" wi="182" he="89" />S42、依据定义的函数B求出当前位置与前两个定位位置的实际距离:<img file="dest_path_913753dest_path_image018.GIF" wi="192" he="90" />S43、因为速度向量与位置向量的时间戳并不同步,需要求出当前位置时间点(t3)、前两个位置时间点(t1,t2)的预测速度:<img file="dest_path_556087dest_path_image019.GIF" wi="174" he="88" /><img file="dest_path_566768dest_path_image020.GIF" wi="165" he="40" />S44、依据定义的函数K求出两时间点间的预测距离:<img file="dest_path_534724dest_path_image021.GIF" wi="189" he="90" />S45、设误差度为<img file="dest_path_99697dest_path_image022.GIF" wi="15" he="16" />,预测距离与实际距离的差为<img file="dest_path_811301dest_path_image023.GIF" wi="34" he="22" />,预测距离与实际距离二者之中的较大者为<img file="dest_path_145331dest_path_image024.GIF" wi="73" he="18" />,将<img file="dest_path_753030dest_path_image023.GIF" wi="34" he="22" />与<img file="dest_path_336458dest_path_image024.GIF" wi="73" he="18" />进行比较求值,得出数据可信度权重<img file="dest_path_553550dest_path_image025.GIF" wi="17" he="16" />:<img file="dest_path_7665dest_path_image026.GIF" wi="190" he="221" />得到的<img file="dest_path_317424dest_path_image025.GIF" wi="17" he="16" />即为当前接收到的经纬度值<img file="dest_path_325831dest_path_image027.GIF" wi="37" he="31" />的可信度,若&lt;1,则将<img file="dest_path_848079dest_path_image027.GIF" wi="36" he="31" />视作可信数据进行存储。
地址 230001 安徽省合肥市宿州路4号欣都大厦3009室