[go: up one dir, main page]

CN111221020A - 一种室内外定位方法、装置及系统 - Google Patents

一种室内外定位方法、装置及系统 Download PDF

Info

Publication number
CN111221020A
CN111221020A CN202010152973.2A CN202010152973A CN111221020A CN 111221020 A CN111221020 A CN 111221020A CN 202010152973 A CN202010152973 A CN 202010152973A CN 111221020 A CN111221020 A CN 111221020A
Authority
CN
China
Prior art keywords
indoor
vehicle
outdoor
imu
positioning method
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.)
Pending
Application number
CN202010152973.2A
Other languages
English (en)
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.)
Shanghai Jingzhong Information Technology Co Ltd
Original Assignee
Shanghai Jingzhong Information Technology Co Ltd
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 Shanghai Jingzhong Information Technology Co Ltd filed Critical Shanghai Jingzhong Information Technology Co Ltd
Priority to CN202010152973.2A priority Critical patent/CN111221020A/zh
Publication of CN111221020A publication Critical patent/CN111221020A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • 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
    • 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • 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/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/18—Stabilised platforms, e.g. by gyroscope
    • 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/20—Instruments for performing navigational calculations
    • G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
    • 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/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30—Map- or contour-matching
    • 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/343—Calculating itineraries, i.e. routes leading from a starting point to a series of categorical destinations using a global route restraint, round trips, touristic trips

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)

Abstract

本发明涉及定位技术领域，具体公开了一种室内外定位方法，其中，包括：根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息；记录车辆在室外进入室内前一时刻的位置信息；当车辆进入到室内时，根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息。本发明还公开了一种室内外定位装置及系统。本发明提供的室内外定位方法在不增加车端硬件装置和场端改造成本的前提下克服室内定位的缺陷，采用车端现有的惯导装置和高精度地图信息，实现汽车从地上到地下停车场的一体化定位，提高了定位精度和可靠性，成本较低。

Description

一种室内外定位方法、装置及系统
技术领域
本发明涉及定位技术领域，尤其涉及一种室内外定位方法、室内外定位装置及包括该室内外定位装置的室内外定位方法。
背景技术
室内外定位是指室内室外一体化定位技术，包含了室外定位、室内定位和室内室外环境切换三个过程。室外定位有GNSS信号源作为绝对参考，再融合IMU数据，通过组合导航可以达到较好的定位效果。但是在室内环境下，由于室内环境复杂，接收不到卫星信号，使得室内定位变得比较困难。另外室外到室内的场景切换，没有高精度地图作为参考依据，很难做到精准判断，所以提出在室内环境无法使用卫星定位时，采用其他室内定位技术解决室内定位的问题，以及室外到室内的一体化定位方法。
目前在没有卫星信号的室内实现室内定位有三种技术路线，一种是在室内布设定位基站，比如蓝牙信标、UWB基站、5G基站、WIFI热点等；一种是基于室外GPS信号引到室内后用IMU来做坐标纠正；另一种是建立室内语义地图，然后通过视觉或激光雷达等传感器进行识别与语义地图进行对比，以获取在地图的位置。
中国专利文献CN201510790928.9公开了一种用于室内定位的智能终端及蓝牙室内定位系统的室内定位方法，该方法采用蓝牙信标来计算出终端的位置，该方法需要在定位区域铺设蓝牙信标和蓝牙网关，成本较高，并且蓝牙的安装位置分布对定位精度也有影响，不同的环境定位也不一样，无法普及使用。
中国专利文献CN201510056693.0公开了一种基于无线信号数据融合的室内定位方法，该方法通过WIFI信号和RFID信号融合的方式提高了室内定位的精度，该方法需要在场端布置WIFI路由器和RFID标签，还需要一个后台服务器，然后在客户端需要搭载一个信号接收设备，结构复杂，成本较高，无法普及使用。
中国专利文献CN201510629975.5公开了一种基于单视觉的机器人室内定位和导航方法，该方法需要有单目摄像头、电子罗盘和声呐传感器，设置三个可识别的标记点，通过单目摄像头测量所在位置，该方案需要的硬件传感器在车端无法统一满足，在地下停车场环境也存在弊端，无法满足使用。
因此，如何提供一种能够满足汽车从地上到地下停车场的一体化定位，且定位精度高成本低的定位方式成为本领域技术人员亟待解决的技术问题。
发明内容
本发明提供了一种室内外定位方法、室内外定位装置及包括该室内外定位装置的室内外定位方法，解决相关技术中存在的无法实现对车辆由地上到地下的一体化定位的问题。
作为本发明的第一个方面，提供一种室内外定位方法，其中，包括：
根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息；
记录车辆在室外进入室内前一时刻的位置信息；
当车辆进入到室内时，根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息。
进一步地，所述室内外定位方法还包括在所述根据IMU和GNSS组合导航定位方法建立室外空间状态模型的步骤前进行的：
初始化惯导器件。
进一步地，所述室内外定位方法还包括在所述记录车辆在室外进入室内前一时刻的位置信息的步骤后进行的：
判断车辆是否进入室内；
若车辆进入室内，则执行记录车辆在室外进入室内前一时刻的位置信息的步骤。
进一步地，所述判断车辆是否进入室内，包括：
检测室内与室外之间的电子栅栏的开关信号；
分别比较车辆的航向角和俯仰角与室内入口的航向角与俯仰角的差值是否均在阈值范围内；
若所述电子栅栏的开关信号为开，且所述车辆的航向角和俯仰角与室内入口的航向角与俯仰角的差值是否均在阈值范围内，则判定所述车辆进入室内。
进一步地，所述根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息，包括：
根据IMU捷联解算获得的位置以及GNSS获得的位置建立室外空间状态模型；
对所述室外空间状态模型进行卡尔曼滤波，获得车辆在室外的姿态、速度和位置。
进一步地，所述根据IMU捷联解算获得的位置以及GNSS获得的位置建立室外空间状态模型，包括：
根据IMU中陀螺仪输出的角速度进行二子样圆锥误差补偿，通过捷联解算进行姿态更新，获得姿态角；
对IMU中加速度计输出的比力值通过积分进行速度更新得到更新后的速度；
对更新后的速度通过积分进行位置更新，获得东北天三个方向上的速度、经纬度和高度信息；
根据所述GNSS定位的绝对位置和速度以及根据IMU获得的东北天三个方向上的速度、经纬度和高度信息建立室外空间状态模型。
进一步地，所述根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息，包括：
根据IMU捷联解算获得的位置以及根据DR航位推算获得的位置建立室内空间状态模型；
对所述室内空间状态模型进行卡尔曼滤波，获得车辆在室内的姿态、速度和位置。
进一步地，所述根据IMU捷联解算获得的位置以及根据DR航位推算获得的位置建立室内空间状态模型，包括：
根据IMU中陀螺仪输出的角速度进行二子样圆锥误差补偿，通过捷联解算进行姿态更新，获得姿态角；
对IMU中加速度计输出的比力值通过积分进行速度更新得到更新后的速度；
对更新后的速度通过积分进行位置更新，获得东北天三个方向上的速度、经纬度和高度信息；
根据IMU捷联解算的姿态矩阵，将车体坐标系下的速度转化到导航坐标系下；
根据航位推算的速度和位置以及根据IMU获得的东北天三个方向上的速度、经纬度和高度信息建立室内空间状态模型。
作为本发明的另一个方面，提供一种室内外定位装置，其中，包括：
模型建立模块，用于根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息；
记录模块，用于记录车辆在室外进入室内前一时刻的位置信息；
位置获得模块，用于当车辆进入到室内时，根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息。
作为本发明的另一个方面，提供一种室内外定位系统，其中，包括：信号源传感器和前文所述的室内外定位装置，所述室内外定位装置与所述信号源传感器通信连接，所述信号源传感器包括车辆CAN信号、GNSS模块、IMU模块和高精度地图数据模块，用于为所述室内外定位装置提供多种信号源，所述室内外定位装置用于根据多种信号源实现车辆在室内和室外的定位。
本发明提供的室内外定位方法，通过IMU和GNSS实现车辆在室外的定位，并通过记录车辆由室外进入室内前一时刻的位置信息以及结合IMU和DR实现车辆在室内的定位。本发明实施例提供的室内外定位方法在不增加车端硬件装置和场端改造成本的前提下克服室内定位的缺陷，采用车端现有的惯导装置和高精度地图信息，实现汽车从地上到地下停车场的一体化定位，提高了定位精度和可靠性，成本较低。
附图说明
附图是用来提供对本发明的进一步理解，并且构成说明书的一部分，与下面的具体实施方式一起用于解释本发明，但并不构成对本发明的限制。在附图中：
图1为本发明提供的室内外定位方法的流程图。
图2为本发明提供的室内外定位系统的框架图。
图3为本发明提供的室内外定位方法的具体工作流程图。
图4为本发明提供的室内外定位算法的具体流程图。
具体实施方式
需要说明的是，在不冲突的情况下，本发明中的实施例及实施例中的特征可以相互结合。下面将参考附图并结合实施例来详细说明本发明。
为了使本领域技术人员更好地理解本发明方案，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分的实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本发明保护的范围。
需要说明的是，本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的本发明的实施例。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包括，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
在本实施例中提供了一种室内外定位方法，图1是根据本发明实施例提供的室内外定位方法的流程图，如图1所示，包括：
S110、根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息；
S120、记录车辆在室外进入室内前一时刻的位置信息；
S130、当车辆进入到室内时，根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息。
本发明实施例提供的室内外定位方法，通过IMU和GNSS实现车辆在室外的定位，并通过记录车辆由室外进入室内前一时刻的位置信息以及结合IMU和DR实现车辆在室内的定位。本发明实施例提供的室内外定位方法在不增加车端硬件装置和场端改造成本的前提下克服室内定位的缺陷，采用车端现有的惯导装置和高精度地图信息，实现汽车从地上到地下停车场的一体化定位，提高了定位精度和可靠性，成本较低。
需要说明的是，IMU，全称Inertial measurement unit，惯性测量装置。GNSS，全称Global Navigation Satellite System，全球导航卫星系统。DR，全称Dead Reckoning，航位推算。
应当理解的是，车辆在室内的定位通常指在地下停车场等场合的定位，车辆在室外的定位通常指地面上的定位，因此，本发明实施例中以地面定位阶段表示室外定位，地下定位阶段表示室内定位。
如图2所示，本发明实施例采用了车辆CAN信号、GNSS模块、IMU模块、高精度地图数据作为信号源，实现多传感器融合定位算法。
下面结合图3和图4对本发明实施例提供的室内外定位方法的具体实现过程进行详细描述。
具体地，所述室内外定位方法还包括在所述根据IMU和GNSS组合导航定位方法建立室外空间状态模型的步骤前进行的：
初始化惯导器件。
惯导器件初始对准：通过矢量定姿原理进行惯导粗对准和精对准，确定载体坐标系相对于导航坐标系的空间方位。
进一步具体地，初始对准的方法包括以下步骤：
已知三维空间中的两个直角坐标系r系和b系，参考矢量V1和V2的投影坐标分别为
Figure BDA0002403079490000051
通过矢量定姿原理求解两坐标系间的方位关系
Figure BDA0002403079490000052
经过粗对准阶段获得粗略的地理导航指向。
为减小测量误差，对参与解算的矢量进行正交和单位化处理：
Figure BDA0002403079490000053
为减小失准角误差，根据惯导系统误差方程规律，建立初始状态空间模型，采用卡尔曼滤波方法获得粗对准状态下失准角的最优估计，实现惯导系统的精对准。
具体地，所述室内外定位方法还包括在所述记录车辆在室外进入室内前一时刻的位置信息的步骤后进行的：
判断车辆是否进入室内；
若车辆进入室内，则执行记录车辆在室外进入室内前一时刻的位置信息的步骤。
进一步具体地，所述判断车辆是否进入室内，包括：
检测室内与室外之间的电子栅栏的开关信号；
分别比较车辆的航向角和俯仰角与室内入口的航向角与俯仰角的差值是否均在阈值范围内；
若所述电子栅栏的开关信号为开，且所述车辆的航向角和俯仰角与室内入口的航向角与俯仰角的差值是否均在阈值范围内，则判定所述车辆进入室内。
可以理解的是，车辆由地上向地下场景切换过程包括以下步骤：
当车辆靠近车库入口，检测是否进入地下停车场入口电子栅栏，同时分别比较车辆航向角和俯仰角与车库入口的航向角和俯仰角的大小；
若车辆航向角和俯仰角与入口的航向角和俯仰角差距保持在阈值范围内，认为车辆进入地下车库；
记录入口的姿态和初始位置，使用IMU和DR进行组合导航。
具体地，所述根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息，包括：
根据IMU捷联解算获得的位置以及GNSS获得的位置建立室外空间状态模型；
对所述室外空间状态模型进行卡尔曼滤波，获得车辆在室外的姿态、速度和位置。
进一步具体地，所述根据IMU捷联解算获得的位置以及GNSS获得的位置建立室外空间状态模型，包括：
根据IMU中陀螺仪输出的角速度进行二子样圆锥误差补偿，通过捷联解算进行姿态更新，获得姿态角；
对IMU中加速度计输出的比力值通过积分进行速度更新得到更新后的速度；
对更新后的速度通过积分进行位置更新，获得东北天三个方向上的速度、经纬度和高度信息；
根据所述GNSS定位的绝对位置和速度以及根据IMU获得的东北天三个方向上的速度、经纬度和高度信息建立室外空间状态模型。
在本发明实施例中，GNSS以GPS为例进行说明。
具体地，根据IMU单元中陀螺仪输出的角速度
Figure BDA0002403079490000061
进行二子样圆锥误差补偿，通过捷联结算进行姿态更新
Figure BDA0002403079490000062
获得姿态角(俯仰角、横滚角以及航向角)。
对IMU单元中加速度计输出的比力值
Figure BDA0002403079490000063
通过积分进行速度更新
Figure BDA0002403079490000064
对速度积分进行位置更新
Figure BDA0002403079490000065
Figure BDA0002403079490000066
获得最终东北天三个方向上的速度以及经纬度和高度信息。
考虑杆臂和时间不同步误差δpδt,
Figure BDA0002403079490000067
对GPS定位的绝对位置和速度
Figure BDA0002403079490000068
以及上述过程中获得的捷联解算获得的位置和速度
Figure BDA0002403079490000069
建立状态空间模型
Figure BDA00024030794900000610
进行卡尔曼滤波。根据误差校正捷联解算的速度和位置，并将误差反馈，对姿态进行更新。
具体地，所述根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息，包括：
根据IMU捷联解算获得的位置以及根据DR航位推算获得的位置建立室内空间状态模型；
对所述室内空间状态模型进行卡尔曼滤波，获得车辆在室内的姿态、速度和位置。
进一步具体地，所述根据IMU捷联解算获得的位置以及根据DR航位推算获得的位置建立室内空间状态模型，包括：
根据IMU中陀螺仪输出的角速度进行二子样圆锥误差补偿，通过捷联解算进行姿态更新，获得姿态角；
对IMU中加速度计输出的比力值通过积分进行速度更新得到更新后的速度；
对更新后的速度通过积分进行位置更新，获得东北天三个方向上的速度、经纬度和高度信息；
根据IMU捷联解算的姿态矩阵，将车体坐标系下的速度转化到导航坐标系下；
根据航位推算的速度和位置以及根据IMU获得的东北天三个方向上的速度、经纬度和高度信息建立室内空间状态模型。
根据IMU单元中陀螺仪输出的角速度进行二子样圆锥误差补偿，通过捷联结算进行姿态更新，获得姿态角(俯仰角、横滚角以及航向角)。
对IMU单元中加速度计输出的比力值通过积分进行速度更新，对速度积分进行位置更新，获得最终东北天三个方向上的速度以及经纬度和高度信息。
考虑杆臂误差δpDL，车辆里程计输出的速度
Figure BDA0002403079490000071
数据，根据IMU捷联解算的姿态矩阵
Figure BDA0002403079490000072
将车体坐标系下的速度转化到导航坐标系下，对航位推算的速度和位置pINS以及上述过程中获得的捷联解算获得的位置pINS和速度建立状态空间模型
Figure BDA0002403079490000073
进行卡尔曼滤波。根据误差校正捷联解算的速度和位置，并将误差反馈，对姿态进行更新。
作为本发明的另一实施例，提供一种室内外定位装置，其中，包括：
模型建立模块，用于根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息；
记录模块，用于记录车辆在室外进入室内前一时刻的位置信息；
位置获得模块，用于当车辆进入到室内时，根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息。
本发明实施例提供的室内外定位装置，通过IMU和GNSS实现车辆在室外的定位，并通过记录车辆由室外进入室内前一时刻的位置信息以及结合IMU和DR实现车辆在室内的定位。本发明实施例提供的室内外定位装置在不增加车端硬件装置和场端改造成本的前提下克服室内定位的缺陷，采用车端现有的惯导装置和高精度地图信息，实现汽车从地上到地下停车场的一体化定位，提高了定位精度和可靠性，成本较低。
作为本发明的另一实施例，提供一种室内外定位系统，其中，包括：信号源传感器和前文所述的室内外定位装置，所述室内外定位装置与所述信号源传感器通信连接，所述信号源传感器包括车辆CAN信号、GNSS模块、IMU模块和高精度地图数据模块，用于为所述室内外定位装置提供多种信号源，所述室内外定位装置用于根据多种信号源实现车辆在室内和室外的定位。
本发明实施例提供的室内外定位系统，采用前文的室内外定位装置，通过IMU和GNSS实现车辆在室外的定位，并通过记录车辆由室外进入室内前一时刻的位置信息以及结合IMU和DR实现车辆在室内的定位。本发明实施例提供的室内外定位系统在不增加车端硬件装置和场端改造成本的前提下克服室内定位的缺陷，采用车端现有的惯导装置和高精度地图信息，实现汽车从地上到地下停车场的一体化定位，提高了定位精度和可靠性，成本较低。
可以理解的是，以上实施方式仅仅是为了说明本发明的原理而采用的示例性实施方式，然而本发明并不局限于此。对于本领域内的普通技术人员而言，在不脱离本发明的精神和实质的情况下，可以做出各种变型和改进，这些变型和改进也视为本发明的保护范围。

