CN113945229A - 基于pps的嵌入式ins测量时刻标定系统及方法 - Google Patents
基于pps的嵌入式ins测量时刻标定系统及方法 Download PDFInfo
- Publication number
- CN113945229A CN113945229A CN202111557956.8A CN202111557956A CN113945229A CN 113945229 A CN113945229 A CN 113945229A CN 202111557956 A CN202111557956 A CN 202111557956A CN 113945229 A CN113945229 A CN 113945229A
- Authority
- CN
- China
- Prior art keywords
- data
- ins
- gnss
- pps
- time
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- 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
- 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/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
Abstract
本发明实施例公开了一种基于PPS的嵌入式INS测量时刻标定系统及方法,所述系统包括GNSS芯片、INS传感器以及嵌入式芯片。GNSS芯片通过数据总线发送数据至嵌入式芯片,通过GPIO接口将PPS输入至嵌入式芯片;INS传感器通过数据总线连接至GNSS芯片;嵌入式芯片完成数据解析和INS解算,嵌入式芯片包含一个以输入时钟为基准的计数器Timer,该计数器按照时钟频率自动累加。本发明利用GNSS芯片输出的PPS来标定INS传感器测量时刻,标定误差可以控制在1us以下,提高GNSS/INS组合导航定位的精度和可靠性。
Description
技术领域
本发明涉及定位导航技术领域,尤其涉及一种基于PPS的嵌入式INS测量时刻标定系统及方法。
背景技术
GNSS(Global Navigation Satellite System,全球卫星导航系统)导航定位依赖接收GNSS卫星信号进行定位,具有全天候、实时、精度较高、导航误差不随时间累积等优点,但是也存在信号容易受到遮挡或干扰导致无法定位、数据更新率低以及在动态环境中可靠性较差等问题。
惯性导航系统(Inertial Navigation System,INS)是一种不依赖于外部信息的自主式导航系统。INS根据牛顿力学原理,由陀螺仪和加速度计测得的载体相对于惯性空间的角速度和加速度信息,积分求得载体的三维速度、位置和姿态信息等导航参数。INS是一种自主性强、隐蔽性好、不受气象条件限制、短时精度高的导航系统。其优点是不受外界环境(包括遮挡、电磁干扰等)影响,并可以在一定的时间内保证较高精度,缺点是定位误差会随时间积累。高精度的惯性导航器件成本可达百万人民币,而低成本惯性器件精度较低,且误差扩散比较快,难以满足长时间独立导航需求。
随着对运动载体的导航定位精度和可靠性要求的提高,单一的导航系统已经难以满足用户的需求。由于GNSS和INS具有良好的优势互补性,因此GNSS/INS组合可以提高系统的整体导航性能及导航精度。GNSS/INS组合导航可以使用低成本惯导器件,具有成本上的优势,并且可以满足民用导航定位的需求。
对于不生产GNSS芯片的GNSS/INS组合导航研发单位,通常是购买GNSS芯片和INS传感器(IMU,高度计,里程计等),将GNSS数据和INS传感器数据输入至嵌入式芯片(一般是ARM或DSP),由嵌入式芯片完成GNSS/INS组合定位。
对于GNSS/INS导航定位系统,很多传感器的数据不包含时间信息,传感器测量时刻的标定是INS的一个重点和难点。如果测量时刻标定不准确,会导致定位结果不准确,并有可能导致INS滤波发散,无法收敛的严重后果。
发明内容
本发明实施例所要解决的技术问题在于,提供一种基于PPS的嵌入式INS测量时刻标定系统及方法,以提高GNSS/INS组合导航定位的精度和可靠性。
为了解决上述技术问题,本发明实施例提出了一种基于PPS的嵌入式INS测量时刻标定系统,
包括GNSS芯片、INS传感器以及嵌入式芯片,嵌入式芯片包含一个以输入时钟为基准的计数器Timer,该计数器按照时钟频率自动累加,其中,嵌入式芯片包括中断服务函数、INS传感器数据处理模块、GNSS数据解析模块、INS解算模块,
GNSS芯片通过数据总线发送GNSS定位结果至嵌入式芯片,并通过GPIO接口输入PPS至嵌入式芯片;INS传感器发送IMU、里程计、高度计传感器数据至嵌入式芯片;
嵌入式芯片的GNSS数据解析模块根据GNSS定位结果完成GNSS数据解析,得到定位数据;
嵌入式芯片接收到PPS中断后,在对应的中断服务函数中记录当前时刻的Timer计数,并记录对应的GNSS时间;嵌入式芯片接收到INS传感器的数据中断后,在中断服务函数中设置传感器数据时间标签,并发送至INS传感器数据处理模块;INS传感器数据处理模块接收GNSS数据解析模块发送的定位数据,接收到传感器数据时间标签后,提取IMU、里程计、高度计传感器数据,整理后发送至INS解算模块;INS解算模块完成INS解算,输出定位结果。
相应地,本发明实施例还提供了一种基于PPS的嵌入式INS测量时刻标定方法,包括:
步骤1、GNSS芯片通过数据总线发送定位结果至嵌入式芯片;
步骤2、GNSS芯片通过GPIO接口输入PPS至嵌入式芯片;
步骤3、嵌入式芯片完成GNSS数据解析;
步骤4、嵌入式芯片接收到PPS中断后,在GNSS数据中断服务函数中记录PPS对应的Timer计数,并记录对应的GNSS时间;
嵌入式芯片接收到INS传感器的数据中断后,在INS传感器数据中断服务函数中设置传感器数据时间标签,并发送至INS传感器数据处理模块;
步骤5、INS传感器数据处理模块接收GNSS数据解析模块发送的定位数据,接收到传感器数据时间标签后,提取IMU、里程计、高度计传感器数据,整理后发送至INS解算模块;
步骤6、INS解算模块完成INS解算;
步骤7、输出定位结果。
本发明的有益效果为:本发明利用GNSS芯片输出的PPS来标定INS传感器测量时刻,标定误差可以控制在1us以下,提高GNSS/INS组合导航定位的精度和可靠性。
附图说明
图1是本发明一种实施例的基于PPS的嵌入式INS测量时刻标定系统的结构示意图。
图2是本发明另一种实施例的基于PPS的嵌入式INS测量时刻标定系统的结构示意图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互结合,下面结合附图和具体实施例对本发明作进一步详细说明。
请参照图1和图2,本发明实施例的基于PPS的嵌入式INS测量时刻标定系统包括GNSS芯片、INS传感器以及嵌入式芯片。
嵌入式芯片包含一个以输入时钟为基准的计数器Timer,该计数器按照时钟频率自动累加。嵌入式芯片利用该计数器计算时间间隔,完成数据解析和INS解算。嵌入式芯片包括中断服务函数、INS传感器数据处理模块、GNSS数据解析模块、INS解算模块。
GNSS芯片通过数据总线发送GNSS定位结果至嵌入式芯片,并通过GPIO(General-purpose input/output,通用型输入输出)接口输入PPS至嵌入式芯片;INS传感器发送IMU(Inertial Measurement Unit,惯性测量单元)、里程计、高度计传感器数据至嵌入式芯片。
嵌入式芯片根据GNSS定位结果完成GNSS数据解析,得到定位数据;嵌入式芯片接收到PPS中断后,在对应的中断服务函数中记录当前时刻的Timer计数,并记录对应的GNSS时间;嵌入式芯片接收到INS传感器的数据中断后,在中断服务函数中设置传感器数据时间标签,并发送至INS传感器数据处理模块;INS传感器数据处理模块接收GNSS数据解析模块发送的定位数据,接收到传感器数据时间标签后,提取IMU、里程计、高度计传感器数据,整理后发送至INS解算模块;INS解算模块完成INS解算,输出定位结果。
作为一种实施方式,在嵌入式芯片接收到GNSS芯片发送的数据中断后,中断服务函数启动,从数据总线提取GNSS数据并存至缓存,并发送给GNSS数据解析模块,GNSS数据解析模块接收到数据后,完成数据帧同步、校验、解析流程,提取位置、速度、时间信息发送至INS传感器数据处理模块或INS解算模块。
作为一种实施方式,嵌入式芯片在PPS中断后,根据以下方法设置传感器数据时间标签:
根据计算的当前GNSS时间设置传感器数据的时间标签。
本发明实施例的基于PPS的嵌入式INS测量时刻标定方法,包括:
步骤1、GNSS芯片通过数据总线发送定位结果至嵌入式芯片;
步骤2、GNSS芯片通过GPIO接口输入PPS至嵌入式芯片;
步骤3、嵌入式芯片完成GNSS数据解析;
步骤4、嵌入式芯片接收到PPS中断后,在GNSS数据中断服务函数中记录PPS对应的Timer计数,并记录对应的GNSS时间;
嵌入式芯片接收到INS传感器的数据中断后,在INS传感器数据中断服务函数中设置传感器数据时间标签,并发送至INS传感器数据处理模块;
步骤5、INS传感器数据处理模块接收GNSS数据解析模块发送的定位数据,接收到传感器数据时间标签后,提取IMU、里程计、高度计传感器数据,整理后发送至INS解算模块;
步骤6、INS解算模块完成INS解算;
步骤7、输出定位结果。
作为一种实施方式,GNSS数据中断服务函数启动后,从数据总线提取GNSS数据并存至缓存,发送给GNSS数据解析模块;GNSS数据解析模块接收到数据后,完成数据帧同步、校验、解析等流程,提取位置、速度、时间等信息,发送至INS传感器数据处理模块或者INS解算模块。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同范围限定。
Claims (6)
1.一种基于PPS的嵌入式INS测量时刻标定系统,其特征在于,包括GNSS芯片、INS传感器以及嵌入式芯片,嵌入式芯片包含一个以输入时钟为基准的计数器Timer,该计数器按照时钟频率自动累加,其中,嵌入式芯片包括中断服务函数、INS传感器数据处理模块、GNSS数据解析模块、INS解算模块,
GNSS芯片通过数据总线发送GNSS定位结果至嵌入式芯片,并通过GPIO接口输入PPS至嵌入式芯片;INS传感器发送IMU、里程计、高度计传感器数据至嵌入式芯片;
嵌入式芯片的GNSS数据解析模块根据GNSS定位结果完成GNSS数据解析,得到定位数据;
嵌入式芯片接收到PPS中断后,在对应的中断服务函数中记录当前时刻的Timer计数,并记录对应的GNSS时间;嵌入式芯片接收到INS传感器的数据中断后,在中断服务函数中设置传感器数据时间标签,并发送至INS传感器数据处理模块;INS传感器数据处理模块接收GNSS数据解析模块发送的定位数据,接收到传感器数据时间标签后,提取IMU、里程计、高度计传感器数据,整理后发送至INS解算模块;INS解算模块完成INS解算,输出定位结果。
2.如权利要求1所述的基于PPS的嵌入式INS测量时刻标定系统,其特征在于,在嵌入式芯片接收到GNSS芯片发送的数据中断后,中断服务函数启动,从数据总线提取GNSS数据并存至缓存,并发送给GNSS数据解析模块,GNSS数据解析模块接收到数据后,完成数据帧同步、校验、解析流程,提取位置、速度、时间信息发送至INS传感器数据处理模块或INS解算模块。
4.一种基于PPS的嵌入式INS测量时刻标定方法,其特征在于,包括:
步骤1、GNSS芯片通过数据总线发送定位结果至嵌入式芯片;
步骤2、GNSS芯片通过GPIO接口输入PPS至嵌入式芯片;
步骤3、嵌入式芯片完成GNSS数据解析;
步骤4、嵌入式芯片接收到PPS中断后,在对应的中断服务函数中记录当前时刻的Timer计数,并记录对应的GNSS时间;
嵌入式芯片接收到INS传感器的数据中断后,在INS传感器数据中断服务函数中设置传感器数据时间标签,并发送至INS传感器数据处理模块;
步骤5、INS传感器数据处理模块接收GNSS数据解析模块的定位数据,接收到传感器数据时间标签后,提取IMU、里程计、高度计传感器数据,整理后发送至INS解算模块;
步骤6、INS解算模块完成INS解算;
步骤7、输出定位结果。
5.如权利要求4所述的基于PPS的嵌入式INS测量时刻标定方法,其特征在于,步骤4中,
GNSS数据中断服务函数启动后,从数据总线提取GNSS数据并存至缓存,发送给GNSS数据解析模块;
GNSS数据解析模块接收到数据后,完成数据帧同步、校验、解析等流程,提取位置、速度、时间信息,发送至INS传感器数据获取模块或者INS解算模块。
6.如权利要求4所述的基于PPS的嵌入式INS测量时刻标定方法,其特征在于,步骤4包括以下子步骤:
子步骤7、INS传感器数据中断的GNSS时间计算完后,设置好时间标签发送至传感器数据处理模块。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111557956.8A CN113945229A (zh) | 2021-12-20 | 2021-12-20 | 基于pps的嵌入式ins测量时刻标定系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111557956.8A CN113945229A (zh) | 2021-12-20 | 2021-12-20 | 基于pps的嵌入式ins测量时刻标定系统及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113945229A true CN113945229A (zh) | 2022-01-18 |
Family
ID=79339271
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111557956.8A Pending CN113945229A (zh) | 2021-12-20 | 2021-12-20 | 基于pps的嵌入式ins测量时刻标定系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113945229A (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101067656A (zh) * | 2007-05-25 | 2007-11-07 | 北京航空航天大学 | 一种位置姿态系统的硬件时间同步方法 |
CN102183253A (zh) * | 2010-12-31 | 2011-09-14 | 北京航空航天大学 | 一种位置和姿态测量系统的软件时间同步方法 |
CN109729277A (zh) * | 2018-11-19 | 2019-05-07 | 魔门塔(苏州)科技有限公司 | 多传感器采集时间戳同步装置 |
CN113009541A (zh) * | 2019-12-19 | 2021-06-22 | 瑞士优北罗股份有限公司 | 给异步传感器测量加时间戳 |
-
2021
- 2021-12-20 CN CN202111557956.8A patent/CN113945229A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101067656A (zh) * | 2007-05-25 | 2007-11-07 | 北京航空航天大学 | 一种位置姿态系统的硬件时间同步方法 |
CN102183253A (zh) * | 2010-12-31 | 2011-09-14 | 北京航空航天大学 | 一种位置和姿态测量系统的软件时间同步方法 |
CN109729277A (zh) * | 2018-11-19 | 2019-05-07 | 魔门塔(苏州)科技有限公司 | 多传感器采集时间戳同步装置 |
CN113009541A (zh) * | 2019-12-19 | 2021-06-22 | 瑞士优北罗股份有限公司 | 给异步传感器测量加时间戳 |
Non-Patent Citations (2)
Title |
---|
丁继成 等,: ""基于嵌入式平台的GNSS/INS组合导航时间同步方法研究"", 《遥测遥控》 * |
常乐,: ""基于DSP的GNSS/INS实时组合导航系统的研究"", 《中国优秀博硕士学位论文全文数据库(硕士) 基础科学辑》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111381487B (zh) | 多传感器同步授时系统、方法、装置及电子设备 | |
CN111007554A (zh) | 数据采集时间同步系统和方法 | |
CN112577521B (zh) | 一种组合导航误差校准方法及电子设备 | |
US7171303B1 (en) | Navigation method and apparatus | |
CN111121768B (zh) | 一种机器人位姿估计方法、装置、可读存储介质及机器人 | |
EP2816374B1 (en) | Vehicle positioning in high-reflection environments | |
CN106197410A (zh) | 用于准确捕获惯性传感器数据的方法和装置 | |
CN113848579B (zh) | Ins辅助gnss定位的粗差剔除方法及系统 | |
US20100103041A1 (en) | Method of determining reliability of long-term predicted orbit data, method of providing long-term predicted orbit data, and information providing apparatus | |
US11662475B2 (en) | Time stamping asynchronous sensor measurements | |
CN107990901B (zh) | 一种基于传感器的用户方向定位方法 | |
CN113091770A (zh) | 惯性测量传感器的零偏的补偿方法 | |
CN109975851A (zh) | 一种列车线路故障点精确定位方法与系统 | |
CN105785402A (zh) | 一种用于gnss信号模拟器时延校准的系统及方法 | |
CN113498625A (zh) | 时钟同步方法和装置、芯片系统、无人机和终端 | |
CN116678406B (zh) | 组合导航姿态信息确定方法、装置、终端设备及存储介质 | |
CN104897169B (zh) | 一种微型姿态模块的动态精度测试系统及其方法 | |
CN111443370B (zh) | 车辆定位方法、装置、设备及车辆 | |
CN111679307B (zh) | 一种卫星定位信号解算方法及装置 | |
CN113945229A (zh) | 基于pps的嵌入式ins测量时刻标定系统及方法 | |
CN105910617A (zh) | 一种车载导航系统中采样点时间同步的方法及装置 | |
CN114545762B (zh) | 一种基于惯性测量单元的时间数据同步方法及系统 | |
CN102901517A (zh) | 一种基于时间同步的火箭橇试验测量系统 | |
CN113808413B (zh) | 车辆及其车速确定方法及装置、存储介质、终端 | |
CN114812544A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20220118 |