[发明专利]一种消防员单兵定位导航装置

权利要求书

1.一种消防员单兵定位导航装置，包括卫星导航信息接收模块、电子罗盘模块、气压计模块、电子地图模块、存储模块、MEMS惯导模块、图像信息码读取模块和中央处理器模块；所述卫星导航信息接收模块、所述电子罗盘模块、所述气压计模块、所述电子地图模块、所述存储模块、所述MEMS惯导模块和所述图像信息码读取模块分别连接于所述中央处理器模块，其特征在于：

所述卫星导航信息接收模块接收卫星定位信号并将得出的第一定位信息传输给所述中央处理器模块，并供所述MEMS惯导模块进行初始对准；

所述电子罗盘模块获得携带所述定位导航装置的携带者的移动方向和移动姿态信息形成第二定位信息，将所述第二定位信息传输给所述中央处理器模块，并供所述MEMS惯导模块进行所述初始对准；

所述气压计模块获得所述携带者的高度信息形成第三定位信息，传输给所述中央处理器模块，并供所述MEMS惯导模块进行所述初始对准；

所述电子地图模块显示地图，并将所述中央处理器模块传来的综合定位信息在所述地图上显示；

所述存储模块存储所述地图的信息；

MEMS惯导模块测量所述携带者的加速度和角速度，得到所述携带者的速度信息、位置信息和姿态信息形成第四定位信息，并将所述第四定位信息传输给所述中央处理器模块；

所述图像信息码读取模块读取预先设置的图像信息码，得到校正信息并传输给所述中央处理器模块；所述图像信息码对应其所在位置的位置信息；

所述中央处理器模块对接收到的所述校正信息、所述第一定位信息、所述第二定位信息、所述第三定位信息和所述第四定位信息进行数据融合得到所述综合定位信息。

2.根据权利要求1所述消防员单兵定位导航装置，其特征在于：所述图像信息码读取模块得到所述校正信息的方法采用卡尔曼滤波方法，状态方程为：

X·IX·P=FI0003×3XIXP+GI00I3×3WIWP]]>

其中，

GI=03×6c11c21c31000c12c22c32000c13c23c33000000c11c21c31000c12c22c32000c13c23c3306×6]]>

ω_ie为地球自转角速度，L为当地纬度，R为地球半径；X_P＝[δL_P δλ_P δh_P]为图像信息码对应的经度、纬度和高度误差；

观测方程为：

ZIP=δLI-δLPδλI-δλPδh-δhP+vLIPvλIPvhIP=HIPXIXP+vLIPvλIPvhIP]]>

其中，δL_I、δλ_I分别为纬度误差和经度误差，δh为高度误差，H_IP＝[I_3×3 0_3×12 -I_3×3]为观测方程系数矩阵，和为观测量中的零均值高斯白噪声。