一种航迹推算辅助的离开角测向定位方法技术

本发明专利技术公开了一种航迹推算辅助的离开角测向定位方法，包括：终端接收AOD基站广播信号并标记接收时间，提取基站MAC地址、离开角、RSSI值信息；终端基于观测信息，结合基站位置、终端工作高度信息开展AOD多源异构数据融合定位估计；终端获取加速度计、磁力计与陀螺仪传感器数据；利用AOD融合定位估计值、卡尔曼滤波结果、传感器数据，修正航迹推算算法状态信息；利用传感器数据、修正信息以及时间间隔，进行航迹推算定位估计；AOD融合定位估计值性能若满足要求，则输出AOD融合定位估计值，否则，输出航迹推算定位估计值；对定位估计值进行卡尔曼滤波，并输出定位结果。并输出定位结果。并输出定位结果。

【技术实现步骤摘要】
一种航迹推算辅助的离开角测向定位方法


[0001]本专利技术涉及无线电信号测向
，特别涉及一种航迹推算辅助的离开角测向定位方法。

技术介绍

[0002]室内定位已成为当前信息产业的一个热门应用，并呈现出广阔的市场前景，但是在消防应急领域的定位进展较为缓慢。惯导定位是目前消防应用的一个主要研究方向，但是，惯导定位技术受消防员运动姿态影响，在工作一段时间后会出现较大的累计误差，且无法自校准；基于无线电的室内定位技术，诸如：蓝牙iBeacon、WiFi、UWB、蓝牙AOA等，尤其是UWB、蓝牙AOA具有较高的定位精度，适合用于辅助校准惯导状态提高定位稳定性。但是，UWB、蓝牙AOA等系统需要提前布线，且基站成本较高，在建筑改造中施工量大不具可行性，同时，遇到紧急情况会出现断电断网的情况，系统无法正常工作。
[0003]因此，针对施工布线成本高、紧急状态下断电断网等问题，基于离开角基站功耗低、无线通信，电池供电续航时间长等特点，设计了航迹推算辅助的离开角测向定位方法。
[0004]本专利技术通过终端接收低功耗AOD基站广播信号获得观测信息，结合基站位置、终端工作高度等信息开展AOD融合定位估计；终端获得传感器数据，结合AOD融合定位结果修正航迹推算算法状态信息，并进行航迹推算定位估计；根据AOD融合定位估计值质量，从AOD融合定位估计值与航迹推算定位估计值中选取一个作为定位估计值并进行卡尔曼滤波。根据实际需要滤波结果可通过低频信道传输至指控平台。本专利技术能够使终端获得稳定准确的终端位置估计值，具有系统结构简单、实施方便、定位精度高的特点。

技术实现思路

