[发明专利]一种单兵三维定位系统及其定位方法

摘要

一种单兵三维定位系统，包括有定位模块、通信中继系统以及后台系统。本发明的单兵定位系统采用惯性导航技术，通过精准优化的算法计算人的姿态位移和偏移角度，定位精度高，水平定位精度在1米以内，垂直定位精度在1米以内，角度误差在2度以内，在外部复杂环境下，仍能够定位准确。后台系统通过定位解析模块将信息展示在后台系统主界面上，主界面主要来描绘人的行走轨迹，姿态展示和数据显示，还包括火源点设置及轨迹隐藏和显示，颜色的改变设置。

主权项

一种单兵三维定位系统，其特征在于：包括有定位模块、通信中继系统以及后台系统；所述定位模块包括有惯性导航模块、第一蓝牙模块以及用于控制惯性导航模块的第一核心控制器；所述通信中继系统包括有与第一蓝牙模块配套的第二蓝牙模块、4G通讯模块、第一无线射频模块以及用于控制第二蓝牙模块、4G通讯模块以及第一无线射频模块的第二核心控制器；所述后台系统包括有用于输出位置信息的显示器、主机、用于与第一无线射频模块连接的第二无线射频模块；所述惯性导航模块、第一蓝牙模块分别与第一核心控制器通过外围电路连接；所述第二蓝牙模块、4G通讯模块以及第一无线射频模块分别与第二核心控制器通过外围电路连接；所述显示器、第二无线射频模块分别与主机连接；所述主机包括有用于解析惯性导航模块所采集位置信息的定位算法模块以及CPU，所述定位算法模块与CPU连接。