CN113514057B - 一种警务定位设备、方法及*** - Google Patents

一种警务定位设备、方法及*** Download PDF

Info

Publication number
CN113514057B
CN113514057B CN202110427536.1A CN202110427536A CN113514057B CN 113514057 B CN113514057 B CN 113514057B CN 202110427536 A CN202110427536 A CN 202110427536A CN 113514057 B CN113514057 B CN 113514057B
Authority
CN
China
Prior art keywords
positioning
coordinate
satellite
police
information
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110427536.1A
Other languages
English (en)
Other versions
CN113514057A (zh
Inventor
朱新宇
戴帅
褚昭明
刘金广
朱建安
赵琳娜
李金刚
闫星培
于晓娟
成超锋
刘涛
杨钧剑
姚雪娇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Road Traffic Safety Research Center Ministry Of Public Security Of People's Republic Of China
Original Assignee
Road Traffic Safety Research Center Ministry Of Public Security Of People's Republic Of China
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Road Traffic Safety Research Center Ministry Of Public Security Of People's Republic Of China filed Critical Road Traffic Safety Research Center Ministry Of Public Security Of People's Republic Of China
Priority to CN202110427536.1A priority Critical patent/CN113514057B/zh
Publication of CN113514057A publication Critical patent/CN113514057A/zh
Application granted granted Critical
Publication of CN113514057B publication Critical patent/CN113514057B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance
    • G01C21/3407—Route searching; Route guidance specially adapted for specific applications
    • G01C21/3415—Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明公开了一种警用定位设备、方法及***，该设备包括：卫星定位模块、惯性定位模块及处理器，其中，卫星定位模块用于根据卫星信号进行定位；惯性定位模块用于根据卫星定位模块的定位坐标及加速度信息、角速度旋转信息进行定位；处理器用于执行以下步骤：获取卫星定位模块检测的卫星信号强度；根据信号强度判断是否能正常接收卫星信号；如果不能正常接收卫星信号，获取最近一次根据卫星信号计算得到的导航坐标系的第一坐标及惯性定位模块检测的当前第一加速度信息、第一角速度旋转信息；根据第一坐标、第一加速度信息及第一角速度信息得到导航坐标系的第二坐标；根据第二坐标进行定位。

Description

一种警务定位设备、方法及***
技术领域
本发明涉及警务定位技术领域，具体涉及一种警务定位设备、方法及***。
背景技术
目前警用定位装置多采用对讲机定位或移动警务通(警用PDA)来进行定位，但这些警用定位装置都是单纯采用全球卫星导航***(Global Navigation SatelliteSystem，GNSS)定位功能来进行定位的，一旦进入隧道，卫星信号自然会受到遮挡，定位功能也就无法实现。据调研，在多隧道、多山地的城市，公安警用定位装置普遍存在由于信号遮挡而导致的定位偏移问题，这些城市内发生的警用定位装置的定位偏移问题给勤务和交通安保工作开展带来了严重影响。
发明内容
有鉴于此，本发明实施例提供了一种警用定位设备、方法及***，以解决目前警用定位装置单纯采用全球卫星导航***进行定位，存在由于信号遮挡而导致定位偏移的问题。
根据第一方面，本发明实施例提供了一种警用定位设备，包括：卫星定位模块、惯性定位模块及处理器，其中，卫星定位模块用于根据卫星信号进行定位；惯性定位模块用于根据卫星定位模块的定位坐标及加速度信息、角速度旋转信息进行定位；处理器用于执行以下步骤：获取卫星定位模块检测的卫星信号强度；根据信号强度判断是否能正常接收卫星信号；如果不能正常接收卫星信号，获取最近一次根据卫星信号计算得到的导航坐标系的第一坐标及惯性定位模块检测的当前第一加速度信息、第一角速度旋转信息；根据第一坐标、第一加速度信息及第一角速度信息得到导航坐标系的第二坐标；根据第二坐标进行定位。
可选地，惯性定位模块包括：MEMS惯性加速度计及陀螺仪。
可选地，卫星定位模块包括：GNSS芯片。
可选地，处理器还用于执行如下步骤：如果能正常接收信号，判断当前时刻之前的预设时段内计算出的坐标位置是否存在跳变和/或卫星数量的个数是否在第二预设阈值之间；如果当前时刻之前的预设时间段内计算出的坐标位置存在跳变和/或卫星数量的个数在第二预设阈值之间，判定卫星定位结果不准确；获取最近一次根据卫星信号解算得到的导航坐标系的第三坐标，及当前第二加速度信息、第二角速度旋转信息；根据第三坐标、第二加速度信息及第二角速度信息得到导航坐标系的第四坐标；根据第四坐标对卫星定位结果进行修正；根据修正后的卫星定位结果进行定位。
可选地，处理器还用于执行如下步骤：如果当前时刻之前的预设时间段内计算出的坐标位置不存在跳变和/或卫星数量的个数不在第二预设阈值之间，判定卫星定位结果准确；根据卫星定位结果进行定位。
可选地，道路地理信息***还用于判断卫星定位结果和/或第二坐标是否位于道路上；如果卫星定位结果和/或第二坐标不位于道路上，将卫星定位结果和/或第二坐标调整为距离卫星定位结果和/或第二坐标最近的同向道路的中心点坐标。
根据第二方面，本发明实施例提供了一种警用定位方法，应用于如第一方面或第一方面任意实施方式中的警用定位设备，包括：获取卫星定位模块检测的卫星信号强度；根据信号强度判断是否能正常接收卫星信号；如果不能正常接收卫星信号，获取最近一次根据卫星信号计算得到的导航坐标系的第一坐标，及惯性定位模块检测的当前第一加速度信息、第一角速度旋转信息；根据第一坐标、第一加速度信息及第一角速度信息得到导航坐标系的第二坐标；根据第二坐标进行定位。
可选地，根据第一坐标、第一加速度信息及第一角速度信息得到导航坐标系的第二坐标，包括：根据第一角速度信息计算得到四元数微分方程的四元数；根据四元数计算得到姿态矩阵；根据第一加速度信息、姿态矩阵计算得到导航坐标系的加速度值；根据第一坐标、加速度值计算得到导航坐标系的第二坐标。
可选地，第一角速度信息包括俯仰角、横滚角和航向角，通过以下公式计算得到四元数、姿态矩阵、加速度值及第二坐标：
其中，q0、q1、q2、q3为四元数，θ为俯仰角，γ为横滚角，Ψ为航向角，T为姿态矩阵，Tij为姿态矩阵的元素，fx、fy、fz为导航坐标系的加速度值，fx b、fy b、fz b为载体坐标系的加速度值，即第一加速度信息，vx0、vy0为载体的初始速度，x0、y0为载体的初始位置，即导航坐标系第一坐标，vx、vy为载体当前的速度，x、y为当前载体的位置，即导航坐标系第二坐标，t为时间。
可选地，根据信号强度判断是否能正常接收卫星信号，包括：根据信号强度判断是否能计算出坐标位置；如果不能计算出坐标位置，则不能正常接收卫星信号；和/或根据卫星信号判断卫星数量是否小于或等于第一预设阈值；如果卫星数量小于或等于第一预设阈值，则不能正常接收卫星信号。
可选地，在根据第二坐标进行定位之前，警用定位方法还包括：判断第二坐标是否位于道路上；如果第二坐标不位于道路上，将第二坐标调整为距离第二坐标最近的同向道路的中心点坐标。
可选地，如果能正常接收信号，判断当前时刻之前的预设时段内计算出的坐标位置是否存在跳变和/或卫星数量的个数是否在第二预设阈值之间；如果当前时刻之前的预设时间段内计算出的坐标位置存在跳变和/或卫星数量的个数在第二预设阈值之间，判定卫星定位结果不准确；获取最近一次根据卫星信号解算得到的导航坐标系的第三坐标，及当前第二加速度信息、第二角速度旋转信息；根据第三坐标、第二加速度信息及第二角速度信息得到导航坐标系的第四坐标；根据第四坐标对卫星定位结果进行修正；根据修正后的卫星定位结果进行定位。
可选地，如果当前时刻之前的预设时间段内计算出的坐标位置不存在跳变和/或卫星数量的个数不在第二预设阈值之间，判定卫星定位结果准确；根据卫星定位结果进行定位。
可选地，警用定位方法还包括：获取最近一次根据卫星信号解算得到的导航坐标系的第四坐标，及当前第三加速度信息、第三角速度旋转信息；根据第四坐标、第三加速度信息及第三角速度信息得到导航坐标系的第五坐标；根据卫星定位结果对第五坐标进行修正。
可选地，在根据卫星定位结果进行定位之前，警用定位方法还包括：判断卫星定位结果是否位于道路上；如果卫星定位结果不位于道路上，将卫星定位结果调整为距离第二坐标最近的同向道路的中心点坐标。
根据第三方面，本发明实施例提供了一种警用定位***，包括：上述任意实施例中的警用定位设备；后台定位***，与警用定位终端连接，用于接收警用定位设备发送的定位信息并显示。
本发明实施例提供的警用定位设备、方法及***，融合了卫星定位模块和惯性定位模块，利用这种新型的硬件组合方式组成了警用定位终端设备的硬件基础，并将卫星定位模块的输出与惯性定位模块的输出进行了紧组合，可以实现警用定位设备同时采用全球卫星定位和惯性导航定位进行定位，在卫星信号良好时，以卫星定位的结果作为输出的最终定位坐标，在卫星信号丢失时(例如在隧道中卫星信号被遮挡时)，采用卫星信号丢失时的位置坐标作为起点，结合惯性定位模块检测的当前第一加速度信息、第一角速度旋转信息进行惯性导航计算，得到定位坐标，继续对警用定位设备进行定位，可以避免由于卫星信号的遮挡而导致定位的偏移，从而解决对于警用定位设备仅采用卫星导航定位方式进行定位，存在由于信号遮挡而导致定位偏移的问题。
附图说明
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案，下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图是本发明的一些实施方式，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1示出了本发明实施例的警用定位设备的结构框图；
图2示出了本发明实施例的组合导航模块进入隧道后的工作原理图；
图3示出了本发明实施例的警用定位设备在进入隧道前、后的主体导航原理图；
图4示出了本发明实施例的警用定位设备的运行结构流程图；
图5示出了本发明实施例的另一警用定位设备的结构框图；
图6示出了本发明实施例的警用定位方法的流程图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
本发明实施例提供了一种警用定位设备，如图1所示，包括：卫星定位模块11、惯性定位模块21及处理器31，其中，卫星定位模块11用于根据卫星信号进行定位；惯性定位模块21用于根据卫星定位模块11的定位坐标及加速度信息、角速度旋转信息进行定位；处理器31用于执行以下步骤：获取卫星定位模块11检测的卫星信号强度；根据信号强度判断是否能正常接收卫星信号；如果不能正常接收卫星信号，获取最近一次根据卫星信号计算得到的导航坐标系的第一坐标及惯性定位模块21检测的当前第一加速度信息、第一角速度旋转信息；根据第一坐标、第一加速度信息及第一角速度信息得到导航坐标系的第二坐标；根据第二坐标进行定位。
具体地，卫星定位模块11采用的定位方式为全球卫星导航***定位，全球卫星导航***定位坐标是根据卫星信号进行实时计算的。一般是采用测码伪距观测值以及卫星导航电文中所给出的卫星广播星历及卫星钟差来进行单点定位。所谓测码伪距观测法是指利用卫星信号从卫星发射出发，一直被到用户终端接收的时间间隔来测量卫星到用户终端距离的一种测距方法，因为电磁波信号的速度固定为光速c，因此获取了时间间隔既可以计算出卫星至用户终端的距离，该段距离因为可能存在误差而称为伪距。利用四颗以上卫星到用户的伪距即可计算出用户终端在地球上的三维坐标信息。利用测码伪距单点定位可以轻易得出警用定位设备在导航坐标系下WGS－84坐标系的坐标位置信息。单纯的GNSS测码伪距观测值误差稳定在10m以下。
惯性定位模块21采用的定位方式为惯性导航***(INS)定位，惯性导航***定位坐标也是实时计算的，惯性导航***工作原理图如图2所示，惯性导航***实时根据卫星信号最近一次计算得到的第一坐标作为惯性导航***定位的起始坐标，再根据惯性定位模块21检测到的当前的第一加速度信息、第一角速度旋转信息计算得到惯性导航***定位坐标。其中，可以采用滤波算法消除计算过程中的误差，并对误差进行分析。同时，在能够根据卫星定位模块11进行定位的时候，实时引入GNSS定位结果对惯性导航***定位坐标进行位置修正。
惯性导航定位的具体算法就是根据载体(警用定位设备)上所搭载的加速度计和陀螺仪所监测到的载体相对于某个惯性空间坐标系(载体坐标系)的角速度旋转信息和加速度信息，再通过解算常微分方程组，就得到载体在导航坐标系中的位置、速度、姿态和时间信息等。由于加速度测量计测量的是其敏感轴上的比力(沿载体坐标系的矢量)，因此如何在载体运动过程中，保证加速度计的输出为沿导航坐标系的矢量是实现准确导航定位的基础。要满足这一条件有2种途径：①利用陀螺稳定平台建立一个稳定的三维空间导航坐标系，也称平台式惯性导航***；②通过不同坐标系之间的变换，解决加速度计输出的指向问题，即将加速度计和陀螺仪都直接固联在载体上，陀螺仪的输出角速度信息用来解算载体相对导航坐标系的姿态矩阵，经姿态矩阵将加速度计的输出变换至导航坐标系，这种方式也称捷联式惯性导航***。本发明实施例中应用的的加速度计和陀螺仪都是固联在新型警用定位设备内部的MEMS捷联式惯导传感器，因此所采用的算法是捷联式的计算方式。
处理器31可以为中央处理器(Central Processing Unit，CPU)。处理器31还可以为其他通用处理器、数字信号处理器(Digital Signal Processor，DSP)、专用集成电路(Application Specific Integrated Circuit，ASIC)、现场可编程门阵列(Field－Programmable Gate Array，FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等芯片，或者上述各类芯片的组合。
在本发明实施例中，警用定位设备工作原理图如图3和图4所示，具体为：当警员或警用车辆处在开阔空间，卫星信号不受遮挡时，若卫星信号强度满足定位精度要求，采用卫星定位模块11利用测码伪距的绝对定位方式对警员或警用车辆进行定位，若卫星信号强度较弱，不满足精度要求，则采用惯性定位模块21作为辅助定位，修正卫星定位结果，利用修正后卫星定位结果对警员或警用车辆进行定位；当警员或警用车辆行驶到隧道中，卫星信号丢失时，切换至惯性定位模块21作为主要定位***进行工作，并将卫星信号丢失前的最后一个卫星定位坐标值作为惯性导航定位的起始坐标，利用惯性导航定位继续对警员或警用车辆进行定位，确保警员或警用车辆的位置信息保持在精准状态。同时，引入地理信息***对警员或警用车辆的位置信息进行辅助修正，保证警员或警用车辆的位置始终保持在道路上，并将道路地理信息***修正后的实时坐标结果代入下次的惯性导航定位运算中。
本发明实施例提供的警用定位设备，融合了全球卫星定位模块11和惯性定位模块21，利用这种新型的硬件组合方式组成了警用定位终端设备的硬件基础，并将卫星定位模块11的输出与惯性定位模块21的输出进行了紧组合，可以实现警用定位设备同时采用全球卫星定位和惯性导航定位进行定位，在卫星信号良好时，以卫星定位的结果作为输出的最终定位坐标，在卫星信号丢失时(例如在隧道中卫星信号被遮挡时)，采用卫星信号丢失时的位置坐标作为起点，结合惯性定位模块21检测的当前第一加速度信息、第一角速度旋转信息进行惯性导航计算，得到定位坐标，继续对警用定位设备进行定位，可以避免由于卫星信号的遮挡而导致定位的偏移，从而解决对于警用定位设备仅采用卫星导航定位方式进行定位，存在由于信号遮挡而导致定位偏移的问题。
本发明研制的警务定位设备采用的组合导航模块，可在跨江隧道、山体隧道和高架桥下实现精准定位，在交通勤务调度方面较之目前的警务定位***能够起到很大提高，在长沙、武汉、上海等拥有众多跨江隧道的城市中应用前景十分广泛。
在可选的实施例中，警用定位设备还可以包括存储器32，其中处理器31和存储器32可以通过总线或者其他方式连接，图5中以通过总线连接为例。
存储器32作为一种非暂态计算机可读存储介质，可用于存储非暂态软件程序、非暂态计算机可执行程序以及模块，如警用定位方法对应的程序指令/模块。处理器31通过运行存储在存储器32中的非暂态软件程序、指令以及模块，从而执行处理器的各种功能应用以及数据处理，即实现警用定位方法。
存储器32可以包括存储程序区和存储数据区，其中，存储程序区可存储操作***、至少一个功能所需要的应用程序；存储数据区可存储处理器31所创建的数据等。此外，存储器32可以包括高速随机存取存储器，还可以包括非暂态存储器，例如至少一个磁盘存储器件、闪存器件、或其他非暂态固态存储器件。在一些实施例中，存储器32可选包括相对于处理器31远程设置的存储器，这些远程存储器可以通过网络连接至处理器31。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
上述的一个或者多个模块存储在存储器32中，当被处理器31执行时，执行警用定位方法。
在可选的实施例中，为了使得惯性定位模块21可以集成到警用定位设备中，惯性定位模块21包括：MEMS惯性加速度计及陀螺仪。MEMS惯性加速度计和陀螺仪的体积较小，便于嵌入警用定位设备中，如警务通PDA或对讲机等。且MEMS惯性加速度计和陀螺仪成本较低，从而集成了惯性定位模块21的警用定位设备的成本也较低，便于大规模生产和使用。
在可选的实施例中，卫星定位模块11包括：GNSS芯片。采用GNSS芯片作为卫星定位模块11，可以使得卫星定位模块11的体积小，而且GNSS芯片可以直接输出测码伪距坐标，当采用惯性导航时，可以直接获取测码伪距坐标带入计算，而不用对卫星定位模块11输出的数据再次进行处理。
在可选的实施例中，处理器还用于执行如下步骤：如果能正常接收信号，判断当前时刻之前的预设时段内计算出的坐标位置是否存在跳变和/或卫星数量的个数是否在第二预设阈值之间；如果当前时刻之前的预设时间段内计算出的坐标位置存在跳变和/或卫星数量的个数在第二预设阈值之间，判定卫星定位结果不准确；获取最近一次根据卫星信号解算得到的导航坐标系的第三坐标，及当前第二加速度信息、第二角速度旋转信息；根据第三坐标、第二加速度信息及第二角速度信息得到导航坐标系的第四坐标；根据第四坐标对卫星定位结果进行修正；根据修正后的卫星定位结果进行定位。具体地，预设时间段可以为1分钟、几分钟、几十分钟等，第二预设阈值可以为6－8。因为惯性导航***也是实时在工作的，如果当前的全球卫星导航***的定位结果不准确，可以采用惯性导航***的定位对全球卫星导航***的定位结果进行修正，使得对警员或警用车辆的定位更加准确。
在可选的实施例中，处理器还用于执行如下步骤：如果当前时刻之前的预设时间段内计算出的坐标位置不存在跳变和/或卫星数量的个数不在第二预设阈值之间，判定卫星定位结果准确；根据卫星定位结果进行定位。具体地，如果卫星信号良好，计算出的坐标位置连续，符合实际的警员或警用车辆的运动轨迹，或卫星数量超过了9个及以上，那么，此时，就以全球卫星定位***的定位坐标进行定位。
在可选的实施例中，警用定位设备还包括：道路地理信息***，当采用惯性定位模块21进行定位时，道路地理信息***用于判断第二坐标是否位于道路上；如果第二坐标不位于道路上，将第二坐标调整为距离第二坐标最近的同向道路的中心点坐标。当采用卫星定位模块11进行定位时，道路地理信息***还用于判断卫星定位结果是否位于道路上；如果卫星定位结果不位于道路上，将卫星定位结果调整为距离卫星定位结果最近的同向道路的中心点坐标。具体地，考虑到警员或警用车辆只是在道路上使用的应用场景，所以会把定位计算结果与道路地理信息***结合，判断定位坐标是否在道路上。通过采用道路地理信息***将定位坐标修正到道路上，可以使得对警员、警用车辆的定位更加切近实际。
本发明实施例还提供了一种警用定位方法，应用于如上述任意实施方式中的警用定位设备，如图6所示，包括：
S301.获取卫星定位模块11检测的卫星信号强度；具体地，可通过GNSS芯片直接输出卫星信号强度。
S302.根据信号强度判断是否能正常接收卫星信号；具体地，可以通过根据信号强度是否能计算出定位坐标或根据信号强度判断接收卫星的数目等来判断是否能正常接收卫星信号。如果能正常接收卫星信号，进入步骤S306。如果不能正常接收卫星信号，进入步骤S303。
S303.获取最近一次根据卫星信号计算得到的导航坐标系的第一坐标，及惯性定位模块21检测的当前第一加速度信息、第一角速度旋转信息；具体地，不能正常接收卫星信号，说明警用定位设备的卫星信号被遮挡，此时，应该切换为惯性导航***进行定位。惯性导航***定位坐标是实时计算的，惯性导航***定位时需要根据卫星信号输出的最近一次根据卫星信号实时计算得到的第一坐标作为惯性导航***定位的起始坐标，再根据惯性定位模块21检测到的当前的第一加速度信息、第一角速度旋转信息计算得到惯性导航***定位坐标。
S304.根据第一坐标、第一加速度信息及第一角速度信息得到导航坐标系的第二坐标；具体地，加速度计测量得到的是载体坐标系的加速度值，而本发明实施例需要计算的是导航坐标系的坐标，因此需要将第一加速度信息转换成导航坐标系的加速度值。根据第一角速度信息可以得到载体坐标系相对导航坐标系的姿态矩阵，根据姿态矩阵可以将第一加速度信息转换成导航坐标系的加速度值，根据转换后的加速度值、起始坐标，就可以得到导航坐标系的第二坐标。
S305.根据第二坐标进行定位。
S306.根据卫星定位结果进行定位。
本发明实施例提供的警用定位方法，融合了卫星定位模块11和惯性定位模块21，利用这种新型的硬件组合方式组成了警用定位终端设备的硬件基础，并将卫星定位模块11的输出与惯性定位模块21的输出进行了紧组合，可以实现警用定位设备同时采用全球卫星定位和惯性导航定位进行定位，在卫星信号良好时，以卫星定位的结果作为输出的最终定位坐标，在卫星信号丢失时(例如在隧道中卫星信号被遮挡时)，采用卫星信号丢失时的位置坐标作为起点，结合惯性定位模块21检测的当前第一加速度信息、第一角速度旋转信息进行惯性导航计算，得到定位坐标，继续对警用定位设备进行定位，可以避免由于卫星信号的遮挡而导致定位的偏移，从而解决对于警用定位设备仅采用卫星导航定位方式进行定位，存在由于信号遮挡而导致定位偏移的问题。
在可选的实施例中，步骤S302中，根据信号强度判断是否能正常接收卫星信号，包括：根据信号强度判断是否能计算出坐标位置；如果不能计算出坐标位置信息，则不能正常接收卫星信号。如果能计算出坐标位置信息，则判定能正常接收卫星信号。具体地，如果GNSS芯片计算位置坐标失败，即GNSS芯片无法计算出位置坐标，这时候可以确定GNSS没法正常工作。这时判断GNSS信号被遮挡，警用定位设备进入了隧道。通过是否能计算出坐标位置来判断GNSS是否能正常接收卫星信号，比较直观。
和/或，根据卫星信号判断卫星数量是否小于或等于第一预设阈值；如果卫星数量小于或等于第一预设阈值，则不能正常接收卫星信号。如果卫星数量大于第一预设阈值，则能正常接收卫星信号。具体地，GNSS定位要求的最小卫星数量为4个，而且如果设备处在开阔地，是不可能只接收到这么少的卫星数目的，因此，可以设定第一预设阈值为4，如果接收到的数量少于5颗卫星，则考虑GNSS无法定位，即使给出了定位结果也是不可信的。
可选的实施例中，步骤S304中，根据第一坐标、第一加速度信息及第一角速度信息得到导航坐标系的第二坐标，包括：根据第一角速度信息计算得到四元数微分方程的四元数；根据四元数计算得到姿态矩阵；根据第一加速度信息、姿态矩阵计算得到导航坐标系的加速度值；根据第一坐标、加速度值计算得到导航坐标系的第二坐标。具体地，由于新型警用定位设备并不存在稳定的惯性平台，而且一般都是由用户随身携带的，所以必然的选择就是采用捷联式的惯性导航算法来进行导航定位工作。与平台式惯性导航***相比较，姿态矩阵的解算相当于建立了“数学平台”。对于捷联式惯性导航***，姿态矩阵的实时更新和导航解算算法是其关键。姿态矩阵的即时更新就是实时地给出姿态矩阵T的内容，而这要通过一定的算法来完成。进行姿态矩阵即时更新的算法很多。比较典型的方法有欧拉角法(三参数法)、四元数法(四参数法)以及方向余弦法(九参数法)。本实施例以四元数法为例进行说明。所谓四元数法，是指将载体坐标系相对导航坐标系的转动用四元数来表示。根据三轴陀螺仪实时输出的第一角速度信息可以用来解算四元数微分方程得到四元数微分方程的实时四元数，根据实时四元数可以求出实时的姿态矩阵，根据实时的姿态矩阵对实时的第一加速度信息进行坐标系转换，可以得到实时的导航坐标系的加速度值，从而得到载体的实时速度，根据载体实时的速度、第一坐标就可以计算得到载体的实时坐标，即第二坐标。
在可选的实施例中，第一角速度信息包括俯仰角、横滚角和航向角，通过以下公式计算得到四元数、姿态矩阵、加速度值及第二坐标：
其中，q0、q1、q2、q3为四元数，θ为俯仰角，γ为横滚角，Ψ为航向角，T为姿态矩阵，Tij为姿态矩阵的元素，fx、fy、fz为导航坐标系的加速度值，fx b、fy b、fz b为载体坐标系的加速度值，即第一加速度信息，vx0、vy0为载体的初始速度，初始速度为最近一次导航坐标***计算得到的载体的速度，x0、y0为载体的初始位置，即导航坐标系第一坐标，vx、vy为载体当前的速度，x、y为当前载体的位置，即导航坐标系第二坐标，t为时间。
在可选的实施例中，在步骤S305，根据第二坐标进行定位之前，警用定位方法还包括：判断第二坐标是否位于道路上；如果第二坐标不位于道路上，将第二坐标调整为距离第二坐标最近的同向道路的中心点坐标。如果第二坐标位于道路上，进入步骤S305，根据第二坐标进行定位。具体地，考虑到警员或警用车辆只是在道路上使用的应用场景，所以会把定位计算结果与道路地理信息***结合，判断定位坐标是否在道路上。通过采用道路地理信息***将定位坐标修正到道路上，可以使得对警员、警用车辆的定位更加切近实际。
在可选的实施例中，如果能正常接收信号，在步骤S306之前，警用定位方法还包括：判断当前时刻之前的预设时段内计算出的坐标位置是否存在跳变和/或卫星数量的个数是否在第二预设阈值之间；如果当前时刻之前的预设时间段内计算出的坐标位置存在跳变和/或卫星数量的个数在第二预设阈值之间，判定卫星定位结果不准确；获取最近一次根据卫星信号解算得到的导航坐标系的第三坐标，及当前第二加速度信息、第二角速度旋转信息；根据第三坐标、第二加速度信息及第二角速度信息得到导航坐标系的第四坐标；根据第四坐标对卫星定位结果进行修正；根据修正后的卫星定位结果进行定位。如果当前时刻之前的预设时间段内计算出的坐标位置不存在跳变和/或卫星数量的个数不在第二预设阈值之间，判定卫星定位结果准确；进入步骤S306，根据卫星定位结果进行定位。具体地，预设时间段可以为1分钟、几分钟、几十分钟等，第二预设阈值可以为6－8。因为惯性导航***也是实时在工作的，如果当前的全球卫星导航***的定位结果不准确，可以采用惯性导航***的定位对全球卫星导航***的定位结果进行修正，使得对警员或警用车辆的定位更加准确。
在可选的实施例中，在根据卫星定位结果进行定位之前，在步骤S306之前，警用定位方法还包括：判断卫星定位结果是否位于道路上；如果卫星定位结果不位于道路上，将卫星定位结果调整为距离第二坐标最近的同向道路的中心点坐标。具体地，考虑到警员或警用车辆只是在道路上使用的应用场景，所以会把定位计算结果与道路地理信息***结合，判断定位坐标是否在道路上。通过采用道路地理信息***将定位坐标修正到道路上，可以使得对警员、警用车辆的定位更加切近实际。
在可选的实施例中，判定卫星定位结果准确之后，警用定位方法还包括：获取最近一次根据卫星信号解算得到的导航坐标系的第四坐标，及当前第三加速度信息、第三角速度旋转信息；根据第四坐标、第三加速度信息及第三角速度信息得到导航坐标系的第五坐标；根据卫星定位结果对第五坐标进行修正。具体地，对于卫星定位结果准确时，是采用卫星定位的结果作为最终的定位坐标输出，但惯性导航***同时也是实时在工作的，需要不断采用全球卫星导航***的坐标带入惯性导航***进行计算，对惯性导航***的定位结果进行修正。这样，可以使得在卫星信号丢失时，采用惯性导航***进行定位时，定位更加准确。
本发明实施例还提供了一种警用定位***，包括：上述任意实施例中的警用定位设备；具体的对于警用定位设备的描述详见上述实施例中警用定位设备实施例中的描述，在此不再赘述。
后台定位***，与警用定位设备连接，用于接收警用定位设备发送的定位信息并进行显示。具体地，为了便于对警员和/或警用车辆的管理、调度、考核等，可以设置一个后台定位***，与所有的警用定位建立连接，接收警用定位设备发送的定位信息并显示，从而可以快速查看警员和/或警用车辆的位置。
本发明实施例提供的警用定位***，融合了卫星定位模块11和惯性定位模块21，利用这种新型的硬件组合方式组成了警用定位终端设备的硬件基础，并将卫星定位模块11的输出与惯性定位模块21的输出进行了紧组合，可以实现警用定位设备同时采用全球卫星定位和惯性导航定位进行定位，在卫星信号良好时，以卫星定位的结果作为输出的最终定位坐标，在卫星信号丢失时(例如在隧道中卫星信号被遮挡时)，采用卫星信号丢失时的位置坐标作为起点，结合惯性定位模块21检测的当前第一加速度信息、第一角速度旋转信息进行惯性导航计算，得到定位坐标，继续对警用定位设备进行定位，可以避免由于卫星信号的遮挡而导致定位的偏移，从而解决对于警用定位设备仅采用卫星导航定位方式进行定位，存在由于信号遮挡而导致定位偏移的问题。
本领域技术人员可以理解，实现上述实施例方法中的全部或部分流程，是可以通过计算机程序来指令相关的硬件来完成，所述的程序可存储于一计算机可读取存储介质中，该程序在执行时，可包括如上述各方法的实施例的流程。其中，所述存储介质可为磁碟、光盘、只读存储记忆体(Read－Only Memory，ROM)、随机存储记忆体(RandomAccessMemory，RAM)、快闪存储器(Flash Memory)、硬盘(Hard Disk Drive，缩写：HDD)或固态硬盘(Solid－State Drive，SSD)等；所述存储介质还可以包括上述种类的存储器的组合。
虽然结合附图描述了本发明的实施例，但是本领域技术人员可以在不脱离本发明的精神和范围的情况下作出各种修改和变型，这样的修改和变型均落入由所附权利要求所限定的范围之内。

Claims (11)

1.一种警用定位设备，其特征在于，包括：卫星定位模块、惯性定位模块及处理器，其中，
所述卫星定位模块用于根据卫星信号进行定位；
所述惯性定位模块用于根据所述卫星定位模块的定位坐标及加速度信息、角速度旋转信息进行定位；
所述处理器用于执行以下步骤：
获取所述卫星定位模块检测的卫星信号强度；根据所述信号强度判断是否能正常接收卫星信号；
如果不能正常接收卫星信号，获取最近一次根据所述卫星信号计算得到的导航坐标系的第一坐标及所述惯性定位模块检测的当前第一加速度信息、第一角速度旋转信息；
根据所述第一坐标、所述第一加速度信息及所述第一角速度旋转信息得到导航坐标系的第二坐标；
根据所述第二坐标进行定位；
所述处理器还用于执行如下步骤：
如果能正常接收信号，判断当前时刻之前的预设时段内计算出的坐标位置是否存在跳变和/或卫星数量的个数是否在第二预设阈值之间；
如果当前时刻之前的预设时间段内计算出的坐标位置存在跳变和/或卫星数量的个数在第二预设阈值之间，判定卫星定位结果不准确；
获取最近一次根据所述卫星信号解算得到的导航坐标系的第三坐标，及当前第二加速度信息、第二角速度旋转信息；
根据所述第三坐标、所述第二加速度信息及所述第二角速度旋转信息得到导航坐标系的第四坐标；
根据所述第四坐标对所述卫星定位结果进行修正；
根据修正后的卫星定位结果进行定位；
所述警用定位设备还包括道路地理信息***，用于判断所述卫星定位结果和/或所述第二坐标是否位于道路上；如果所述卫星定位结果和/或所述第二坐标不位于道路上，将所述卫星定位结果和/或所述第二坐标调整为距离所述卫星定位结果和/或所述第二坐标最近的同向道路的中心点坐标。
2.根据权利要求1所述的警用定位设备，其特征在于，所述惯性定位模块包括：MEMS惯性加速度计及陀螺仪。
3.根据权利要求1所述的警用定位设备，其特征在于，所述卫星定位模块包括：GNSS芯片。
4.根据权利要求1所述的警用定位设备，其特征在于，所述处理器还用于执行如下步骤：
如果当前时刻之前的预设时间段内计算出的坐标位置不存在跳变和/或卫星数量的个数不在第二预设阈值之间，判定卫星定位结果准确；
根据所述卫星定位结果进行定位。
5.一种警用定位方法，应用于如权利要求1－4任一项所述的警用定位设备，其特征在于，包括：
获取所述卫星定位模块检测的卫星信号强度；
根据所述信号强度判断是否能正常接收卫星信号；
如果不能正常接收卫星信号，获取最近一次根据所述卫星信号计算得到的导航坐标系的第一坐标，及所述惯性定位模块检测的当前第一加速度信息、第一角速度旋转信息；
根据所述第一坐标、所述第一加速度信息及所述第一角速度旋转信息得到导航坐标系的第二坐标；
根据所述第二坐标进行定位；
如果能正常接收信号，判断当前时刻之前的预设时段内计算出的坐标位置是否存在跳变和/或卫星数量的个数是否在第二预设阈值之间；
如果当前时刻之前的预设时间段内计算出的坐标位置存在跳变和/或卫星数量的个数在第二预设阈值之间，判定卫星定位结果不准确；
获取最近一次根据所述卫星信号解算得到的导航坐标系的第三坐标，及当前第二加速度信息、第二角速度旋转信息；
根据所述第三坐标、所述第二加速度信息及所述第二角速度旋转信息得到导航坐标系的第四坐标；
根据所述第四坐标对所述卫星定位结果进行修正；
根据修正后的卫星定位结果进行定位；
在所述根据所述第二坐标进行定位之前，还包括：
判断所述第二坐标是否位于道路上；
如果所述第二坐标不位于道路上，将所述第二坐标调整为距离所述第二坐标最近的同向道路的中心点坐标。
6.根据权利要求5所述的警用定位方法，其特征在于，所述根据所述第一坐标、所述第一加速度信息及所述第一角速度旋转信息得到导航坐标系的第二坐标，包括：
根据所述第一角速度旋转信息计算得到四元数微分方程的四元数；
根据所述四元数计算得到姿态矩阵；
根据所述第一加速度信息、所述姿态矩阵计算得到导航坐标系的加速度值；
根据所述第一坐标、所述加速度值计算得到所述导航坐标系的第二坐标。
7.根据权利要求6所述的警用定位方法，其特征在于，所述第一角速度旋转信息包括俯仰角、横滚角和航向角，通过以下公式计算得到所述四元数、姿态矩阵、加速度值及第二坐标：
其中，q0、q1、q2、q3为四元数，θ为俯仰角，γ为横滚角，Ψ为航向角，T为姿态矩阵，Tij为姿态矩阵的元素，fx、fy、fz为导航坐标系的加速度值，fx b、fy b、fz b为载体坐标系的加速度值，即第一加速度信息，vx0、vy0为载体的初始速度，x0、y0为载体的初始位置，即导航坐标系第一坐标，vx、vy为载体当前的速度，x、y为当前载体的位置，即导航坐标系第二坐标，t为时间。
8.根据权利要求5所述的警用定位方法，其特征在于，所述根据所述信号强度判断是否能正常接收卫星信号，包括：
根据所述信号强度判断是否能计算出坐标位置；
如果不能计算出坐标位置，则判定不能正常接收卫星信号；和/或
根据所述卫星信号判断卫星数量是否小于或等于第一预设阈值；
如果所述卫星数量小于或等于第一预设阈值，则判定不能正常接收卫星信号。
9.根据权利要求5所述的警用定位方法，其特征在于，
如果当前时刻之前的预设时间段内计算出的坐标位置不存在跳变和/或卫星数量的个数不在第二预设阈值之间，判定卫星定位结果准确；
根据所述卫星定位结果进行定位。
10.根据权利要求5所述的警用定位方法，其特征在于，还包括：
获取最近一次根据所述卫星信号解算得到的导航坐标系的第四坐标，及当前第三加速度信息、第三角速度旋转信息；
根据所述第四坐标、所述第三加速度信息及所述第三角速度旋转信息得到导航坐标系的第五坐标；
根据所述卫星定位结果对所述第五坐标进行修正。
11.一种警用定位***，其特征在于，包括：
如权利要求1－4任意一项所述的警用定位设备；
后台定位***，与所述警用定位终端连接，用于接收所述警用定位设备发送的定位信息并显示。
CN202110427536.1A 2021-04-20 2021-04-20 一种警务定位设备、方法及*** Active CN113514057B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110427536.1A CN113514057B (zh) 2021-04-20 2021-04-20 一种警务定位设备、方法及***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110427536.1A CN113514057B (zh) 2021-04-20 2021-04-20 一种警务定位设备、方法及***

Publications (2)

Publication Number Publication Date
CN113514057A CN113514057A (zh) 2021-10-19
CN113514057B true CN113514057B (zh) 2024-06-04

Family

ID=78062371

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110427536.1A Active CN113514057B (zh) 2021-04-20 2021-04-20 一种警务定位设备、方法及***

Country Status (1)

Country Link
CN (1) CN113514057B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117109579A (zh) * 2023-07-28 2023-11-24 无锡广盈集团有限公司 用于室内信号定位的信号阻碍监测告警方法及***

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN202648669U (zh) * 2011-07-27 2013-01-02 康讯科技股份有限公司 行人路径方位估算装置
CN103453913A (zh) * 2013-08-29 2013-12-18 镇江青思网络科技有限公司 停车场中车辆的组合定位方法
CN105300395A (zh) * 2014-07-11 2016-02-03 北京协进科技发展有限公司 一种导航定位方法及装置
CN108827292A (zh) * 2018-06-27 2018-11-16 四川大学 基于gnss和地面基站的组合式导航精确测速定位方法及***
WO2019004538A1 (ko) * 2017-06-30 2019-01-03 현대엠엔소프트 주식회사 관성센서 캘리브레이션 방법
RU2697859C1 (ru) * 2018-10-03 2019-08-21 Открытое акционерное общество "Радиоавионика" Способ определения местоположения наземного подвижного объекта
CN111221020A (zh) * 2020-03-06 2020-06-02 上海晶众信息科技有限公司 一种室内外定位方法、装置及***
CN111366161A (zh) * 2020-05-29 2020-07-03 北京晶众智慧交通科技股份有限公司 车辆定位方法及电子设备

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN202648669U (zh) * 2011-07-27 2013-01-02 康讯科技股份有限公司 行人路径方位估算装置
CN103453913A (zh) * 2013-08-29 2013-12-18 镇江青思网络科技有限公司 停车场中车辆的组合定位方法
CN105300395A (zh) * 2014-07-11 2016-02-03 北京协进科技发展有限公司 一种导航定位方法及装置
WO2019004538A1 (ko) * 2017-06-30 2019-01-03 현대엠엔소프트 주식회사 관성센서 캘리브레이션 방법
CN108827292A (zh) * 2018-06-27 2018-11-16 四川大学 基于gnss和地面基站的组合式导航精确测速定位方法及***
RU2697859C1 (ru) * 2018-10-03 2019-08-21 Открытое акционерное общество "Радиоавионика" Способ определения местоположения наземного подвижного объекта
CN111221020A (zh) * 2020-03-06 2020-06-02 上海晶众信息科技有限公司 一种室内外定位方法、装置及***
CN111366161A (zh) * 2020-05-29 2020-07-03 北京晶众智慧交通科技股份有限公司 车辆定位方法及电子设备

Also Published As

Publication number Publication date
CN113514057A (zh) 2021-10-19

Similar Documents

Publication Publication Date Title
CN107328410B (zh) 用于定位自动驾驶车辆的方法和汽车电脑
Du et al. Next-generation automated vehicle location systems: Positioning at the lane level
CN103744096B (zh) 一种多信息融合的定位方法和装置
EP2040037A2 (en) Navigation device
CN111562603B (zh) 基于航位推算的导航定位方法、设备及存储介质
CN110851545B (zh) 地图绘制方法、装置及设备
US20110307171A1 (en) GPS Location Refinement Method In Environments With Low Satellite Visibility
CN110319850B (zh) 一种获取陀螺仪的零点偏移的方法及装置
CN110057356B (zh) 一种隧道内车辆定位方法及装置
US20210396524A1 (en) Generating a Geomagnetic Map
CN113063425B (zh) 车辆定位方法、装置、电子设备及存储介质
CN110579786A (zh) 定位方法及***、导航方法及***和一种车辆管理终端
CN111121755B (zh) 一种多传感器的融合定位方法、装置、设备及存储介质
CN113514057B (zh) 一种警务定位设备、方法及***
EP4215873A1 (en) Automobile positioning method and apparatus
Dasanayaka et al. Analysis of vehicle location prediction errors for safety applications in cooperative-intelligent transportation systems
CN115468563A (zh) 轨迹处理方法及计算机程序产品
CN117232506A (zh) 一种复杂战场环境下的军用移动装备定位***
Forno et al. Techniques for improving localization applications running on low-cost IoT devices
CN113465616B (zh) 轨迹异常点检测方法和装置、电子设备及存储介质
CN110109153A (zh) 导航处理方法、导航终端、设备及存储介质
CN113642548B (zh) 氢能运输车的异常驾驶行为检测、装置和计算机设备
CN114701505A (zh) 车辆行驶状态的判定方法、装置及存储介质
CN114001730A (zh) 融合定位方法、装置、计算机设备和存储介质
Zou et al. A MEMS-assisted GNSS signal uninterrupted tracking method based on adaptive motion constraints

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant