文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 自然科学 > 天文/地理 > GPS_INS组合导航系统数据同步处理方法研究
侵权投诉

GPS_INS组合导航系统数据同步处理方法研究

716武汉大学学报#信息科学版2008年7月

标准时刻,则在融合时间段(tk-1,tk]内,GPS接收

2 组合导航系统的数据同步方法

当GPS/INS采用软件模式进行组合时,GPS接收机和INS一般通过RS-232或RS-422接口输出各自的NMEA-0183格式导航数据包。GPS的导航数据包不仅包含有纬度、经度、海拔高度等当前位置信息,还包含当前位置所对应的UTC时间信息。INS的导航数据包也包含有姿态角速率和位置加速度等导航信息,但所包含的时间信息并非UTC这一国际标准时间,这是因为INS没有统一的时间参照系,每种INS产品内部的时钟频率标准都是生产厂家自定的。所以,针对GPS/INS组合导航系统的两个子系统各自使用不同的时钟频率标准的问题,若要将它们的数据在同一时刻配准,必须先将其统一到一个公共的时间参照系中。由于卡尔曼滤波一般都是通过计算机来完成,所以不妨以计算机所使用的当地时间作为两个子系统处理数据的公共时间参照系。另外,两个子系统在完成测量并更新数据后要通过串口把数据传输到计算机,计算机在接收到数据后,还要先对其进行预处理(如对INS输出的姿态角速率进行积分才能得到载体姿态角的信息)才会开始滤波运算;由于数据传输和预处理都要花费时间,GPS/INS组合系统在作数据同步时[7,8],需要同步的数据所对应的时刻是其更新时刻,而不是计算机对其进行滤波的时刻。2.1 获取两路数据的更新同步时间差$t

设GPS接收机的数据更新周期为TGPS,INS的数据更新周期为TINS,卡尔曼滤波的滤波周期为T,并且TGPS和TINS满足比例关系:TGPS=NTINS(N为正整数)。在第k个融合时间段(t

k-1k

[6]

机和INS的数据同步时间差$t为:

kk

$tk=tkI(N)-tGU tkI(N)- tkG=$S(N)

(7)

另有:

T=TGPS(8) 在某个融合时间段,只要得到计算机接收两路导航数据的时间差$S(i)(i=1,2,,,N),就可以近似得到数据更新同步时间差$t。

显然,要得到某个融合时间段的$S(i)(i=1,2,,,N),则只需要分别获得计算机在此时间段内接收到GPS接收机和INS数据包首字节的时刻tG 和tI (i)(i=1,2,,,N),即给计算机接收到的两路导航数据打上到达时的时间戳。对于一个实际的GPS/INS车载导航系统而言,假定要求其满足的导航定位精度为10cm,又若车辆以120km/h的速度行驶,则系统的时间同步误差必须小于3ms,也即要求得到的计算机系统时间达到ms级。在VisualC++中,可通过使用GetSystemTime()这个API函数来得到系统精确到ms的时间。2.2 插值运算

若已经得到了GPS接收机和INS在某个融合时间段内的数据同步时间差$t,那么根据$t,经过插值运算即可获得INS在相应同步时刻(GPS数据更新时刻)的值,这样就获得了组合系统在相应同步时刻的虚拟量测数据。插值的方法有多种,最为典型是拉格朗日三点插值法,其原理如下。

假设在某个融合时间段内,INS数据更新时刻tI(N-2)、tI(N-1)、tI(N)的测量值分别为YINS[tI(N-2)]、YINS[tI(N-1)]、YINS[tI(N)],由于插值点时间为GPS接收机数据更新时刻tG,则运用拉格朗日三点插值法计算出INS在tG时刻的虚拟测量值为:

YINS(tG)=YINS[tI(N-2)]L2+YINS[tI(N-1)]

L1+YINS[tI(N)]L0

其中,

(9)

[10-13]

[9]

k

,t]内,GPS接收机数据更新一次,更新时刻

k

k

为tG;INS数据更新N次,更新时刻为tI(i)(i=

1,2,,,N);计算机接收到GPS接收机和INS数据包首字节的时刻分别为 tjG和 tjI(i)(i=1,2,,,N),开始滤波的时刻为tk。

另设GPS接收机和INS的数据传输到计算机的通信延迟分别为$tG和$tI,则有:

tG+$tG= tGtI+$tI= tI

k

k

k

k

k

k

k

k

[tG-tI(N-2)][tG-tI(N-1)]

L0=[tI(N)-tI(N-2)][tI(N)-tI(N-1)],L1=L2=

GIGI,

[tI(N-1)-tI(N-2)][tI(N-1)-tI(N)]GIGI。

[tI(N-2)-tI(N-1)][tI(N-2)-tI(N)]

(5)(6)

由前述可知,GPS/INS组合导航系统在作数据同步时,需要同步的数据所对应的时刻是数据更新时刻,而不是加上通信延迟的计算机接收时刻。由于在通常情况下,$tG和$tI大致相等,所k

k

3 仿真实验与分析

上一页第2页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email