CN106405606A - 一种高精度卫星定位的实现方法 - Google Patents
一种高精度卫星定位的实现方法 Download PDFInfo
- Publication number
- CN106405606A CN106405606A CN201610711878.5A CN201610711878A CN106405606A CN 106405606 A CN106405606 A CN 106405606A CN 201610711878 A CN201610711878 A CN 201610711878A CN 106405606 A CN106405606 A CN 106405606A
- Authority
- CN
- China
- Prior art keywords
- serial port
- latitude
- longitude
- toggle switch
- 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.)
- Pending
Links
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/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)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种高精度卫星定位的实现方法,属于导航定位领域,主要应用于对定位精度要求较高的场合。本发明通过陀螺仪、加速度计和磁力计确立定位载体的方向,角速度和加速度,经计算校正最终输出定位载体的经纬度和高度信息,从而提供更加精确的定位。
Description
技术领域
本发明涉及涉及卫星导航定位技术。
背景技术
随着导航定位技术的发展,导航定位在日常生活中日渐普及,但是受天气和使用环境的影响,经常发生南辕北辙的情况,定位精度的高低直接影响导航的结果。本发明装置支持北斗和GPS卫星定位装置的接入,通过陀螺仪、加速度计和磁力计确立定位载体的方向,角速度和加速度,经计算校正最终输出定位载体的经纬度和高度信息,经实际定位测试误差小于1米。
目前为了解决定位误差过大的问题,而发射更多的导航定位卫星。发射更多的导航定位卫星固然可以提高导航定位的精度,但是成本高,在接收导航定位卫星信号比较差的环境,导航定位的精度仍很难保证。
故,需要一种新的技术方案以解决上述问题。
发明内容
本发明的目的在于克服上述方案的缺点,通过陀螺仪、加速度计和磁力计确立定位载体的方向,角速度和加速度,经计算校正最终输出定位载体的经纬度和高度信息。
为实现上述目的,本发明可采用如下技术方案:
一种高精度卫星定位的实现方法,包括以下步骤:
(1)、在定位载体上设置高精度定位装置;该高精度定位装置中包括处理器、输入串口、输入串口波特率拨码开关、输入串口协议拨码开关、输出串口、输出串口波特率拨码开关、输出串口协议拨码开关;所述输入串口、输入串口波特率拨码开关、输入串口协议拨码开关、输出串口、输出串口波特率拨码开关、输出串口协议拨码开关均与处理器电性连接;其特征在于:还包括陀螺仪、加速度计、磁力计,陀螺仪、加速度计、磁力计也与处理器电性连接;
(2)、采集陀螺仪、加速度计和磁力计的数据,采用陀螺仪和加速度计互为校正确立定位载体的各轴向的角度和加速度,最后结合磁力计计算各方向上的位移;
(3)、解析北斗/GPS通信协议,获取当前定位载体的经纬度和高度信息;
(4)、计算输出定位载体的经纬度和高度信息。
相对与现有技术,本发明具有如下优点:
1)导航定位精度高,经实际定位测试误差小于1米;
2)本发明装置体积较小,便于安装,直接串联在串口线上即可;
3)支持多种卫星导航定位协议,如:NAEA-0183、NAEA-0180和NAEA-0182等;
4)通过设置输入串口波特率和协议拨码开关可以支持不同厂家的卫星导航定位设备;
5)通过设置输出串口波特率和协议拨码开关,可以和现有系统实现无缝对接,不需任何软件修改。
附图说明
图1是本发明中高精度定位装置的结构示意图。
图2是本发明中软件模块的关系示意图。
图3是传感器采集计算模块工作流程图。
图4是北斗/GPS协议解析模块工作流程图。
图5是计算校正输出模块工作流程图。
具体实施方式
下面结合附图,进一步阐明本发明,应理解这些实施例仅用于说明本发明而不用于限制本发明的范围,在阅读了本发明之后,本领域技术人员对本发明的各种等价形式的修改均落于本申请所附权利要求所限定的范围。
本发明公开一种高精度卫星定位的实现方法,包括以下步骤:
(1)、如图1所示,在定位载体上设置高精度定位装置;该高精度定位装置中包括处理器、输入串口、输入串口波特率拨码开关、输入串口协议拨码开关、输出串口、输出串口波特率拨码开关、输出串口协议拨码开关;所述输入串口、输入串口波特率拨码开关、输入串口协议拨码开关、输出串口、输出串口波特率拨码开关、输出串口协议拨码开关均与处理器电性连接;其特征在于:还包括陀螺仪、加速度计、磁力计,陀螺仪、加速度计、磁力计也与处理器电性连接;
(2)、采集陀螺仪、加速度计和磁力计的数据,采用陀螺仪和加速度计互为校正确立定位载体的各轴向的角度和加速度,最后结合磁力计计算各方向上的位移;
(3)、解析北斗/GPS通信协议,获取当前定位载体的经纬度和高度信息;
(4)、计算输出定位载体的经纬度和高度信息。
其中,步骤(2)至步骤(4)中,需要设置软件模块进行实现,软件模块包括传感器采集计算模块、北斗/GPS协议解析模块、计算校正输出模块,各模块之间的关系如图2所示。
传感器采集计算模块负责采集陀螺仪、加速度计和磁力计的数据,加速度计读数受振动影响较大,采用陀螺仪和加速度计互为校正确立定位载体的各轴向的角度和加速度,最后结合磁力计计算各方向上的位移,其实现过程如图3,即实现步骤(2),该步骤(2)中,包括如下细分步骤:
(2a)读取加速度传感器的当前值:AxADCn、AyADCn、AzADCn,读取时间:T1、T2、T3,最后一次读取时间:T1n、T2n、T3n;
(2b)读取陀螺仪传感器的当前值:∠xADCn、∠yADCn、∠zADCn;
(2c)重复步骤(2a)和(2b)100次并将其累计后,求其平均值分别为:AxADC、AyADC、AzADC和∠xADC、∠yADC、∠zADC;
(2d)分别将AxADC、AyADC、AzADC代入(ADC*Vref/1023-Vzg)/S计算得到Rx、Ry、Rz方向上的加速度;
上式中ADC为AxADC、AyADC、AzADC;
Vref为传感器的参考电压;
1023为2^传感器的分辨率位数-1计算得到,如当前传感器分辨率为10,固有2^10-1=1023;
Vzg为传感器的零加速度的电压值;
S为传感器的灵敏度;
(2e)由三维空间勾股定理通过Rx、Ry、Rz可以计算得到X、Y和Z轴的角度∠X1、∠Y1、∠Z1;
(2f)和步骤(2d)中的公式类似可以计算出陀螺仪传感器在X、Y和Z轴的角度∠X2、∠Y2、∠Z2;
(2g)计算比较∠X1/∠X2、∠Y1/∠Y2、∠Z1/∠Z2的值,如果3个值都在1以内继续,否则重复(2a)~(2g);
(2h)由位移=VoT+1/2*A*T^2令Vo为0,T=T1n-T1,将Rx、Ry、Rz代入,计算各轴的位移:Sx、Sy、Sz;
(2i)采集磁力计的当前值,计算校正各轴的角度得到角度∠x、∠y、∠z。
北斗/GPS协议解析模块负责解析北斗/GPS通信协议,获取当前定位载体的经纬度和高度信息,其实现过程如图4,即实现步骤(3),该步骤(3)中,包括如下细分步骤:
(3a)建立环形数据缓冲区;
(3b)将输入串口的数据存入环形数据缓冲区,同时移动保存数据位置指针,当保存数据位置指针移到环形数据缓冲区末尾时,令保存数据位置指针指向环形数据缓冲区头;
(3c)从环形数据缓冲区首位置读取数据,解析数据,同时移动读取数据位置指针,当读取数据位置指针移到环形数据缓冲区末尾时,令读取数据位置指针指向环形数据缓冲区头;
(3d)将解析出来的经纬度和高度信息保存到X、Y、Z。
计算校正输出模块将传感器采集计算模块输出的位移信息:Sx、Sy、Sz,角度信息:∠x、∠y、∠z,加速度信息:Rx、Ry、Rz和北斗/GPS协议解析模块输出的经纬度和高度信息:X、Y、Z,进行互为校正,最终计算输出定位载体的经纬度和高度信息,其实现过程如图5所示,即实现步骤(4),该步骤(4)中,包括如下细分步骤:
(4a)读取位移信息:Sx、Sy、Sz,角度信息:∠x、∠y、∠z,加速度信息:Rx、Ry、Rz,经纬度和高度信息:X、Y、Z分别存入缓冲区:FSx、FSy、FSz、F∠x、F∠y、F∠z、FRx、FRy、FRz、Fx、Fy、Fz;
(4b)读取位移信息:Sx、Sy、Sz,角度信息:∠x、∠y、∠z,加速度信息:Rx、Ry、Rz,经纬度和高度信息:X、Y、Z;
(4c)将Sx、Sy、∠x、∠y、Fx、Fy代入下式
Xn=Fx+Sx*cos(∠x);
Yn=Fy+Sy*sin(∠y);
(4d)根据Xn、Yn和高斯算法计算出新点的经纬度和高度:X2,Y2,Z2;
(4e)根据Sx、Sy、Sz、∠x、∠y、∠z、Rx、Ry、Rz、X、Y、Z与FSx、FSy、FSz、F∠x、F∠y、F∠z、FRx、FRy、FRz、Fx、Fy、Fz计算判断X、Y、Z的合法性;若合法根据X2、Y2、Z2、X、Y和Z计算后,按照输出串口协议和波特率输出定位载体的经纬度和高度信息;若不合法直接将X2、Y2和Z2按照输出串口协议和波特率输出定位载体的经纬度和高度信息。
综上所述,本发明的关键点是利用陀螺仪、加速度计和磁力计计算当前定位载体的方向,角速度和加速度信息,与北斗/GPS解析出来的经纬度和高度信息进行互为校正最终输出定位载体的经纬度和高度信息。
本发明应用于高精度导航定位的场合,体现了如下优点:
1)导航定位精度高,经实际定位测试误差小于1米;
2)本发明装置体积较小,便于安装,直接串联在串口线上即可;
3)支持多种卫星导航定位协议,如:NAEA-0183、NAEA-0180和NAEA-0182等;
4)通过设置输入串口波特率和协议拨码开关可以支持不同厂家的卫星导航定位设备;
5)通过设置输出串口波特率和协议拨码开关,可以和现有系统实现无缝对接,不需任何软件修改。
Claims (4)
1.一种高精度卫星定位的实现方法,其特征在于,包括以下步骤:
(1)、在定位载体上设置高精度定位装置;该高精度定位装置中包括处理器、输入串口、输入串口波特率拨码开关、输入串口协议拨码开关、输出串口、输出串口波特率拨码开关、输出串口协议拨码开关;所述输入串口、输入串口波特率拨码开关、输入串口协议拨码开关、输出串口、输出串口波特率拨码开关、输出串口协议拨码开关均与处理器电性连接;其特征在于:还包括陀螺仪、加速度计、磁力计,陀螺仪、加速度计、磁力计也与处理器电性连接;
(2)、采集陀螺仪、加速度计和磁力计的数据,采用陀螺仪和加速度计互为校正确立定位载体的各轴向的角度和加速度,最后结合磁力计计算各方向上的位移;
(3)、解析北斗/GPS通信协议,获取当前定位载体的经纬度和高度信息;
(4)、计算输出定位载体的经纬度和高度信息。
2.根据权利要求1所述高精度卫星定位的实现方法,其特征在于:步骤(2)中,包括如下细分步骤:
(2a)读取加速度传感器的当前值:AxADCn、AyADCn、AzADCn,读取时间:T1、T2、T3,最后一次读取时间:T1n、T2n、T3n;
(2b)读取陀螺仪传感器的当前值:∠xADCn、∠yADCn、∠zADCn;
(2c)重复步骤(2a)和(2b)100次并将其累计后,求其平均值分别为:AxADC、AyADC、AzADC和∠xADC、∠yADC、∠zADC;
(2d)分别将AxADC、AyADC、AzADC代入(ADC*Vref/1023-Vzg)/S计算得到Rx、Ry、Rz方向上的加速度;
上式中ADC为AxADC、AyADC、AzADC;
Vref为传感器的参考电压;
1023为2^传感器的分辨率位数-1计算得到,如当前传感器分辨率为10,固有2^10-1=1023;
Vzg为传感器的零加速度的电压值;
S为传感器的灵敏度;
(2e)由三维空间勾股定理通过Rx、Ry、Rz可以计算得到X、Y和Z轴的角度∠X1、∠Y1、∠Z1;
(2f)和步骤(2d)中的公式类似可以计算出陀螺仪传感器在X、Y和Z轴的角度∠X2、∠Y2、∠Z2;
(2g)计算比较∠X1/∠X2、∠Y1/∠Y2、∠Z1/∠Z2的值,如果3个值都在1以内继续,否则重复(2a)~(2g);
(2h)由位移=VoT+1/2*A*T^2令Vo为0,T=T1n-T1,将Rx、Ry、Rz代入,计算各轴的位移:Sx、Sy、Sz;
(2i)采集磁力计的当前值,计算校正各轴的角度得到角度∠x、∠y、∠z。
3.根据权利要求1所述高精度卫星定位的实现方法,其特征在于:步骤(3)中,包括如下细分步骤:
(3a)建立环形数据缓冲区;
(3b)将输入串口的数据存入环形数据缓冲区,同时移动保存数据位置指针,当保存数据位置指针移到环形数据缓冲区末尾时,令保存数据位置指针指向环形数据缓冲区头;
(3c)从环形数据缓冲区首位置读取数据,解析数据,同时移动读取数据位置指针,当读取数据位置指针移到环形数据缓冲区末尾时,令读取数据位置指针指向环形数据缓冲区头;
(3d)将解析出来的经纬度和高度信息保存到X、Y、Z。
4.根据权利要求1所述高精度卫星定位的实现方法,其特征在于:步骤(4)中,包括如下细分步骤:
(4a)读取位移信息:Sx、Sy、Sz,角度信息:∠x、∠y、∠z,加速度信息:Rx、Ry、Rz,经纬度和高度信息:X、Y、Z分别存入缓冲区:FSx、FSy、FSz、F∠x、F∠y、F∠z、FRx、FRy、FRz、Fx、Fy、Fz;
(4b)读取位移信息:Sx、Sy、Sz,角度信息:∠x、∠y、∠z,加速度信息:Rx、Ry、Rz,经纬度和高度信息:X、Y、Z;
(4c)将Sx、Sy、∠x、∠y、Fx、Fy代入下式
Xn=Fx+Sx*cos(∠x);
Yn=Fy+Sy*sin(∠y);
(4d)根据Xn、Yn和高斯算法计算出新点的经纬度和高度:X2,Y2,Z2;
(4e)根据Sx、Sy、Sz、∠x、∠y、∠z、Rx、Ry、Rz、X、Y、Z与FSx、FSy、FSz、F∠x、F∠y、F∠z、FRx、FRy、FRz、Fx、Fy、Fz计算判断X、Y、Z的合法性;若合法根据X2、Y2、Z2、X、Y和Z计算后,按照输出串口协议和波特率输出定位载体的经纬度和高度信息;若不合法直接将X2、Y2和Z2按照输出串口协议和波特率输出定位载体的经纬度和高度信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610711878.5A CN106405606A (zh) | 2016-08-23 | 2016-08-23 | 一种高精度卫星定位的实现方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610711878.5A CN106405606A (zh) | 2016-08-23 | 2016-08-23 | 一种高精度卫星定位的实现方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106405606A true CN106405606A (zh) | 2017-02-15 |
Family
ID=58005203
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610711878.5A Pending CN106405606A (zh) | 2016-08-23 | 2016-08-23 | 一种高精度卫星定位的实现方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106405606A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109525354A (zh) * | 2018-12-28 | 2019-03-26 | 山东山大电力技术股份有限公司 | 一种基于拨码开关控制的串口对时装置及其配置方法 |
CN111123330A (zh) * | 2019-12-31 | 2020-05-08 | 上海摩勤智能技术有限公司 | 一种定位方法及定位系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0679975A2 (en) * | 1989-12-11 | 1995-11-02 | Caterpillar Inc. | Integrated vehicle positioning and navigation system, apparatus and method |
JP2007064853A (ja) * | 2005-08-31 | 2007-03-15 | Hitachi Ltd | 複合測位による移動体の測位制御装置、システムおよびプログラム |
US20120062414A1 (en) * | 2010-09-15 | 2012-03-15 | Casio Computer Co., Ltd. | Positioning apparatus, positioning method, and storage medium for measuring position using both autonomous navigation and gps |
CN102589573A (zh) * | 2012-02-09 | 2012-07-18 | 黑龙江省博凯科技开发有限公司 | 微型组合导航系统中的传感器野外标定方法 |
CN105021183A (zh) * | 2015-07-05 | 2015-11-04 | 电子科技大学 | 多旋翼飞行器gps和ins低成本组合导航系统 |
-
2016
- 2016-08-23 CN CN201610711878.5A patent/CN106405606A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0679975A2 (en) * | 1989-12-11 | 1995-11-02 | Caterpillar Inc. | Integrated vehicle positioning and navigation system, apparatus and method |
JP2007064853A (ja) * | 2005-08-31 | 2007-03-15 | Hitachi Ltd | 複合測位による移動体の測位制御装置、システムおよびプログラム |
US20120062414A1 (en) * | 2010-09-15 | 2012-03-15 | Casio Computer Co., Ltd. | Positioning apparatus, positioning method, and storage medium for measuring position using both autonomous navigation and gps |
CN102589573A (zh) * | 2012-02-09 | 2012-07-18 | 黑龙江省博凯科技开发有限公司 | 微型组合导航系统中的传感器野外标定方法 |
CN105021183A (zh) * | 2015-07-05 | 2015-11-04 | 电子科技大学 | 多旋翼飞行器gps和ins低成本组合导航系统 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109525354A (zh) * | 2018-12-28 | 2019-03-26 | 山东山大电力技术股份有限公司 | 一种基于拨码开关控制的串口对时装置及其配置方法 |
CN111123330A (zh) * | 2019-12-31 | 2020-05-08 | 上海摩勤智能技术有限公司 | 一种定位方法及定位系统 |
CN111123330B (zh) * | 2019-12-31 | 2022-03-15 | 上海摩勤智能技术有限公司 | 一种定位方法及定位系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101586962B (zh) | 惯性导航系统地图回馈校正方法 | |
CN106556854B (zh) | 一种室内外导航系统及方法 | |
CN105607093B (zh) | 一种组合导航系统及获取导航坐标的方法 | |
CN101403620B (zh) | 导航装置及方法 | |
US20190033466A1 (en) | System for Land Vehicle Navigation and Corresponding Method | |
CN108225324B (zh) | 一种基于智能终端的地磁匹配与pdr融合的室内定位方法 | |
WO2012041109A1 (zh) | 一种具备gps导航功能的移动终端及该移动终端形成三维立体位置信息的方法 | |
CN204101033U (zh) | 一种基站天线下倾角动态测量系统 | |
CN104515519A (zh) | 加速度、陀螺仪和磁场九轴传感器的空间轨迹定位系统 | |
CN102590842B (zh) | 一种gnss/imu一体化天线 | |
CN108780157A (zh) | 利用动态校准和/或动态加权的汽车航位推测 | |
CN104215229A (zh) | Rtk设备调节方法、系统及rtk测量方法 | |
CN103743378A (zh) | 一种管道检测器姿态检测系统 | |
CN103697885A (zh) | 自动补偿磁偏角的远程定位方法 | |
CN107870341B (zh) | 一种基于两个标志点矢量信息的卫星自主定位方法 | |
CN202442699U (zh) | 一种抗磁干扰手持式姿态测量终端 | |
CN106405606A (zh) | 一种高精度卫星定位的实现方法 | |
JP5355443B2 (ja) | 位置補正システム | |
CN201170799Y (zh) | 具高度及方向校正的卫星定位系统接收装置 | |
CN205958758U (zh) | 一种车载全程亚米级定位系统 | |
CN104792321A (zh) | 一种基于辅助定位的土地信息采集系统及方法 | |
CN104215255A (zh) | 便携式终端机及其运作方法 | |
CN111624552B (zh) | 一种基于声波渡越时间测量的地下管道定位系统及方法 | |
CN108775899A (zh) | 基于伪卫星和惯性信息的深部开采井上下坐标系连接方法 | |
CN108061552A (zh) | 一种户外运动路径创建及重现的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170215 |
|
RJ01 | Rejection of invention patent application after publication |