本发明涉及一种基于gps的仿真航迹推算传感器方法,根据gps提供的测量仿真实现航迹推算传感器,其特征在于在gps信号不能覆盖的区域利用gps采集的历史数据估计线速度和角速度。
背景技术:
基于gps的导航和定位已经广泛应用于汽车、飞机、船舶、手机等设备,在智能交通、智慧城市、机器人导航等领域被广泛使用。
航迹推算是根据本体的运行线速度和角速度来估计本体自身位姿的过程,通常利用编码器和陀螺仪等传感器来测量线速度和角速度。当没有这类传感器时,如何利用gps信息来仿真实现编码器和陀螺仪等航迹推算传感器的功能,具有非常重要的实际价值。
在现有技术中,李昇智等人提出了一种基于gps轨迹数据的混合多步markov位置预测方法(参见,李昇智,乔建忠,林树宽,杨迪;《基于gps轨迹数据的混合多步markov位置预测》,东北大学学报(自然科学版),2017年第12期1686-1690页)。该方法提出了基于混合多步markov模型的位置预测方法,在将原始gps轨迹转化为区域轨迹的基础上,对各多步模型进行融合,利用adaboost算法确定多步模型影响系数。
其不足在于没有利用gps测量提供的精度信息。
技术实现要素:
本发明的目的在于克服上述技术存在的缺陷,提供一种基于gps的仿真航迹推算传感器方法,根据gps提供的测量仿真实现航迹推算传感器,其特征在于利用了gps测量精度信息,在gps信号不能覆盖的区域利用gps采集的历史数据估计线速度和角速度。
其具体技术方案包括以下步骤:
输入:gps测量数据
其中,
输出:
步骤1:r=6371,
步骤2:t=t+1;
步骤3:获取时间步t的纬度
步骤4:如果
步骤5:
步骤6:
步骤7:
步骤8:
步骤9:
步骤10:
步骤11:
步骤12:如果
步骤13:
步骤14:如果t<n,转步骤2;如果t>=n,结束。
与现有技术相比,本发明的有益效果为:在gps信号不能覆盖的区域也能利用gps采集的历史数据估计线速度和角速度。
具体实施方式
为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体实例进一步阐述本发明。
一种基于gps的仿真航迹推算传感器方法,根据gps提供的测量仿真实现航迹推算传感器,其特征在于在gps信号不能覆盖的区域利用gps采集的历史数据估计线速度和角速度,包括以下步骤:
输入:gps测量数据
其中,
输出:
步骤1:r=6371,
步骤2:t=t+1;
步骤3:获取时间步t的纬度
步骤4:如果
步骤5:
步骤6:
步骤7:
步骤8:
步骤9:
步骤10:
步骤11:
步骤12:如果
步骤13:
步骤14:如果t<n,转步骤2;如果t>=n,结束。
以上所述,仅为本发明最佳实施方式,任何熟悉本技术领域的技术人员在本发明披露的技术范围内,可显而易见地得到的技术方案的简单变化或等效替换均落入本发明的保护范围内。