[0005]为了克服现有技术中的不足，本专利技术提供一种航迹推算辅助的离开角测向定位方法，能够使终端获得稳定准确的终端位置估计值，具有系统结构简单、实施方便、定位精度高的特点。
[0006]为了达到上述专利技术目的，解决其技术问题所采用的技术方案如下：
[0007]一种航迹推算辅助的离开角测向定位方法，包括以下步骤：
[0008]步骤S1：终端接收AOD基站广播信号并标记接收时间，提取基站MAC地址、离开角、RSSI值信息；
[0009]步骤S2：终端基于观测信息，结合基站位置、终端工作高度信息开展AOD多源异构数据融合定位估计；
[0010]步骤S3：终端获取加速度计、磁力计与陀螺仪传感器数据；
[0011]步骤S4：利用AOD融合定位估计值、卡尔曼滤波结果、传感器数据，修正航迹推算算法状态信息；
[0012]步骤S5：利用传感器数据、修正信息以及时间间隔，进行航迹推算定位估计；
[0013]步骤S6：AOD融合定位估计值性能若满足要求，则输出AOD融合定位估计值，否则，
输出航迹推算结果定位估计值；
[0014]步骤S7：对定位估计值进行卡尔曼滤波，并输出定位结果。
[0015]进一步的，所述步骤S1中包括以下步骤：
[0016]步骤S11：基站广播的无线电信号中包含终端用于区分基站的MAC地址；
[0017]步骤S12：终端接收基站广播信号进行接收时间标记；
[0018]步骤S13：终端提取基站MAC地址、离开角、RSSI值信息；
[0019]步骤S14：终端对接收数据按照基站MAC地址进行分组，每一组别所有数据对应终端观测到一个基站的所有信息；
[0020]步骤S15：对每一组别数据按照接收时间先后进行排序。
[0021]可选的，步骤S11中，基站广播的无线电信号中还可包含基站位置信息。
[0022]进一步的，所述步骤S2中包括以下步骤：
[0023]步骤S21：每一类数据在时间间隔T内，将每一组向前NT时间段内的数据作为一个小组，N越小，实时性越强，抖动越大，相反，N越大，实时性越弱，抖动越小；
[0024]步骤S22：每个小组计算RSSI值两两之间的距离，设置距离阈值，小于阈值的数据进行聚类，大于阈值的数据排除；
[0025]步骤S23：将各组聚类后的数据重新组合进行融合定位；
[0026]步骤S24：根据基站位置坐标、终端工作高度信息通过极点法初步定位；
[0027]步骤S25：以初步定位位置为中心，根据测向算法测向精度，俯仰角、方位角向周围拓展，形成模糊定位区域，真实位置极大概率落在模糊定位区域内；
[0028]步骤S26：根据俯仰角与RSSI值联合设计模糊定位区域权重，俯仰角越大、能量越强，权重值越大，相反，俯仰角越小、能量越弱，权重值越小；
[0029]步骤S27：交叠区域的权重进行叠加，找出权重最大的区域，将该区域的重心位置作为终端的融合定位估计值。
[0030]进一步的，所述步骤S3中包括以下步骤：
[0031]步骤S31：终端以时间间隔T为周期获取加速度计、磁力计与陀螺仪传感器数据；
[0032]步骤S32：根据惯性敏感元器件误差随机过程模型修正传感器数据。
[0033]进一步的，所述步骤S4中包括以下步骤：
[0034]步骤S41：航迹推算方案需要对位置坐标、速度、姿态参数进行初始对准，确定终端与空间坐标系的相对关系；
[0035]步骤S42：当前时刻AOD融合定位估计值作为定位估计值时，利用AOD融合定位估计值、卡尔曼滤波结果、传感器数据，修正下一时刻航迹推算方案位置坐标、速度、姿态参数状态信息；
[0036]步骤S43：当前时刻航迹推算定位估计值作为定位估计值时，利用卡尔曼滤波结果、传感器数据，修正下一时刻航迹推算方案位置坐标、速度、姿态参数状态信息。
[0037]进一步的，所述步骤S5中包括以下步骤：
[0038]基于前一时刻位置坐标、速度、姿态参数状态信息，结合当前时刻加速度计、磁力计、陀螺仪传感器数据以及时间间隔，推算当前时刻位置坐标、速度、姿态参数状态变化，获得终端定位估计值。
[0039]进一步的，所述步骤S6中包括以下步骤：
[0040]结合AOD基站位置、终端工作高度、离开角以及RSSI值设计AOD融合定位估计值质量评价标准，若满足标准要求，则选择AOD融合定位估计值作为输出，否则，选择航迹推算定位估计值；
[0041]可选的，所述步骤S6中还包括以下步骤：
[0042]将系统定位区域划分为两类：AOD定位区域与航迹推算定位区域，通过基站位置、终端工作高度、离开角以及RSSI值等参数设计实现区域划分。
[0043]进一步的，所述步骤S7中包括以下步骤：
[0044]步骤S71：通过卡尔曼滤波对定位估计值进行平滑；
[0045]步骤S72：将卡尔曼滤波融合定位结果作为用于修正航迹推算方案位置坐标、速度、姿态等参数状态信息；
[0046]步骤S73：结合AOD定位系统覆盖范围、俯仰角以及RSSI值设计终端进入系统工作区域的准入条件，当观测数据满足准入条件，则认为终端进入系统工作范围，根据最新的定位估计值设置卡尔曼滤波本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种航迹推算辅助的离开角测向定位方法，其特征在于，包括以下步骤：步骤S1：终端接收AOD基站广播信号并标记接收时间，提取基站MAC地址、离开角、RSSI值信息；步骤S2：终端基于观测信息，结合基站位置、终端工作高度信息开展AOD多源异构数据融合定位估计；步骤S3：终端获取加速度计、磁力计与陀螺仪传感器数据；步骤S4：利用AOD融合定位估计值、卡尔曼滤波结果、传感器数据，修正航迹推算算法状态信息；步骤S5：利用传感器数据、修正信息以及时间间隔，进行航迹推算定位估计；步骤S6：AOD融合定位估计值性能若满足要求，则输出AOD融合定位估计值，否则，输出航迹推算定位估计值；步骤S7：对定位估计值进行卡尔曼滤波，并输出定位结果。2.根据权利要求1所述的一种航迹推算辅助的离开角测向定位方法，其特征在于，所述步骤S1中包括以下步骤：步骤S11：基站广播的无线电信号中包含终端用于区分基站的MAC地址；步骤S12：终端接收基站广播信号进行接收时间标记；步骤S13：终端提取基站MAC地址、离开角、RSSI值信息；步骤S14：终端对接收数据按照基站MAC地址进行分组，每一组别所有数据对应终端观测到一个基站的所有信息；步骤S15：对每一组别数据按照接收时间先后进行排序。3.根据权利要求2所述的一种航迹推算辅助的离开角测向定位方法，其特征在于，步骤S11中，基站广播的无线电信号中还可包含基站位置信息。4.根据权利要求1所述的一种航迹推算辅助的离开角测向定位方法，其特征在于，所述步骤S2中包括以下步骤：步骤S21：每一类数据在时间间隔T内，将每一组向前NT时间段内的数据作为一个小组，N越小，实时性越强，抖动越大，相反，N越大，实时性越弱，抖动越小；步骤S22：每个小组计算RSSI值两两之间的距离，设置距离阈值，小于阈值的数据进行聚类，大于阈值的数据排除；步骤S23：将各组聚类后的数据重新组合进行融合定位；步骤S24：根据基站位置坐标、终端工作高度信息通过极点法初步定位；步骤S25：以初步定位位置为中心，根据测向算法测向精度，俯仰角、方位角向周围拓展，形成模糊定位区域，真实位置极大概率落在模糊定位区域内；步骤S26：根据俯仰角与RSSI值联合设计模糊定位区域权重，俯仰角越大、能量越强，权重值越大，相反，俯仰角越小、能量越弱，权重值越小；步骤S27：交叠区域的权重进行叠加，找出权重最大的区域，将该区域的重心位置作为终端的融合定位估计值。5.根据权利要求1所述的一种航迹推算辅助的离开角测向定位方法，其特征在于，所述步骤S3中包括以下步骤：步骤...

【专利技术属性】
技术研发人员：周昊苏，陆文斌，吕振彬，王涛，叶曦，
申请(专利权)人：上海航天测控通信研究所，
类型：发明
国别省市：