简介:为实现无人机高精度高可靠性导航,提出了一种以捷联惯性导航系统(SINS)为主,以地形辅助导航(TAN)、大气数据系统(ADS)及电子磁罗盘(MCP)为辅的组合导航方式。通过分析SINS、TAN、ADS及MCP单一系统的工作原理及输出误差模型,构建了SINS/TAN、SINS/ADS及SINS/MCP系统的状态方程及观测方程,最后采用联邦卡尔曼滤波方式实现了对各组合系统的信息融合。仿真数据对比表明:SINS/TAN系统位置误差较小,但航向误差较大;SINS/ADS系统速度误差较小且比较稳定,但位置误差随时间发散;SINS/MCP系统航向误差方差可达0.3783’,但其位置和速度估计精度不理想;而SINS/TAN/ADS/MCP系统能够克服上述不足,实现所有导航参数误差估计的高精度。
简介:FsText3=TmeShowStateVal(Fs)Text1=LatLabel3.Caption=LatStrText2=LodLabel4.Caption=LodStrText4=SpdText5=AngForm1.Caption="实验卫星导航系统-"&,Len(Text2.Text)-l-1))CurrLog=d+f*60+m*3600’取得当前纬度k=InStr(Text1.Text,Len(Text1.Text)-l-1))CurrLat=d+f*60+m*3600’计算当前位置在Picture2控件中的坐标X=(LogL-CurrLog)*picutre2.Width/(LogL-LogR)Y=(LatB-CurrLat)*Picture2.Height/(LatB-LatT)’将当前位置标示图标移到坐标所在处Image1.Left=XImage1.Top=Y’移动地图位置