CN107064970B - 一种gps定位滤波算法和汽车 - Google Patents
一种gps定位滤波算法和汽车 Download PDFInfo
- Publication number
- CN107064970B CN107064970B CN201710280553.0A CN201710280553A CN107064970B CN 107064970 B CN107064970 B CN 107064970B CN 201710280553 A CN201710280553 A CN 201710280553A CN 107064970 B CN107064970 B CN 107064970B
- Authority
- CN
- China
- Prior art keywords
- gps
- gps coordinates
- coordinates
- preset time
- coordinate
- 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
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/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/32—Multimode operation in a single same satellite system, e.g. GPS L1/L2
-
- 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/421—Determining position by combining or switching between position solutions or signals derived from different satellite radio beacon positioning systems; by combining or switching between position solutions or signals derived from different modes of operation in a single system
- G01S19/423—Determining position by combining or switching between position solutions or signals derived from different satellite radio beacon positioning systems; by combining or switching between position solutions or signals derived from different modes of operation in a single system by combining or switching between position solutions derived from different satellite radio beacon positioning systems
Abstract
本发明涉及一种GPS定位滤波算法,包括如下步骤:步骤S1:获取预设时间内的多组GPS坐标;步骤S2:计算移动设备在预设时间内移动的距离L1以及多组GPS坐标中的基准GPS坐标;步骤S3:依次计算基准GPS坐标与多组GPS坐标中最后一组坐标至第一组坐标之间的距离,将最先计算出小于L1/2的距离对应的GPS坐标作为有效GPS坐标,若多组GPS坐标与基准GPS坐标的距离均大于等于L1/2,则将基准GPS坐标作为有效GPS坐标。通过本方法可以有效的将GPS定位过程中的无效点或偏移点去除,为绘制移动设备的运动轨迹提供准确数据。
Description
技术领域
本发明涉及定位技术领域,具体是指一种GPS定位滤波算法。
背景技术
现有技术中,移动设备的运动轨迹基本是通过GPS来确定,而GPS在定位过程中会出现一些无效点或者是偏移点,由于这些无效点或者是偏移点的存在,在确认移动设备的运动轨迹时会出现偏差,而后期在对这个偏差进行修复后重新绘制的移动设备的运动轨迹往往与移动设备的真实运动轨迹有一定的偏差。如何去除GPS定位过程中出现的无效点或者偏移点、准确的绘制移动设备的运动轨迹是定位技术领域中迫切需要解决的问题。
发明内容
本发明所要解决的技术问题是提供一种能够准确定位、去除GPS定位过程中的无效点或偏移点的GPS定位滤波算法。
本发明解决上述技术问题的技术方案如下:一种GPS定位滤波算法,包括如下步骤:
步骤S1:获取预设时间内的多组GPS坐标;
步骤S2:计算移动设备在所述预设时间内移动的距离L1以及确定所述多组GPS坐标中的基准GPS坐标;
步骤S3:依次计算所述基准GPS坐标与所述多组GPS坐标中最后一组GPS坐标至第一组GPS坐标之间的距离,将最先计算出小于L1/2的所述距离对应的GPS坐标作为有效GPS坐标,若所述多组GPS坐标与所述基准GPS坐标的所述距离均大于等于L1/2,则将所述基准GPS坐标作为有效GPS坐标。
本发明的有益效果是:通过本方法可以有效的将GPS定位过程中的无效点或偏移点去除,为绘制移动设备的运动轨迹提供准确数据。
在上述技术方案的基础上,本发明还可以做如下改进。
进一步,所述多组GPS坐标为连续的GPS坐标。
进一步,每组所述GPS坐标至少包括经度和纬度。
进一步,分别将所述多组GPS坐标中的多个所述经度和多个所述纬度进行冒泡排序,由处于中间位置的一个所述经度和一个所述纬度组成所述基准GPS坐标。
进一步,所述步骤S2中计算所述移动设备在所述预设时间内移动的所述距离L1使用的计算公式为:
L1=V*T;
其中,V为所述预设时间内的所述多组GPS坐标中包括的多个速度的平均速度,T为所述预设时间。
本发明所要解决的技术问题是提供一种能够准确定位、去除GPS定位过程中的无效点或偏移点的汽车。
本发明解决上述技术问题的技术方案如下:一种汽车,所述汽车采用如上述任一技术方案所述的一种GPS定位滤波算法。
附图说明
图1为本发明一种GPS定位滤波算法的流程图。
具体实施方式
以下结合附图对本发明的原理和特征进行描述,所举实例只用于解释本发明,并非用于限定本发明的范围。
实施例一
如图1所示,一种GPS定位滤波算法,包括如下步骤:
步骤S1:获取预设时间内的多组GPS坐标。
具体的,GPS模块每秒向MCU传输一个GPS坐标。在实际应用中,以每十秒(一共十组GPS坐标)为一个预设时间,每秒向MCU输入一组GPS坐标,一共向MCU连续输入连续的十组GPS坐标。
每组GPS坐标均包括有:时间、经度、纬度、速度、高度、方向和卫星数量。
步骤S2:计算移动设备在预设时间内移动的距离L1以及多组GPS坐标中的基准GPS坐标。
具体的,距离L1使用的计算公式为:
L1=V*T;
其中:V为十秒内的十组GPS坐标中包括的十个速度的平均速度,T为预设时间(也就是十秒)。
十组GPS坐标中的基准GPS坐标的确定通过分别将十组GPS坐标中的十个经度和十个纬度分别进行冒泡排序,由处于中间位置的一个经度和一个纬度组成基准GPS坐标。
步骤S3:依次计算基准GPS坐标与多组GPS坐标中最后一组GPS坐标至第一组GPS坐标之间的距离,将最先计算出小于L1/2的距离对应的GPS坐标作为有效GPS坐标,若多组GPS坐标与基准GPS坐标的距离均大于等于L1/2,则将基准GPS坐标作为有效GPS坐标。
具体的,首先计算基准GPS坐标与十组GPS坐标中的最后一组GPS坐标之间的距离L2,比较L2与L1/2,若L2大于或等于L1/2则计算基准GPS坐标与倒数第二组GPS坐标之间的距离L2;依次类推,直至计算出的基准GPS坐标与十组GPS坐标的一组GPS坐标之间的距离小于L1/2为止,将此组GPS坐标作为有效GPS坐标;若计算出的基准GPS坐标与十组GPS坐标中的所有的GPS坐标之间的距离均大于等于L1/2,则将基准GPS坐标作为有效GPS坐标。
在本实施例中假定计算到第三组GPS坐标(也就是倒数第三组GPS坐标)即判断出L2小于L1/2,那么将倒数第三组GPS坐标作为有效GPS坐标。
在另一种可选的实施例中,依次计算基准GPS坐标与十组GPS坐标之间的距离L2;一共是十个L2,每个L2均不小于L1/2,因此将基准GPS坐标作为有效GPS坐标。
在确定移动设备的准确位置和移动轨迹时,均可以采用由上述方法得出的有效GPS坐标。
实施例二
一种汽车,所述汽车采用如上述实施例一所述的一种GPS定位滤波算法。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不必须针对的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任一个或多个实施例或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (4)
1.一种GPS定位滤波算法,其特征在于,包括如下步骤:
步骤S1:获取预设时间内的多组GPS坐标,其中每组所述GPS坐标至少包括经度和纬度;
步骤S2:计算移动设备在所述预设时间内移动的距离L1以及确定所述多组GPS坐标中的基准GPS坐标,其中分别将所述多组GPS坐标中的多个所述经度和多个所述纬度进行冒泡排序,由处于中间位置的一个所述经度和一个所述纬度组成所述基准GPS坐标;
步骤S3:依次计算所述基准GPS坐标与所述多组GPS坐标中最后一组GPS坐标至第一组GPS坐标之间的距离,将最先计算出小于L1/2的所述距离对应的GPS坐标作为有效GPS坐标,若所述多组GPS坐标与所述基准GPS坐标的所述距离均大于等于L1/2,则将所述基准GPS坐标作为有效GPS坐标。
2.根据权利要求1所述一种GPS定位滤波算法,其特征在于,所述多组GPS坐标为连续的GPS坐标。
3.根据权利要求1所述一种GPS定位滤波算法,其特征在于,所述步骤S2中计算所述移动设备在所述预设时间内移动的所述距离L1使用的计算公式为:
L1=V*T;
其中,V为所述预设时间内的所述多组GPS坐标中包括的多个速度的平均速度,T为所述预设时间。
4.一种汽车,其特征在于,所述汽车采用如权利要求1至3任一项所述的一种GPS定位滤波算法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710280553.0A CN107064970B (zh) | 2017-04-26 | 2017-04-26 | 一种gps定位滤波算法和汽车 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710280553.0A CN107064970B (zh) | 2017-04-26 | 2017-04-26 | 一种gps定位滤波算法和汽车 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107064970A CN107064970A (zh) | 2017-08-18 |
CN107064970B true CN107064970B (zh) | 2020-05-01 |
Family
ID=59604081
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710280553.0A Active CN107064970B (zh) | 2017-04-26 | 2017-04-26 | 一种gps定位滤波算法和汽车 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107064970B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004106802A (ja) * | 2002-09-20 | 2004-04-08 | Nippon Telegr & Teleph Corp <Ntt> | 盗難検出装置及び盗難監視装置 |
CN102455427A (zh) * | 2010-10-22 | 2012-05-16 | 南京莱斯信息技术股份有限公司 | 一种修正gps偏移的方法 |
CN102752825A (zh) * | 2012-07-19 | 2012-10-24 | 德明通讯(上海)有限公司 | 移动终端在LTE网络和Wi-Fi热点网络的无缝切换融合方法 |
CN103809195A (zh) * | 2014-02-13 | 2014-05-21 | 上海温光自动化技术有限公司 | 一种gps轨迹曲线的生成方法及装置 |
CN105607099A (zh) * | 2015-12-11 | 2016-05-25 | 上海卓易科技股份有限公司 | 一种gps定位坐标筛选方法及装置 |
-
2017
- 2017-04-26 CN CN201710280553.0A patent/CN107064970B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004106802A (ja) * | 2002-09-20 | 2004-04-08 | Nippon Telegr & Teleph Corp <Ntt> | 盗難検出装置及び盗難監視装置 |
CN102455427A (zh) * | 2010-10-22 | 2012-05-16 | 南京莱斯信息技术股份有限公司 | 一种修正gps偏移的方法 |
CN102752825A (zh) * | 2012-07-19 | 2012-10-24 | 德明通讯(上海)有限公司 | 移动终端在LTE网络和Wi-Fi热点网络的无缝切换融合方法 |
CN103809195A (zh) * | 2014-02-13 | 2014-05-21 | 上海温光自动化技术有限公司 | 一种gps轨迹曲线的生成方法及装置 |
CN105607099A (zh) * | 2015-12-11 | 2016-05-25 | 上海卓易科技股份有限公司 | 一种gps定位坐标筛选方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN107064970A (zh) | 2017-08-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106878951B (zh) | 用户轨迹分析方法及系统 | |
CN108776727B (zh) | 一种基于出租车轨迹数据的道路几何特征提取方法 | |
CN103809194B (zh) | 一种gps轨迹曲线的显示方法及装置 | |
CN106597496B (zh) | 位置修正方法及相关设备 | |
CN106558219B (zh) | 车辆轨迹预测方法及装置 | |
CN109297500B (zh) | 基于车道线特征匹配的高精度定位装置及方法 | |
CN106056971A (zh) | 用于识别周围车辆的设备和方法 | |
CN107421545B (zh) | 一种机器人的位置偏差检测方法、装置及机器人 | |
CN104197934A (zh) | 一种基于地磁的定位方法、装置及系统 | |
DE102017125965A1 (de) | Fahrzeugstandortbestimmung auf grundlage von wlan-knoten | |
CN105607099A (zh) | 一种gps定位坐标筛选方法及装置 | |
CN104949673A (zh) | 一种基于非视觉感知信息的目标定位方法及装置 | |
CN103047982A (zh) | 基于角度信息的目标自适应跟踪方法 | |
CN109031372A (zh) | 一种从卫星定位数据中自动提取行驶线路关键点的方法 | |
CN106842258B (zh) | 一种gps定位系统和汽车 | |
CN102997927A (zh) | 信息采集和处理方法及装置 | |
CN107064970B (zh) | 一种gps定位滤波算法和汽车 | |
CN104715050B (zh) | 路线推荐方法及系统 | |
CN108519096B (zh) | 一种基于瓦片化的多路线道路筛选规划方法及系统 | |
WO2021251900A1 (en) | Method for real-time position estimate correction of a movable object | |
CN108900978B (zh) | 一种基于移动终端信令数据的城市主干道路连接方法 | |
CN111679297A (zh) | 一种gps定位轨迹的噪声点漂移去除方法 | |
CN105930917A (zh) | 一种在电子地图上生成公交线路的方法及系统 | |
CN106932789B (zh) | 一种移动设备移动状态的判断方法和汽车 | |
CN114999162A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |