CN111562603A - 基于航位推算的导航定位方法、设备及存储介质 - Google Patents
基于航位推算的导航定位方法、设备及存储介质 Download PDFInfo
- Publication number
- CN111562603A CN111562603A CN202010612025.2A CN202010612025A CN111562603A CN 111562603 A CN111562603 A CN 111562603A CN 202010612025 A CN202010612025 A CN 202010612025A CN 111562603 A CN111562603 A CN 111562603A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- information
- gps
- positioning
- speed
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 56
- 239000011159 matrix material Substances 0.000 claims abstract description 47
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 16
- 230000001133 acceleration Effects 0.000 claims description 15
- 238000003745 diagnosis Methods 0.000 claims description 6
- 238000005096 rolling process Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 2
- 238000004891 communication Methods 0.000 description 4
- 230000002159 abnormal effect Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000004973 liquid crystal related substance Substances 0.000 description 2
- 238000004590 computer program Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
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
-
- 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
-
- 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)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于航位推算的导航定位方法、设备及存储介质,利用实时采集车辆运行过程中的车载信息,基于采集的所述车载信息,利用姿态算法,计算实时姿态角,得到方向余弦矩阵;利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度;利用位置精度因子和可见卫星数,判断GPS输出定位信息的可信度;根据所述GPS接收到的导航定位信息的可信度,并结合所述方向余弦矩阵以及获取的所述车辆速度,实时计算并获取所述车辆的定位信息;实现了借助车载航位推算的方式辅助GPS导航定位的目的,满足了不间断定位的需求。
Description
技术领域
本发明涉及车载导航定位技术领域,特别涉及一种基于航位推算的导航定位方法、设备及存储介质。
背景技术
目前,在车载终端领域,GPS(Global Positioning System,全球定位系统)定位技术应用的最为广泛。虽然GPS导航定位应用简单、精确,可以提供全球全天候的实时定位导航,但是GPS信号非常容易受到周围环境的干扰;另外,由于城市楼宇密度越来越大,进一步使得GPS信号更易受到干扰,甚至在某些位置无法保证能够利用GPS来实现定位功能;比如,当车辆经过隧道、立交桥等特殊路段时,GPS信号可能由于被遮挡而导致GPS定位功能完全失效。因此,如何满足不间断的定位需求,成为车载导航定位领域亟待解决的问题之一。
发明内容
本发明提供一种基于航位推算的导航定位方法、设备及存储介质,用以借助车载航位推算的方式辅助GPS导航定位,实现不间断定位的目的。
第一方面,本发明提供了一种基于航位推算的导航定位方法,所述基于航位推算的导航定位方法包括:
实时采集车辆运行过程中的车载信息,基于采集的所述车载信息,利用姿态算法,计算实时姿态角,得到方向余弦矩阵;
利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度;
利用位置精度因子和可见卫星数,判断GPS输出定位信息的可信度;
根据所述GPS接收到的导航定位信息的可信度,并结合所述方向余弦矩阵以及获取的所述车辆速度,实时计算并获取所述车辆的定位信息。
其中,所述实时采集车辆运行过程中的车载信息,基于采集的所述车载信息,利用姿态算法,计算实时姿态角,得到方向余弦矩阵,包括:
实时采集车辆运行过程中包含GPS信号信息、加速度计信息和陀螺仪信息的车载信息;
基于获取的所述车载信息,采用姿态算法,根据初始姿态角计算余弦矩阵的初始值,并利用陀螺仪实时更新的数据,计算实时姿态角,获取地理坐标系与车辆载体坐标系之间的方向余弦矩阵。
其中,所述基于获取的所述车载信息,采用姿态算法,根据初始姿态角计算余弦矩阵的初始值,并利用陀螺仪实时更新的数据,计算实时姿态角,获取地理坐标系与车辆载体坐标系之间的方向余弦矩阵,包括:
利用获取的所述车载信息中的加速度计信息,对GPS输出的俯仰角和横滚角进行初始化,即:
其中,所述利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,包括:
获取所述车载信息中的加速度信息,将获取的所述加速度信息与预设判断阈值进行比较,判断得到所述车载诊断系统OBD中里程速度的可信度。
其中,所述利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度,包括:
判断所述车载诊断系统OBD获取的相邻时刻ΔT内的速度增量ΔVOBD和加速度计在同一时刻ΔT内的积分速度ΔVACC是否满足预设判断阈值对应的判断条件一:
|ΔVOBD-ΔVAcc|≥Γ;其中,Γ为打滑判断阀值,且Γ>0;
以及所述积分速度ΔVACC是否满足预设判断阈值对应的判断条件二:
|ΔVOBD-ΔVAcc|≤Λ;其中,Λ为滑行判断阀值,且Λ<0;
若满足所述判断条件一和/或判断条件二,则采用所述加速度计获取的速度信息作为所述车辆速度,即V=VACC;
若既不满足所述判断条件一,又不满足所述判断条件二,则采用所述车载诊断系统OBD的里程速度作为所述车辆速度,即V=VOBD。
其中,所述利用位置精度因子和可见卫星数,判断GPS输出定位信息的可信度,包括:
调用设置的所述位置精度因子PDOP对应的预设判断阈值ThresholdPDOP以及所述可见卫星数numstar对应的预设判断阈值Thresholdnumstar;
在GPS导航定位的过程中,若GPS输出的定位信息所包含的所述位置精度因子以及所述可见卫星数同时满足:
PDOP<ThresholdPDOP;且NumStar≥Thresholdnumstar;
则判断得出GPS本次输出的所述定位信息可信;否则,判断得出GPS本次输出的所述定位信息不可信。
其中,所述根据所述GPS接收到的导航定位信息的可信度,并结合所述方向余弦矩阵以及获取的所述车辆速度,实时计算并获取所述车辆的定位信息,包括:
若所述GPS接收到的所述导航定位信息可信,则将GPS接收到的导航定位信息作为所述车辆的导航定位信息;
若所述GPS接收到的所述导航定位信息不可信,则利用所述方向余弦矩阵和所述车辆速度,实时计算并获取所述车辆的定位信息。
其中,所述若所述GPS接收到的所述导航定位信息不可信,则利用所述方向余弦矩阵和所述车辆速度,实时计算并获取所述车辆的定位信息,包括:
当所述车辆速度采用加速度计获取得到对应的速度信息时,满足:
其中,gn=[00g],g为当地重力加速度;an为当前时刻车辆加速度信息;Vt-1为所述车辆前一时刻对应的速度信息;Vt为获取的当前时刻对应的车辆速度;为所述方向余弦矩阵,地理坐标系记为n系,车辆载体坐标系记为b系;
当所述车辆速度采用车载诊断系统OBD中的里程速度时,满足:
根据获取得到的所述车辆速度Vt,计算得到所述车辆的定位信息Pt满足:
Pt=Pt-1+Mpv(vt-1+vt)Δt/2;
其中,Pt为当前时刻位置信息,包括经度、维度和高度;Pt-1为前一时刻位置信息;h为高度信息;RMD和RND分别为利用地理信息计算的子午圈和卯酉圈对应的主曲率半径。
第二方面,本发明还提供了一种电子设备,所述电子设备包括存储器和处理器,所述存储器上存储有可在所述处理器上运行的基于航位推算的导航定位程序,所述导航定位程序被所述处理器运行时,执行所述的基于航位推算的导航定位方法。
第三方面,本发明还提供了一种计算机存储介质,其特征在于,所述存储介质上存储有导航定位程序,所述导航定位程序可以被一个或者多个处理器执行,以实现所述的基于航位推算的导航定位方法的步骤。
本发明一种基于航位推算的导航定位方法、设备及存储介质,利用实时采集车辆运行过程中的车载信息,基于采集的所述车载信息,利用姿态算法,计算实时姿态角,得到方向余弦矩阵;利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度;利用位置精度因子和可见卫星数,判断GPS输出定位信息的可信度;根据所述GPS接收到的导航定位信息的可信度,并结合所述方向余弦矩阵以及获取的所述车辆速度,实时计算并获取所述车辆的定位信息;实现了借助车载航位推算的方式辅助GPS导航定位的目的,满足了不间断定位的需求。
附图说明
附图用来提供对本发明的进一步理解,并且构成说明书的一部分,与本发明的实施例一起用于解释本发明,并不构成对本发明的限制。在附图中:
图1是本发明基于航位推算的导航定位方法的一种实施方式的流程示意图。
图2是本发明电子设备的一种实施方式的内部结构示意图。
具体实施方式
以下结合附图对本发明的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本发明,并不用于限定本发明。
本发明提供了一种基于航位推算的导航定位方法、设备及存储介质,用以借助车载航位推算的方式辅助GPS导航定位,满足不间断定位的需求。本发明实施例中,航位推算(Dead Rocking,DR)可以理解为:是一种依靠自身传感器测量值实现定位的自主导航技术,主要利用载体运动方向和速度进行推算,从而实现定位功能。在车载条件下,利用惯性传感器(比如陀螺仪)获取车辆的角速度信息,进而计算并获取车辆的运动方向信息,同时可以利用车辆的里程计信息获取车辆速度,实现导航定位信息的计算和获取。这种处理方式简单高效、对处理器要求低,通过对GPS可信度的判断来获取GPS判断的信号盲区,基于惯性传感器短时精度可信度高的特点,辅助判断车辆里程速度的可信度,利用惯性传感器对应的加速度信息和车载诊断系统(On Board Diagnostics,OBD)接口获取的里程速度信息,满足了在GPS信号弱而无法实时定位以及GPS信号盲区等应用场景下提供持续可靠的车辆轨迹信息的需求。
如图1所示,图1是本发明基于航位推算的导航定位方法的一种实施方式的流程示意图。本发明一种基于航位推算的导航定位方法可以实施为如下步骤S10-S40:
步骤S10、实时采集车辆运行过程中的车载信息,基于采集的所述车载信息,利用姿态算法,计算实时姿态角,得到方向余弦矩阵。
本发明实施例中,实时采集车辆运行过程中的车载信息包括但不限于:GPS信号信息、加速度计信息和陀螺仪信息的车载信息。利用采集的上述车载信息,按照姿态算法,完成姿态角的初始化和实时计算,获取地理坐标系(记为n系)和车辆载体坐标系(记为b系)之间的方向余弦矩阵
步骤S20、利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度。
获取所述车载信息中的加速度信息,将获取的所述加速度信息与预设判断阈值进行比较,进而得到所述车载诊断系统OBD中里程速度的可信度。比如,车辆在行驶过程中可能会出现打滑或滑行,此时,OBD获取的里程速度信息将不准确,比如在车辆实际打滑时,OBD获取得到的里程速度将大于实际车辆速度;而车辆在滑行时则正好相反,即OBD获取得到的里程速度将小于实际车辆速度。由于加速度计对应的信息更新频率高,且在短时间内该加速度积分得到的速度具有较高的可信度,因此,在OBD速度更新过程中(比如车辆滑行或者车辆打滑的情况下),可以利用加速度计中加速度信息积分得到的速度信息,来辅助判断OBD中的里程速度是否异常。若判断出OBD中的里程速度异常,则得出OBD中的里程速度不可信;若判断出OBD中的里程速度正常,则得出OBD中的里程速度是可信的。
步骤S30、利用位置精度因子和可见卫星数,判断GPS输出定位信息的可信度。
在GPS导航定位中,位置精度因子(Position Dilution Of Precision,PDOP)可以衡量观测卫星的空间分布对定位精度的影响,该位置精度因子对应的数字越小,则表征该GPS导航定位的精度越高。同时,可观测到的卫星数量也能够表征定位信息的质量,可观测到的卫星数量越多,则表征该GPS导航定位的精度越高。因此,本发明实施例中,可以通过设置PDOP的阀值ThresholdPDOP以及可见卫星数Thresholdnumstar来实现对GPS定位信息可信度判断。
比如,在一个具体的应用场景中,调用设置的所述位置精度因子PDOP对应的预设判断阈值ThresholdPDOP以及所述可见卫星数numstar对应的预设判断阈值Thresholdnumstar;在GPS导航定位的过程中,若GPS输出的定位信息所包含的所述位置精度因子以及所述可见卫星数同时满足:PDOP<ThresholdPDOP;且NumStar≥Thresholdnumstar;则判断得出GPS本次输出的所述定位信息可信。若PDOP≥ThresholdPDOP和/或:numstar<Thresholdnumstar,则判断得出GPS本次输出的所述定位信息不可信。
步骤S40、根据所述GPS接收到的导航定位信息的可信度,并结合所述方向余弦矩阵以及获取的所述车辆速度,实时计算并获取所述车辆的定位信息。
比如,在一个具体的应用场景中,当GPS接收到的所述导航定位信息不可信时,利用所述方向余弦矩阵和所述车辆速度,实时计算并获取所述车辆的定位信息,可以按照如下方式实施:
当所述车辆速度采用加速度计获取得到对应的速度信息时,满足:且Vt=Vt-1+anΔt;其中,gn=[0 0 g],g为当地重力加速度;an为当前时刻车辆加速度信息;Vt-1为所述车辆前一时刻对应的速度信息;Vt为获取的当前时刻对应的车辆速度;为所述方向余弦矩阵,地理坐标系记为n系,车辆载体坐标系记为b系。
根据获取得到的所述车辆速度Vt,计算得到所述车辆的定位信息Pt满足:
Pt=Pt-1+Mpv(vt-1+vt)Δt/2;
其中,Pt为当前时刻位置信息,包括经度、维度和高度;Pt-1为前一时刻位置信息;h为高度信息;RMD和RND分别为利用地理信息计算的子午圈和卯酉圈对应的主曲率半径。
在一个实施例中,图1所述实施例的骤S10中,基于获取的所述车载信息,采用姿态算法,根据初始姿态角计算余弦矩阵的初始值,并利用陀螺仪实时更新的数据,计算实时姿态角,获取地理坐标系与车辆载体坐标系之间的方向余弦矩阵,可以按照如下方式实现:
基于获取的所述车载信息中的航向角信息,对GPS输出的航迹角进行初始化,得到其中,为航向角,GPSheading为GPS输出的航迹角信息。利用获取的所述车载信息中的加速度计信息,对GPS输出的俯仰角和横滚角进行初始化,即:
对所述初始姿态角进行初始化后,根据所述初始姿态角计算方向余弦矩阵其中,地理坐标系记为n系,车辆载体坐标系记为b系。利用所述车载信息中的陀螺仪信息实时更新所述方向余弦矩阵计算得到实时姿态角,即:且其中,为三轴陀螺仪对应输出的信息,Δt为所述陀螺仪对应的数据采样时间间隔。
在一个实施例中,图1所述实施例的骤S20中,利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度,可以按照如下方式实现:在OBD速度更新过程中,利用加速度计信息获得的速度信息,来辅助判断OBD里程速度是否异常。
比如,可以判断所述车载诊断系统OBD获取的相邻时刻ΔT内的速度增量ΔVOBD和加速度计在同一时刻ΔT内的积分速度ΔVACC是否满足预设判断阈值对应的判断条件一:|ΔVOBD-ΔVAcc|≥Γ;其中,Γ为打滑判断阀值,且Γ>0。以及:所述积分速度ΔVACC是否满足预设判断阈值对应的判断条件二:|ΔVOBD-ΔVAcc|≤Λ;其中,Λ为滑行判断阀值,且Λ<0。若满足所述判断条件一和/或判断条件二,则采用所述加速度计获取的速度信息作为所述车辆速度,即V=VACC;若既不满足所述判断条件一,又不满足所述判断条件二,则采用所述车载诊断系统OBD的里程速度作为所述车辆速度,即V=VOBD。
本发明基于航位推算的导航定位方法,利用实时采集车辆运行过程中的车载信息,基于采集的所述车载信息,利用姿态算法,计算实时姿态角,得到方向余弦矩阵;利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度;利用位置精度因子和可见卫星数,判断GPS输出定位信息的可信度;根据所述GPS接收到的导航定位信息的可信度,并结合所述方向余弦矩阵以及获取的所述车辆速度,实时计算并获取所述车辆的定位信息;实现了借助车载航位推算的方式辅助GPS导航定位的目的,满足了不间断定位的需求。
本发明还提供了一种电子设备,所述电子设备可以按照图1所述的基于航位推算的导航定位方法来实现不间断定位的目的。如图2所示,图2是本发明电子设备的一种实施方式的内部结构示意图。
在本实施例中,电子设备1可以是PC(Personal Computer,个人电脑),也可以是智能手机、平板电脑、便携计算机等终端设备。该电子设备1至少包括存储器11、处理器12、通信总线13以及网络接口14。
其中,存储器11至少包括一种类型的可读存储介质,所述可读存储介质包括闪存、硬盘、多媒体卡、卡型存储器(例如,SD或DX存储器等)、磁性存储器、磁盘、光盘等。存储器11在一些实施例中可以是电子设备1的内部存储单元,例如该电子设备1的硬盘。存储器11在另一些实施例中也可以是电子设备1的外部存储设备,例如电子设备1上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。进一步地,存储器11还可以既包括电子设备1的内部存储单元也包括外部存储设备。存储器11不仅可以用于存储安装于电子设备1的应用软件及各类数据,例如导航定位程序01的代码等,还可以用于暂时地存储已经输出或者将要输出的数据。
处理器12在一些实施例中可以是一中央处理器(Central Processing Unit,CPU)、控制器、微控制器、微处理器或其他数据处理芯片,用于运行存储器11中存储的程序代码或处理数据,例如执行导航定位程序01等。
通信总线13用于实现这些组件之间的连接通信。
网络接口14可选的可以包括标准的有线接口、无线接口(如WI-FI接口),通常用于在该电子设备1与其他电子设备之间建立通信连接。
可选地,该电子设备1还可以包括用户接口,用户接口可以包括显示器(Display)、输入单元比如键盘(Keyboard),可选的用户接口还可以包括标准的有线接口、无线接口。可选地,在一些实施例中,显示器可以是LED显示器、液晶显示器、触控式液晶显示器以及OLED(Organic Light-Emitting Diode,有机发光二极管)触摸器等。其中,显示器也可以适当的称为显示屏或显示单元,用于显示在电子设备1中处理的信息以及用于显示可视化的用户界面。
图2仅示出了具有组件11-14以及导航定位程序01的电子设备1,本领域技术人员可以理解的是,图2示出的结构并不构成对电子设备1的限定,可以包括比图示更少或者更多的部件,或者组合某些部件,或者不同的部件布置。
基于图1实施例的描述,在图2所示的电子设备1实施例中,存储器11中存储有导航定位程序01;所述存储器11上存储的导航定位程序01可在所述处理器12上运行,所述导航定位程序01被所述处理器12运行时实现如下步骤:
实时采集车辆运行过程中的车载信息,基于采集的所述车载信息,利用姿态算法,计算实时姿态角,得到方向余弦矩阵;
利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度;
利用位置精度因子和可见卫星数,判断GPS输出定位信息的可信度;
根据所述GPS接收到的导航定位信息的可信度,并结合所述方向余弦矩阵以及获取的所述车辆速度,实时计算并获取所述车辆的定位信息。
本发明电子设备具体实施方式与上述基于航位推算的导航定位方法各实施例的实施原理基本相同,在此不作累述。
此外,本发明实施例还提供了一种计算机存储介质,所述计算机存储介质上存储有导航定位程序,所述导航定位程序可以被一个或者多个处理器执行,以实现图1所述的基于航位推算的导航定位方法的步骤。
本发明计算机可读存储介质具体实施方式与上述基于航位推算的导航定位方法各实施例的实施原理基本相同,在此不作累述。
本领域内的技术人员应明白,本发明的实施例可提供为方法、系统、或计算机程序产品。因此,本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。
Claims (10)
1.一种基于航位推算的导航定位方法,其特征在于,所述基于航位推算的导航定位方法包括:
实时采集车辆运行过程中的车载信息,基于采集的所述车载信息,利用姿态算法,计算实时姿态角,得到方向余弦矩阵;
利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度;
利用位置精度因子和可见卫星数,判断GPS输出定位信息的可信度;
根据所述GPS接收到的导航定位信息的可信度,并结合所述方向余弦矩阵以及获取的所述车辆速度,实时计算并获取所述车辆的定位信息。
2.如权利要求1所述的基于航位推算的导航定位方法,其特征在于,所述实时采集车辆运行过程中的车载信息,基于采集的所述车载信息,利用姿态算法,计算实时姿态角,得到方向余弦矩阵,包括:
实时采集车辆运行过程中包含GPS信号信息、加速度计信息和陀螺仪信息的车载信息;
基于获取的所述车载信息,采用姿态算法,根据初始姿态角计算余弦矩阵的初始值,并利用陀螺仪实时更新的数据,计算实时姿态角,获取地理坐标系与车辆载体坐标系之间的方向余弦矩阵。
3.如权利要求2所述的基于航位推算的导航定位方法,其特征在于,所述基于获取的所述车载信息,采用姿态算法,根据初始姿态角计算余弦矩阵的初始值,并利用陀螺仪实时更新的数据,计算实时姿态角,获取地理坐标系与车辆载体坐标系之间的方向余弦矩阵,包括:
利用获取的所述车载信息中的加速度计信息,对GPS输出的俯仰角和横滚角进行初始化,即:
4.如权利要求1至3任一项所述的基于航位推算的导航定位方法,其特征在于,所述利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,包括:
获取所述车载信息中的加速度信息,将获取的所述加速度信息与预设判断阈值进行比较,判断得到所述车载诊断系统OBD中里程速度的可信度。
5.如权利要求4所述的基于航位推算的导航定位方法,其特征在于,所述利用所述车载信息,判断车载诊断系统OBD中里程速度的可信度,并根据判断结果获取对应的车辆速度,包括:
判断所述车载诊断系统OBD获取的相邻时刻ΔT内的速度增量ΔVOBD和加速度计在同一时刻ΔT内的积分速度ΔVACC是否满足预设判断阈值对应的判断条件一:
|ΔVOBD-ΔVAcc|≥Γ;其中,Γ为打滑判断阀值,且Γ>0;
以及所述积分速度ΔVACC是否满足预设判断阈值对应的判断条件二:
|ΔVOBD-ΔVAcc|≤Λ;其中,Λ为滑行判断阀值,且Λ<0;
若满足所述判断条件一和/或判断条件二,则采用所述加速度计获取的速度信息作为所述车辆速度,即V=VACC;
若既不满足所述判断条件一,又不满足所述判断条件二,则采用所述车载诊断系统OBD的里程速度作为所述车辆速度,即V=VOBD。
6.如权利要求1至3任一项所述的基于航位推算的导航定位方法,其特征在于,所述利用位置精度因子和可见卫星数,判断GPS输出定位信息的可信度,包括:
调用设置的所述位置精度因子PDOP对应的预设判断阈值ThresholdPDOP以及所述可见卫星数numstar对应的预设判断阈值Thresholdnumstar;
在GPS导航定位的过程中,若GPS输出的定位信息所包含的所述位置精度因子以及所述可见卫星数同时满足:
PDOP<ThresholdPDOP;且NumStar≥Thresholdnumstar;
则判断得出GPS本次输出的所述定位信息可信;否则,判断得出GPS本次输出的所述定位信息不可信。
7.如权利要求1至3任一项所述的基于航位推算的导航定位方法,其特征在于,所述根据所述GPS接收到的导航定位信息的可信度,并结合所述方向余弦矩阵以及获取的所述车辆速度,实时计算并获取所述车辆的定位信息,包括:
若所述GPS接收到的所述导航定位信息可信,则将GPS接收到的导航定位信息作为所述车辆的导航定位信息;
若所述GPS接收到的所述导航定位信息不可信,则利用所述方向余弦矩阵和所述车辆速度,实时计算并获取所述车辆的定位信息。
8.如权利要求7所述的基于航位推算的导航定位方法,其特征在于,所述若所述GPS接收到的所述导航定位信息不可信,则利用所述方向余弦矩阵和所述车辆速度,实时计算并获取所述车辆的定位信息,包括:
当所述车辆速度采用加速度计获取得到对应的速度信息时,满足:
其中,gn=[0 0 g],g为当地重力加速度;an为当前时刻车辆加速度信息;Vt-1为所述车辆前一时刻对应的速度信息;Vt为获取的当前时刻对应的车辆速度;为所述方向余弦矩阵,地理坐标系记为n系,车辆载体坐标系记为b系;
当所述车辆速度采用车载诊断系统OBD中的里程速度时,满足:
根据获取得到的所述车辆速度Vt,计算得到所述车辆的定位信息Pt满足:
Pt=Pt-1+Mpv(vt-1+vt)Δt/2;
其中,Pt为当前时刻位置信息,包括经度、维度和高度;Pt-1为前一时刻位置信息;h为高度信息;RMD和RND分别为利用地理信息计算的子午圈和卯酉圈对应的主曲率半径。
9.一种电子设备,其特征在于,所述电子设备包括存储器和处理器,所述存储器上存储有可在所述处理器上运行的基于航位推算的导航定位程序,所述导航定位程序被所述处理器运行时,执行如权利要求1至8中任一项所述的基于航位推算的导航定位方法。
10.一种计算机存储介质,其特征在于,所述存储介质上存储有导航定位程序,所述导航定位程序可以被一个或者多个处理器执行,以实现如权利要求1至8中任一项所述的基于航位推算的导航定位方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010612025.2A CN111562603B (zh) | 2020-06-30 | 2020-06-30 | 基于航位推算的导航定位方法、设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010612025.2A CN111562603B (zh) | 2020-06-30 | 2020-06-30 | 基于航位推算的导航定位方法、设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111562603A true CN111562603A (zh) | 2020-08-21 |
CN111562603B CN111562603B (zh) | 2022-10-04 |
Family
ID=72071236
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010612025.2A Active CN111562603B (zh) | 2020-06-30 | 2020-06-30 | 基于航位推算的导航定位方法、设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111562603B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112230192A (zh) * | 2020-12-21 | 2021-01-15 | 东方微电科技(武汉)有限公司 | 基于磁传感与定位系统的雷达航向角测量方法及装置 |
CN112415558A (zh) * | 2021-01-25 | 2021-02-26 | 腾讯科技(深圳)有限公司 | 行进轨迹的处理方法及相关设备 |
CN112748716A (zh) * | 2020-12-10 | 2021-05-04 | 无锡行米科技有限公司 | 一种混合obd汽车诊断以及gnss卫星数据获取行车信息的方法 |
CN113124861A (zh) * | 2021-03-03 | 2021-07-16 | 深圳市星砺达科技有限公司 | 空间辅助的电子设备定位方法、装置、计算机设备及介质 |
CN113252048A (zh) * | 2021-05-12 | 2021-08-13 | 高新兴物联科技有限公司 | 一种导航定位方法、导航定位系统及计算机可读存储介质 |
CN114143718A (zh) * | 2021-11-03 | 2022-03-04 | 珠海格力电器股份有限公司 | 目标定位方法、装置、系统、存储介质及电子设备 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6087965A (en) * | 1995-06-15 | 2000-07-11 | Trimble Navigation Limited | Vehicle mileage meter and a GPS position tracking system |
CN1828225A (zh) * | 2005-03-02 | 2006-09-06 | 北京航天鼎一科技发展有限公司 | 车辆航位推算定位方法及定位模块 |
US20100030470A1 (en) * | 2008-07-02 | 2010-02-04 | O2Micro, Inc. | Global positioning system and dead reckoning (gps&dr) integrated navigation system |
EP2244099A1 (en) * | 2008-02-13 | 2010-10-27 | Furuno Electric Co., Ltd. | Satellite navigation/dead-reckoning navigation integrated positioning device |
CN101907714A (zh) * | 2010-06-25 | 2010-12-08 | 陶洋 | 基于多传感器数据融合的gps辅助定位系统及其定位方法 |
CN103471601A (zh) * | 2013-09-22 | 2013-12-25 | 东莞市泰斗微电子科技有限公司 | 一种车载组合导航方法及导航系统 |
CN107389064A (zh) * | 2017-07-27 | 2017-11-24 | 长安大学 | 一种基于惯性导航的无人车变道控制方法 |
CN107436444A (zh) * | 2017-06-23 | 2017-12-05 | 北京机械设备研究所 | 一种车载多模式组合导航系统及方法 |
CN108180925A (zh) * | 2017-12-15 | 2018-06-19 | 中国船舶重工集团公司第七0七研究所 | 一种里程计辅助车载动态对准方法 |
CN108235735A (zh) * | 2017-12-20 | 2018-06-29 | 深圳前海达闼云端智能科技有限公司 | 一种定位方法、装置及电子设备、计算机程序产品 |
CN109813306A (zh) * | 2019-01-17 | 2019-05-28 | 李子月 | 一种无人车规划轨迹卫星定位数据可信度计算方法 |
CN110764119A (zh) * | 2019-11-07 | 2020-02-07 | 中国人民解放军火箭军工程大学 | 不依赖于卫星导航信息的卫星天线自主测控方法及系统 |
CN110986931A (zh) * | 2019-12-10 | 2020-04-10 | 清华大学 | 全球混合导航方法、装置、计算机设备和可读存储介质 |
-
2020
- 2020-06-30 CN CN202010612025.2A patent/CN111562603B/zh active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6087965A (en) * | 1995-06-15 | 2000-07-11 | Trimble Navigation Limited | Vehicle mileage meter and a GPS position tracking system |
CN1828225A (zh) * | 2005-03-02 | 2006-09-06 | 北京航天鼎一科技发展有限公司 | 车辆航位推算定位方法及定位模块 |
EP2244099A1 (en) * | 2008-02-13 | 2010-10-27 | Furuno Electric Co., Ltd. | Satellite navigation/dead-reckoning navigation integrated positioning device |
US20100030470A1 (en) * | 2008-07-02 | 2010-02-04 | O2Micro, Inc. | Global positioning system and dead reckoning (gps&dr) integrated navigation system |
CN101907714A (zh) * | 2010-06-25 | 2010-12-08 | 陶洋 | 基于多传感器数据融合的gps辅助定位系统及其定位方法 |
CN103471601A (zh) * | 2013-09-22 | 2013-12-25 | 东莞市泰斗微电子科技有限公司 | 一种车载组合导航方法及导航系统 |
CN107436444A (zh) * | 2017-06-23 | 2017-12-05 | 北京机械设备研究所 | 一种车载多模式组合导航系统及方法 |
CN107389064A (zh) * | 2017-07-27 | 2017-11-24 | 长安大学 | 一种基于惯性导航的无人车变道控制方法 |
CN108180925A (zh) * | 2017-12-15 | 2018-06-19 | 中国船舶重工集团公司第七0七研究所 | 一种里程计辅助车载动态对准方法 |
CN108235735A (zh) * | 2017-12-20 | 2018-06-29 | 深圳前海达闼云端智能科技有限公司 | 一种定位方法、装置及电子设备、计算机程序产品 |
CN109813306A (zh) * | 2019-01-17 | 2019-05-28 | 李子月 | 一种无人车规划轨迹卫星定位数据可信度计算方法 |
CN110764119A (zh) * | 2019-11-07 | 2020-02-07 | 中国人民解放军火箭军工程大学 | 不依赖于卫星导航信息的卫星天线自主测控方法及系统 |
CN110986931A (zh) * | 2019-12-10 | 2020-04-10 | 清华大学 | 全球混合导航方法、装置、计算机设备和可读存储介质 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112748716A (zh) * | 2020-12-10 | 2021-05-04 | 无锡行米科技有限公司 | 一种混合obd汽车诊断以及gnss卫星数据获取行车信息的方法 |
CN112230192A (zh) * | 2020-12-21 | 2021-01-15 | 东方微电科技(武汉)有限公司 | 基于磁传感与定位系统的雷达航向角测量方法及装置 |
CN112415558A (zh) * | 2021-01-25 | 2021-02-26 | 腾讯科技(深圳)有限公司 | 行进轨迹的处理方法及相关设备 |
CN113124861A (zh) * | 2021-03-03 | 2021-07-16 | 深圳市星砺达科技有限公司 | 空间辅助的电子设备定位方法、装置、计算机设备及介质 |
CN113252048A (zh) * | 2021-05-12 | 2021-08-13 | 高新兴物联科技有限公司 | 一种导航定位方法、导航定位系统及计算机可读存储介质 |
CN113252048B (zh) * | 2021-05-12 | 2023-02-28 | 高新兴物联科技股份有限公司 | 一种导航定位方法、导航定位系统及计算机可读存储介质 |
CN114143718A (zh) * | 2021-11-03 | 2022-03-04 | 珠海格力电器股份有限公司 | 目标定位方法、装置、系统、存储介质及电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN111562603B (zh) | 2022-10-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111562603B (zh) | 基于航位推算的导航定位方法、设备及存储介质 | |
US9921065B2 (en) | Unit and method for improving positioning accuracy | |
CN109931926B (zh) | 一种基于站心坐标系的小型无人机无缝自主式导航方法 | |
US7831389B2 (en) | Map evaluation system and map evaluation method | |
US9618344B2 (en) | Digital map tracking apparatus and methods | |
US20110307171A1 (en) | GPS Location Refinement Method In Environments With Low Satellite Visibility | |
EP3339807B1 (en) | An apparatus and associated methods for determining the location of a vehicle | |
DE102010060234A1 (de) | Verfahren und Applikationen zur Höhenmessung und der Vereinigung von Benutzerinhaltserfassung mit einer Elevationsbewegung für persönliche Navigationssysteme | |
Aly et al. | Robust and ubiquitous smartphone-based lane detection | |
US20230104188A1 (en) | Method, apparatus, and system for calibrating vehicle motion data based on mobile device sensor data | |
US11249197B2 (en) | Image-based techniques for stabilizing positioning estimates | |
CN114545472B (zh) | 一种gnss/ins组合系统的导航方法和装置 | |
CN110940344A (zh) | 一种用于自动驾驶的低成本传感器组合定位方法 | |
CN102538790A (zh) | 惯性导航中陀螺仪参数的差异性解决方法 | |
CN115407376A (zh) | 车辆定位校准方法、装置、计算机设备、存储介质 | |
Iqbal et al. | Experimental results on an integrated GPS and multisensor system for land vehicle positioning | |
US20230051377A1 (en) | Mobility movemennt information acquiring method and mobility movement information acquiring apparatus | |
US20220042802A1 (en) | Extended dead reckoning accuracy | |
CN115790613B (zh) | 一种视觉信息辅助的惯性/里程计组合导航方法及装置 | |
CN116124129A (zh) | 定位信息处理方法、装置、设备和介质 | |
CN114001730B (zh) | 融合定位方法、装置、计算机设备和存储介质 | |
CN113514057B (zh) | 一种警务定位设备、方法及系统 | |
CN110187374B (zh) | 一种智能驾驶性能检测多目标协同定位系统及方法 | |
JP2001264091A (ja) | ナビゲーション装置 | |
TWI811733B (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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20210218 Address after: 518000 area B and C, 2 / F, Mindray R & D building, 009 Keji South 12th Road, Gaoxin community, Yuehai street, Nanshan District, Shenzhen City, Guangdong Province Applicant after: Shenzhen Moji Zhixing Technology Co.,Ltd. Address before: 518000 Guangdong, Shenzhen, Nanshan District, Guangdong Province, Nanshan District high tech Industrial Park, South Korea 12 road, MINDRAY Building 2 floor B area, zone 12 Applicant before: Gaoxing Wulian Technology Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |