CN103048671A - 全球导航卫星***RTD、MEMS-IMU、ZigBee组合高精度无缝导航新方法 - Google Patents

Abstract

本发明提出了一种多传感器组合的无缝定位方法，适合多种应用领域。利用全球卫星导航***、惯性器件等多种传感器，构建一种最佳的组合策略，通过在无GNSS信号环境合理使用惯性器件等无线传感器及辅助传感器，同时建立GNSS信号可用性及异常等综合判别准则，进行无缝定位的可用性选择；在此基础上，采用扩展卡尔曼滤波器进行处理，实现无缝定位的最优估计输出。

Description

全球导航卫星***RTD、MEMS-IMU、ZigBee组合高精度无缝导航新方法

技术领域

“GNSS RTD/MEMS IMU/ZIGBEE组合高精度无缝导航新方法”（简称AnyPos），综合利用GNSS卫星网络 RTD技术、无线电定位技术、基于MEMS的惯性导航组件进行有效组合；在室外充分利用GNSS地面增强设施获取差分电文进行高精度实时定位解算，在室内外场合通过预先布设的ZIGBEE传感器基站进行无导航卫星信号覆盖场合的高精度实时定位解算，同时利用基于MEMS的惯性模块，提供定位盲区下辅助的姿态、速度、加速度信息。 

 本发明的主要创造点是提供一种高精度无缝定位方法，可以有效的将室内定位，室外定位，和定位盲区下辅助姿态信息结合在一起。组合的方式是两两绑定，即“RTD+MEMS”及“MEMS + ZIGBEE”，应用场景包括：1）贵重物品或者设备如文物、珍藏艺术品等的实时监控、引导过程，当被监测对象从出发地前往某一展览馆博物馆的时候，在现场GNSS信号往往无法接收，此时则需要使用到IMU/ZIGBEE信号进行室内定位，并且被监测对象的位置往往需要精确已知，才能提高监测方的判断决策的效率。2) 老人、儿童、病人的监护， 一旦发生迷路、走失等现象时可得到实时的救助。3）矿工井下安全监测，为矿山实时救护提供技术支持。根据这些需求，便提出此方法。 

对以上信息进行融合处理，从而在任何场合的应用情景下，实时地获取用户所关心的高精度位置、速度、姿态等参数，该种技术尤其适用于在室内外任何切换过渡的高精度实时定位场合，如精密设备移动的智能引导、贵重资产的移动管理等。 

背景技术

高精度无缝定位技术的实现前提是在有/无导航卫星信号的环境、场合下，充分利用广泛存在的无线电信号如GNSS、Wi-Fi、ZIGBEE等，并以MEMS的惯性器件所提供的速度、加速度、姿态等信息为基础，综合进行融合处理，从而在任何场合的应用情景下，实时地获取用户所关心的高精度位置、速度、姿态等参数；其背景技术主要分为以下几类。 

 1）室外定位（GNSS RTD）技术： 

 在室外定位场合，通过已经固化的GNSS手持机模块，充分依托全球覆盖的导航卫星信号，联合GNSS地面增强***如连续运行参考站提供的高精度卫星差分改正信号，基于精密测量的载波相位测量值，利用差分技术，实现高达厘米量级的定位结果的输出。

 2）室内定位（ZIGBEE RSSI）技术： 

 在室内定位场合，通过广泛布设的ZigBee基站，在设备充分同步的基础上，基于信号强度衰减观测-距离关系模型，获得的距离值，结合预先精确标定的传感器基站坐标，通过距离交会的计算方法，实现米级的定位结果输出。

 3）辅助定位（MEMS IMU）技术： 

在室内外无线电信号受限制的定位盲区，利用嵌入的MEMS器件加以辅助，一般利用IMU组件，通过惯性测量的原理，输出短时高精度的三维位置、加速度/速度、姿态等参数。该种辅助定位技术，可在室内定位和/或室外定位处于盲区的情况下，帮助室内定位和室外定位执行定位操作。

 4）数据融合技术： 

利用计算机对按时序获得的若干观测信息如GNSS、IMU、ZIGBEE等，在一定准则下加以自动分析、综合，以完成所需的决策和评估任务而进行的信息处理。包括对各种信息源给出的有用信息的采集、传输、综合、过滤、相关及合成。

发明内容