Claims (10)

1.一种室内外定位方法，其特征在于，包括：
根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息；
记录车辆在室外进入室内前一时刻的位置信息；
当车辆进入到室内时，根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息。
2.根据权利要求1所述的室内外定位方法，其特征在于，所述室内外定位方法还包括在所述根据IMU和GNSS组合导航定位方法建立室外空间状态模型的步骤前进行的：
初始化惯导器件。
3.根据权利要求1或2所述的室内外定位方法，其特征在于，所述室内外定位方法还包括在所述记录车辆在室外进入室内前一时刻的位置信息的步骤后进行的：
判断车辆是否进入室内；
若车辆进入室内，则执行记录车辆在室外进入室内前一时刻的位置信息的步骤。
4.根据权利要求3所述的室内外定位方法，其特征在于，所述判断车辆是否进入室内，包括：
检测室内与室外之间的电子栅栏的开关信号；
分别比较车辆的航向角和俯仰角与室内入口的航向角与俯仰角的差值是否均在阈值范围内；
若所述电子栅栏的开关信号为开，且所述车辆的航向角和俯仰角与室内入口的航向角与俯仰角的差值是否均在阈值范围内，则判定所述车辆进入室内。
5.根据权利要求1或2所述的室内外定位方法，其特征在于，所述根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息，包括：
根据IMU捷联解算获得的位置以及GNSS获得的位置建立室外空间状态模型；
对所述室外空间状态模型进行卡尔曼滤波，获得车辆在室外的姿态、速度和位置。
6.根据权利要求5所述的室内外定位方法，其特征在于，所述根据IMU捷联解算获得的位置以及GNSS获得的位置建立室外空间状态模型，包括：
根据IMU中陀螺仪输出的角速度进行二子样圆锥误差补偿，通过捷联解算进行姿态更新，获得姿态角；
对IMU中加速度计输出的比力值通过积分进行速度更新得到更新后的速度；
对更新后的速度通过积分进行位置更新，获得东北天三个方向上的速度、经纬度和高度信息；
根据所述GNSS定位的绝对位置和速度以及根据IMU获得的东北天三个方向上的速度、经纬度和高度信息建立室外空间状态模型。
7.根据权利要求1或2所述的室内外定位方法，其特征在于，所述根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息，包括：
根据IMU捷联解算获得的位置以及根据DR航位推算获得的位置建立室内空间状态模型；
对所述室内空间状态模型进行卡尔曼滤波，获得车辆在室内的姿态、速度和位置。
8.根据权利要求7所述的室内外定位方法，其特征在于，所述根据IMU捷联解算获得的位置以及根据DR航位推算获得的位置建立室内空间状态模型，包括：
根据IMU中陀螺仪输出的角速度进行二子样圆锥误差补偿，通过捷联解算进行姿态更新，获得姿态角；
对IMU中加速度计输出的比力值通过积分进行速度更新得到更新后的速度；
对更新后的速度通过积分进行位置更新，获得东北天三个方向上的速度、经纬度和高度信息；
根据IMU捷联解算的姿态矩阵，将车体坐标系下的速度转化到导航坐标系下；
根据航位推算的速度和位置以及根据IMU获得的东北天三个方向上的速度、经纬度和高度信息建立室内空间状态模型。
9.一种室内外定位装置，其特征在于，包括：
模型建立模块，用于根据IMU和GNSS组合导航定位方法建立室外空间状态模型，获得车辆在室外的位置信息；
记录模块，用于记录车辆在室外进入室内前一时刻的位置信息；
位置获得模块，用于当车辆进入到室内时，根据所述车辆在室外进入室内前一时刻的位置信息以及IMU和DR组合导航定位方法建立室内空间状态模型，获得车辆在室内的位置信息。
10.一种室内外定位系统，其特征在于，包括：信号源传感器和权利要求9所述的室内外定位装置，所述室内外定位装置与所述信号源传感器通信连接，所述信号源传感器包括车辆CAN信号、GNSS模块、IMU模块和高精度地图数据模块，用于为所述室内外定位装置提供多种信号源，所述室内外定位装置用于根据多种信号源实现车辆在室内和室外的定位。
CN202010152973.2A 2020-03-06 2020-03-06 一种室内外定位方法、装置及系统 Pending CN111221020A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010152973.2A CN111221020A (zh) 2020-03-06 2020-03-06 一种室内外定位方法、装置及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010152973.2A CN111221020A (zh) 2020-03-06 2020-03-06 一种室内外定位方法、装置及系统

