本发明专利技术提供了一种定位消防员建筑物进入点的方法及系统，包括：步骤S1：微惯性导航系统、卫星导航系统各自解算出位置数据；步骤S2：对位置数据进行融合，得到融合位置数据；步骤S3：采集周围环境3D数据，并跟建筑物3D图形数据库数据匹配解算，配对建筑物进入点成功后用数据库位置信息校正微惯性导航系统的位置信息；步骤S4：微惯性导航系统基于校正过的位置信息，从此点开始积分计算精确的位置数据。本发明专利技术提供一种基于微型3D激光雷达的融合定位方法，确定消防员建筑物进入点的精确位置，用于单兵定位系统的融合定位解算，从而解决由于现有技术无法提供一种有效的准确融合定位方法的问题。法的问题。法的问题。
【技术实现步骤摘要】
定位消防员建筑物进入点的方法及系统
[0001]本专利技术涉及单兵定位系统，具体地，涉及一种定位消防员建筑物进入点的方法及系统。
技术介绍
[0002]随着社会的发展，城市化和工业化越来越快，各种高楼大厦和规模庞大结构复杂的厂房越建越多。当火灾发生时，就对消防救援提出了更高的要求。消防救援，既要解救被困人员，也要关注消防员自身的安危，这都需要对火灾现场的人员位置做到精确定位，这样现场指挥调度更有效和成功。但是由于现代建筑物结构的复杂性，增加了确定人员位置的难度，同时火灾发生后，由于火苗和烟雾的影响，火灾现场能见度急剧降低，各种照明设施也会由于火灾而失效。因此，为了实时定位消防员的位置，给现场指挥员提供更好的态势信息，提高指挥调度的能力，必须采用各种消防员单兵定位系统。
[0003]目前，常用的单兵定位系统一般采用微惯性导航系统、卫星导航系统、室内无线信标等多种定位设备进行融合解算得到最终的位置输出。微惯性导航系统（Micro
‑
INS， Micro Inertial
‑
Navigation System)是一种不依赖外部信息，基于自身的加速度、角速度等传感器进行时间积分从而确定速度、偏航角和位置等信息，单兵室内定位基本都是以惯性导航系统为基础，但是其缺点是：误差会随着时间积累，经过长时间后最终误差会变的很大，所以需要外部其他信息源对其修正。卫星导航系统（GNSS）通过获取卫星信号，实时解算位置信息，定位数据不会随着时间积累，但是其缺点是：在室内和高楼密集区域信号被遮挡，城市环境还会有多径现象，这些都影响卫星导航系统定位精度和可用性，如果用有误差的卫星导航系统数据去跟微惯导系统融合从而修正微惯导输出，会导致微惯导积分开始的位置就是错误的。用室内无线信标融合校正微惯导输出的方法，需要预先布置大量的无线信标，增加了成本，同时火灾时这些信标极有可能被烧毁，最终导致无法使用。
[0004]专利文献CN103957507A（申请号：CN201410213934.3）公开了一种新型火场消防单兵定位系统，包括手持终端单元、第一至第三监测单元和监测终端单元；所述手持终端单元定时分别向第一至第三监测单元发送终端定位信息，第一至第三监测单元分别对接收到的终端定位信息进行解算，得到第一至第三监测单元分别与手持终端单元的距离，第一至第三监测单元分别将各自的位置信息及各自的解算结果传输给监测终端单元，由监测终端单元最终精确解算出手持终端单元的位置。但该专利技术没有基于微型3D激光雷达的融合定位方法，确定消防员建筑物进入点的精确位置。
技术实现思路
[0005]针对现有技术中的缺陷，本专利技术的目的是提供一种定位消防员建筑物进入点的方法及系统。
[0006]根据本专利技术提供的一种定位消防员建筑物进入点的方法，包括：步骤S1：微惯性导航系统、卫星导航系统各自解算出位置数据；
步骤S2：对位置数据进行融合，得到融合位置数据；步骤S3：采集周围环境3D数据，并跟建筑物3D图形数据库数据匹配解算，配对建筑物进入点成功后用数据库位置信息校正微惯性导航系统的位置信息；步骤S4：微惯性导航系统基于校正过的位置信息，从此点开始积分计算精确的位置数据。
[0007]优选地，卫星导航系统同时采用多种导航系统解算位置数据，导航系统包括：GPS、北斗、格洛纳斯或伽利略。
[0008]优选地，在所述步骤S1中：微惯性导航系统根据初始位置，基于自身的加速度传感器和角速度传感器的数据输出，周期性地基于固定时间间隔进行积分，得到单兵定位设备的实时位置、偏航角、速度的信息，将微惯性导航系统实时解算每一时刻的位置信息，将实时解算出的每一时刻的定位数据，经过卡尔曼滤波处理后，得到卫星导航位置和速度；微惯性导航系统和卫星导航系统定位数据进行融合定位时，具体通过以下步骤：a、数据对准：数据对准主要包括时间对准和空间对准，由于微惯性导航系统和卫星导航系统解算出的定位数据的时间不同，将数据外推或线性时间对准插值到相同的时刻；插值方法采用抛物时间对准插值、拉格朗日时间对准插值；b、数据融合：定位数据融合采用卡尔曼滤波融合算法，微惯性导航系统和卫星导航系统卡尔曼滤波的估计误差协方差矩阵的逆阵加权其估计值的卡尔曼滤波方程基础上，计算出相应的交叉协方差阵，并将交叉协方差阵用于微惯性导航系统与卫星导航系统的定位融合方程中，利用更新过的卡尔曼滤波公式迭代计算得到融合定位数据。
[0009]优选地，在所述步骤S2中：将微惯性导航系统和卫星导航系统得到的定位数据采用集中式融合结构进行融合。
[0010]优选地，在所述步骤S3中：采用五个模块进行匹配解算：3D激光雷达数据采集模块、3D建筑物数据库模块、地形数据配准模块、位置解算模块和位置数据校正模块；3D激光雷达数据采集模块：3D激光雷达数据采集模块实时采集消防员周围的3D图形数据，并发送至地形数据配准模块做进一步处理；3D建筑物数据库模块：3D建筑物数据库模块存储目标建筑物及周边区域的3D图形信息，并提供接口供地形数据配准模块读取预设区域的数据；地形数据配准模块：地形数据配准模块利用3D激光雷达的图形数据，根据消防员位置数据，从数据库中读取周围的3D图形数据，并实时进行配准计算；到达目标建筑物预设距离内后与目标建筑物的特定进入点配准成功，转送位置解算模块继续处理；位置解算模块：位置解算模块读取特定进入点的精确位置坐标信息，根据3D雷达的3D成像信息，利用计算机视觉算法，计算出消防员此时的精确位置；位置数据校正模块：位置数据校正模块将得到的消防员精确位置，对微惯性导航系统和卫星导航系统的融合定位数据进行校正，并设置状态量指示精确位置校正已经完
成。
[0011]优选地，在所述步骤S4中：微惯性导航系统的位置信息被校正修正后，微惯性导航系统基于自身的加速度传感器和角速度传感器的数据输出，根据时间进行积分，从而得到单兵定位设备的实时位置、偏航角、速度的信息；在此后预设时间内，整个单兵定位设备的位置数据输出采用微惯性导航系统的数据输出；基于微惯性导航系统的性能指标，设置一时间阈值，超过时间阈值后，微惯性导航系统的积分累计误差已经超过卫星导航系统数据的误差，如果卫星导航系统数据有输出且输出数据稳定，用卫星导航系统数据对微惯性导航系统进行校正。
[0012]根据本专利技术提供的一种定位消防员建筑物进入点的系统，执行所述的定位消防员建筑物进入点的方法，包括：微惯性导航模块：解算位置数据，基于校正过的准确位置信息，积分计算精确的位置数据；卫星导航模块：解算位置数据，与微惯性导航系统数据进行融合，得到融合位置数据；微型3D雷达模块：采集周围环境3D数据；建筑物3D图形库模块：建筑物3D图形数据库数据与微型3D雷达模块采集数据进行匹配解算。
[0013]优选地，微惯性导航系统为一种或两种以上系统的组合；卫星导航系统为一种或两种以上系统的组合。
[0014]优选地，消防员的建筑物进入点包括大门、窗户或预设装置。
[0015]优选地，在所述建筑物3D图形库模块中：建筑本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种定位消防员建筑物进入点的方法，其特征在于，包括：步骤S1：微惯性导航系统、卫星导航系统各自解算出位置数据；步骤S2：对位置数据进行融合，得到融合位置数据；步骤S3：采集周围环境3D数据，并跟建筑物3D图形数据库数据匹配解算，配对建筑物进入点成功后用数据库位置信息校正微惯性导航系统的位置信息；步骤S4：微惯性导航系统基于校正过的位置信息，从此点开始积分计算精确的位置数据。2.根据权利要求1所述的定位消防员建筑物进入点的方法，其特征在于：卫星导航系统同时采用多种导航系统解算位置数据，导航系统包括：GPS、北斗、格洛纳斯或伽利略。3.根据权利要求1所述的定位消防员建筑物进入点的方法，其特征在于，在所述步骤S1中：微惯性导航系统根据初始位置，基于自身的加速度传感器和角速度传感器的数据输出，周期性地基于固定时间间隔进行积分，得到单兵定位设备的实时位置、偏航角、速度的信息，将微惯性导航系统实时解算每一时刻的位置信息，将实时解算出的每一时刻的定位数据，经过卡尔曼滤波处理后，得到卫星导航位置和速度；微惯性导航系统和卫星导航系统定位数据进行融合定位时，具体通过以下步骤：a、数据对准：数据对准主要包括时间对准和空间对准，由于微惯性导航系统和卫星导航系统解算出的定位数据的时间不同，将数据外推或线性时间对准插值到相同的时刻；插值方法采用抛物时间对准插值、拉格朗日时间对准插值；b、数据融合：定位数据融合采用卡尔曼滤波融合算法，微惯性导航系统和卫星导航系统卡尔曼滤波的估计误差协方差矩阵的逆阵加权其估计值的卡尔曼滤波方程基础上，计算出相应的交叉协方差阵，并将交叉协方差阵用于微惯性导航系统与卫星导航系统的定位融合方程中，利用更新过的卡尔曼滤波公式迭代计算得到融合定位数据。4.根据权利要求1所述的定位消防员建筑物进入点的方法，其特征在于，在所述步骤S2中：将微惯性导航系统和卫星导航系统得到的定位数据采用集中式融合结构进行融合。5.根据权利要求1所述的定位消防员建筑物进入点的方法，其特征在于，在所述步骤S3中：采用五个模块进行匹配解算：3D激光雷达数据采集模块、3D建筑物数据库模块、地形数据配准模块、位置解算模块和位置数据校正模块；3D激光雷达数据采集模块：3D激光雷达数据采集模块实时采集消防员周围的3D图形数据，并发送至地形数据配准模块做进一步处理；3D建筑物数据库模块：3D建筑物数据库模块存储目标建筑物及周边区域的3D图形信息，并提供接口供地形数据配准模块...
【专利技术属性】
技术研发人员：曹熠峰，杨勇，
申请(专利权)人：江苏德一佳安防科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。