目前，室外定位的场合及应用越发普遍且手段不多，主要集中在卫星导航、惯性设备等，从简单的个人/大众电子消费品，如GNSS/DR/COMPASS组合的移动电话、PDA等手持终端，到复杂的专业定位设备，如RTD接收机终端、多功能专业GNSS手持机等。 

 而在室内定位场景方面，主要是HS-GNSS、CDMA、Wi-Fi、RFID、ZigBee等无线电技术，在相关的基础设施依托下，室内定位的设备尚未专门制定相应的标准及产品，常见的主要是WhereNet、Ekahau、Ubisense等公司根据单一无线电信号制定的产品，且定位精度不高。 

 该发明瞄准室内/室外任意切换、无缝过渡的高精度定位应用、生产服务场合。在上述场景中，如精密设备移动的智能引导、贵重资产的移动管理等，目标载体的位置信息尤为至关重要，因此对定位的精确度提出了很高的要求，一般均达到了分米量级；同时，定位的场景往往需要在室内/室外之间任意切换及无缝过渡。这里的过渡是指在无信号覆盖的盲区里，利用辅助MEMS进行短暂过渡的过程。 

 综上，单一地依靠导航卫星信号或者某一种室内定位信号，难以满足以上需求；并且，在某些短暂的定位盲区，任何无线电信号都无法发挥作用的时候，往往需要自主定位的手段来加以辅助，以实现定位过程的过渡，从而实现室内外的无缝定位。因此还需引入MEMS器件，如IMU等，提供必要的三维位置、加速度/速度、姿态等参数。 

为了克服上述不足之处，本发明的主要目的旨在通过RTD、IMU、ZigBee各自实时采集的数据基础上，提供一种多传感器组合的融合算法，这种算法可以有效地将导航卫星定位中的实时伪距差分算法， 和ZigBee定位中RSSI 的算法以及辅助的惯性姿态方位测量结果紧密结合在一起，从而实现实时无缝高精度高可靠导航定位。 

本发明的另一目的旨在提供一种灵活的定位模式切换方法，通过可见卫星数阈值、强弱信号的跟踪与否这两种条件的判断，来执行无缝定位的模式，该判断方法简单、可靠、有效。 

 一般来说，进行GNSS定位的必要条件是卫星数目不少于4颗，以完成导航定位计算，当卫星数少于4颗时候，GNSS定位精度明显下降；而另一种情况是即便卫星数大于4颗当由于受到遮挡屏蔽等环境影响使得卫星信噪比很弱，一般在20dB-Hz以下的时候，需采用MEMS辅助定位模式；而当卫星信号完全失去的时候，即进入室内定位场合，就需执行ZigBee/IMU定位模式。 

 本发明还提出了一种针对不同传感器种类的高精度时空基准统一方法，主要是在无缝定位基础设施建设过程中实施的，在ZigBee基站布设的时候，需要对其坐标进行标定，作为先验信息；另外在数据融合过程中，ZigBee & MEMS以及RTD & MEMS两种模式下定位结果数据的坐标系也不一致，因此需要进行坐标转换。 

 由于全球导航卫星***使用的是地心地固空间坐标系，而ZigBee***使用的是自定义坐标系，同时IMU是惯性坐标系，因此将GNSS世界坐标系作为这些空间坐标系的唯一坐标系，即将其他坐标***坐标转换到WGS 84坐标系下面。这里通过精密测量仪器如全站仪的手段，将传感器位置坐标推算转换至全球导航卫星***的坐标中，从而实现了两种室内外定位信号源的空间基准一致，而惯性坐标系归化至地心地固坐标系的方法，主要是基于姿态转换的方法。 

 对于时间基准，由于全球导航卫星信号是基于自定义的一套时间***，主要参数为周数及周秒，而ZigBee***使用的是不同的时间基准，因此两种时间***需要作一种互相归化的推算方法，本发明使用的是：先将GNSS信号的时间标记进行连续记录，在对采样平滑的基础上，将平滑的时间结果归化为UTC时间格式，同时与ZigBee上的时间进行互差判断，在连续采样100个时间标记的前提上，对其100个互差数值进行平均，最后结果纳入到时间同步输出上。 

 时间同步在于从室外到室内的过渡场合中，以及辅助定位模式中的时间信息校准，当运动载体从室外进入室内的时候，此时需要使用之前的GNSS定位信息，定位信息往往是具有时间标记的，并且GNSS时间***要比ZigBee时间***精确，因此需要将ZigBee时间归化至GNSS时间上，以实现同步。 

 在上述工作的基础上，本发明提供了一种有效的数据融合算法，通过使用扩展卡尔曼滤波等技术，将多种传感器的数据首先进行判断及匹配，如在室外环境下仅使用GNSS/IMU的组合，在室内环境下仅使用ZigBee/IMU的组合，本发明仅限于上述两种组合方式。在此基础上，进行具体的数据融合，利用各自传感器输出的三维地理坐标参数、速度、方位角等姿态参数，进行可扩展的卡尔曼滤波器处理，使得最后输出的定位参数稳定、可靠、有效。 

 另外，本发明提供了一种基于服务器的计算处理工作模式，及用户设备本身不进行基于某种传感器的计算，而是通过发送计算请求及计算所需的观测数据至服务器，服务器通过计算类型进行具体的计算引擎选择进行处理，再将计算结果发送至用户，用户结合各种计算结果进行具体的数据融合处理。 

该发明的主要技术流程图如下。 

图1

定位模式匹配判断：在用户终端中通过相关设置启动，判断此时GNSS信号是否可以，若不可用（即GNSS信号完全无法接收，可用卫星数为零），则默认为室内定位模式，转入步骤2.,执行ZigBee定位计算。 

 启动ZIGBEE定位计算引擎：此时启动终端中ZigBee定位标签，标签将其ID信息发送至ZigBee计算服务器中，服务器将对其进行识别，并同步确定其邻近基站的信息，使得ZigBee定位计算引擎就绪。 

 启动GNSS定位计算引擎：在GNSS信号可用的情况下，终端通过无线通信链路，将其伪距观测值、概略坐标通过RTCM差分电文格式，发送至RTD计算服务器，服务器将对其进行辨别，并同步向CORS网服务器下载网络RTD数据。 

工作状态激活：当ZigBee信号不可用，或者GNSS信号不可用的情况下，激活MEMS模块进行工作，进行辅助定位计算。 

执行RSSI计算：ZigBee主要定位算法是RSSI模式,此时ZigBee计算服务器将判断接收端与发射端之间的信号功率衰减，根据功率-距离模型计算出几何距离，按加权质心算法和RSSI 位置指纹定位计算，并将结果发送至用户终端。 

 执行RTD定位计算：此时RTD计算服务器，将用户终端以及CORS服务器两者数据进行同步以及匹配，从而执行RTD差分计算，并将结果发送至用户终端。 

执行MEMS辅助定位：此时通过配置命令，将ZigBee定位信息或者GNSS定位信息作为初始化输入，通过峰值探测以及方位角推估等，获得定位盲区下的定位信息。 

 数据融合计算：用户终端将各种定位结果数据输入汇总，启动卡尔曼滤波器，进行数据融合计算过程。 

 本发明技术方案的详细阐述。 

 1) 该发明的工作基础主要依托于RTD、IMU、 ZigBee各模块的高度组合上，主要组成有GNSS-RTD模块、ZigBee定位标签、IMU模块、信号转接电路板、主控版、GPRS无线通信模块、计算服务器等。对于主控板，其主要组成有：微控制单元、电源转换电力、信号指示电路等。以下详述。 

 2）上电后，设备进行初始化工作，GNSS模块将进行搜星、捕获、跟踪等工作，ZigBee定位标签将自动搜索附近的传感器基站信号，而MEMS模块将进行自检。自检就是初始化，检查模块的工作状态等。 

 3）初始化结束后，GNSS模块将给出具体的可视卫星数量，以及对应的卫星信号接收功率，并对信号进行一系列的处理及计算，得到用户大致的GNSS坐标值，并转换成为N/E/U的本地坐标系形式，此时用以判断定位环境的具体状态。 

4）若导航卫星信号可用，观测到4颗以上GNSS卫星，并且卫星信号信噪比强度不低于20dBHz，则执行室外定位计算模式（否则跳转是第7）步），此时模块利用RTCM定义的Type 17/18/19电文标准进行编码，通过GNSS模块的串行通信接口（该串口符合RS-232电平标准）输出实时的卫星伪距观测值、载噪比等有用内容，并通过GPRS无线通信模块发送基于以上观测值的RTCM电文至计算服务器。 

5）计算服务器在收到用户RTCM电文请求后，根据用户的位置向网络差分服务发送授权请求，自动生成一个基于参考站网络的高精度伪距差分改正数据，同时基于RTD的特定定位模型进行处理计算，从而计算出该用户的高精度位置，并将定位结果发送至用户，该坐标数据包含在按照NMEA-0183定义的$GPGGA语句中，$GPGGA语句是一个以逗号为分隔符的字符串。 

 6）用户在收到计算服务器精确处理的定位结果后，启动数据融合计算引擎，连同MEMS输出的姿态、速度、步长等有用信息，最终输出用户可靠、精确、全面的定位信息。 

 7）在导航卫星信号不可用时，用户设备通过GPRS通信链路向计算服务器发送具体状态请求，此时计算服务器将启动超宽带计算处理引擎，该引擎将查询授权用户上的ZigBee定位标签身份状态，并连同定位标签附近可用的传感器基站数据，进行时间同步处理，继而进行距离计算处理，同时判断标签与基站之间的通视状态，若可用，输出精确的N/E/U三维坐标值，并发送至用户设备上。 

 8）用户在收到计算服务器精确处理的定位结果后，启动数据融合计算引擎，连同MEMS输出的姿态、速度、步长等有用信息，最终输出用户可靠、精确、全面的定位信息。 

***工作原理图 

图2

具体工作流程，见以上步骤。

  

Claims (6)

1.导航定位模式的判断方法。

2.导航***定位计算中数据同步方法。

3.ZigBee实时定位算法。

4.不同传感器的高精度时空基准统一方法。

5.一种基于服务器的计算处理工作模式。

6.GNSS RTD/MEMS IMU/ZIGBEE组合***数据融合计算。

Images