Publications (1)

Publication Number Publication Date
CN111221020A true CN111221020A (zh) 2020-06-02

Family

ID=70829932

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010152973.2A Pending CN111221020A (zh) 2020-03-06 2020-03-06 一种室内外定位方法、装置及系统

Country Status (1)

Country Link
CN (1) CN111221020A (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111854730A (zh) * 2020-06-19 2020-10-30 中国煤炭科工集团太原研究院有限公司 一种无人驾驶轻型无轨胶轮客货车定位方法及系统
CN113467346A (zh) * 2021-08-11 2021-10-01 中国矿业大学 一种井下轨道车辆自动驾驶机器人及其控制方法
CN113483756A (zh) * 2021-07-13 2021-10-08 北京信息科技大学 数据的处理方法和系统、存储介质及电子设备
CN113514057A (zh) * 2021-04-20 2021-10-19 公安部道路交通安全研究中心 一种警务定位设备、方法及系统
CN118311629A (zh) * 2024-04-15 2024-07-09 桂林电子科技大学 基于uwb/gnss/imu的室内外无缝定位方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1940479A (zh) * 2005-09-29 2007-04-04 上海乐金广电电子有限公司 车载导航设备的危险区域引导方法
CN104655130A (zh) * 2013-11-19 2015-05-27 通用汽车有限责任公司 用于车辆导航的室内停车场环境检测与水平估计位置错误确定
CN104819716A (zh) * 2015-04-21 2015-08-05 北京工业大学 一种基于mems的ins/gps组合的室内外个人导航算法
CN106370190A (zh) * 2015-07-20 2017-02-01 腾讯科技（深圳）有限公司 车辆导航、位置标记方法、装置及系统
CN107110651A (zh) * 2014-09-08 2017-08-29 应美盛股份有限公司 用于使用地图信息辅助的增强型便携式导航的方法和装置
CN109798890A (zh) * 2019-02-01 2019-05-24 上海戴世智能科技有限公司 用于车用组合惯性导航系统在无观测值条件下的启动方法、车用组合惯性导航系统和车辆

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1940479A (zh) * 2005-09-29 2007-04-04 上海乐金广电电子有限公司 车载导航设备的危险区域引导方法
CN104655130A (zh) * 2013-11-19 2015-05-27 通用汽车有限责任公司 用于车辆导航的室内停车场环境检测与水平估计位置错误确定
CN107110651A (zh) * 2014-09-08 2017-08-29 应美盛股份有限公司 用于使用地图信息辅助的增强型便携式导航的方法和装置
CN104819716A (zh) * 2015-04-21 2015-08-05 北京工业大学 一种基于mems的ins/gps组合的室内外个人导航算法
CN106370190A (zh) * 2015-07-20 2017-02-01 腾讯科技（深圳）有限公司 车辆导航、位置标记方法、装置及系统
CN109798890A (zh) * 2019-02-01 2019-05-24 上海戴世智能科技有限公司 用于车用组合惯性导航系统在无观测值条件下的启动方法、车用组合惯性导航系统和车辆

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
刘钢 等: ""一种新型的GPS/DR组合定位系统数据融合算法"", 《计算机仿真》 *
刘钢 等: ""一种新型的GPS/DR组合定位系统数据融合算法"", 《计算机仿真》, vol. 24, no. 1, 31 January 2007 (2007-01-31), pages 107 - 110 *
燕欢 等: ""IMU/GPS/航位推算组合系统室内外无缝导航方法研究"", 《卫星导航定位与北斗系统应用2014——壮大北斗产业创新位置服务》, 30 September 2014 (2014-09-30), pages 184 - 189 *
高永琪 等: "《航天器多源信息融合自主导航技术》", 北京航空航天大学出版社, pages: 191 - 197 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111854730A (zh) * 2020-06-19 2020-10-30 中国煤炭科工集团太原研究院有限公司 一种无人驾驶轻型无轨胶轮客货车定位方法及系统
CN113514057A (zh) * 2021-04-20 2021-10-19 公安部道路交通安全研究中心 一种警务定位设备、方法及系统
CN113514057B (zh) * 2021-04-20 2024-06-04 公安部道路交通安全研究中心 一种警务定位设备、方法及系统
CN113483756A (zh) * 2021-07-13 2021-10-08 北京信息科技大学 数据的处理方法和系统、存储介质及电子设备
CN113467346A (zh) * 2021-08-11 2021-10-01 中国矿业大学 一种井下轨道车辆自动驾驶机器人及其控制方法
CN118311629A (zh) * 2024-04-15 2024-07-09 桂林电子科技大学 基于uwb/gnss/imu的室内外无缝定位方法

Similar Documents

Publication Publication Date Title
CN110160542B (zh) 车道线的定位方法和装置、存储介质、电子装置
CN111221020A (zh) 一种室内外定位方法、装置及系统
JP4897542B2 (ja) 自己位置標定装置、自己位置標定方法および自己位置標定プログラム
JP5927735B2 (ja) 地図データ作成装置、自律移動システムおよび自律移動制御装置
US7457705B2 (en) Navigation apparatus for displaying three-d stored terrain information based on position and attitude
US9420275B2 (en) Visual positioning system that utilizes images of a working environment to determine position
US20210199437A1 (en) Vehicular component control using maps
CN111426320B (zh) 一种基于图像匹配/惯导/里程计的车辆自主导航方法
KR101444685B1 (ko) 영상기반 멀티센서 데이터를 이용한 차량의 위치자세 결정 방법 및 장치
JP2010519550A (ja) 絶対座標及び相対座標を含む車両ナビゲーション及び案内のためのシステム及び方法
CN113739784B (zh) 定位方法、用户设备、存储介质和电子设备
CN108627864B (zh) 基于汽车钥匙的定位方法及系统、无人驾驶汽车系统
CN108445520A (zh) 一种基于云端的室内外建图方法、装置、电子设备及计算机程序产品
CN111123334A (zh) 一种极限工况下多车协同定位平台及定位方法
CN102998689A (zh) 基于虚拟传感器的区域判断方法
Retscher et al. Ubiquitous positioning technologies for modern intelligent navigation systems
CN112269202A (zh) 一种运动载体辅助的空间基准传递系统及方法
Chiang et al. Semantic proximity update of GNSS/INS/VINS for seamless vehicular navigation using smartphone sensors
CN110869864A (zh) 用于定位较高程度自动化的车辆的方法以及相应的驾驶员辅助系统和计算机程序
CN113390422B (zh) 汽车的定位方法、装置及计算机存储介质
CN113188539B (zh) 一种巡检机器人的组合定位方法
Ng et al. Implementation of kinematics bicycle model for vehicle localization using Android sensors
Bevermeier et al. Barometric height estimation combined with map-matching in a loosely-coupled Kalman-filter
Cao et al. A Macrozone LBS Scheme Based on Data Fusion of Vehicle GNSS and Roadside Millimeter-Wave Radar in a Road Traffic Scenario
CN105874352B (zh) 使用旋转半径确定设备与船只之间的错位的方法和装置

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
RJ01 Rejection of invention patent application after publication

Application publication date: 20200602

RJ01 Rejection of invention patent application after publication