CN110133697B - 一种基于rsu检测技术的gps高精定位方法 - Google Patents
一种基于rsu检测技术的gps高精定位方法 Download PDFInfo
- Publication number
- CN110133697B CN110133697B CN201910368943.2A CN201910368943A CN110133697B CN 110133697 B CN110133697 B CN 110133697B CN 201910368943 A CN201910368943 A CN 201910368943A CN 110133697 B CN110133697 B CN 110133697B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- coordinate system
- road side
- gps positioning
- side unit
- 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/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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明涉及定位技术领域,具体公开了一种基于RSU检测技术的GPS高精定位方法,路侧单元RSU将自身测得的与车辆的第二车距,与车载单元OBU根据自身的GPS定位信息和路侧单元的GPS定位信息计算得到的第一车距进行对比,在比对不一致时,基于OBU上传的GPS定位信息中的航向角和车身状态信息中的车速对该GPS定位信息的经纬坐标进行修正,并将修正后的GPS定位信息发回OBU,可有效提高OBU的定位精度,同时依赖OBU上传的定位信息的RSU的预警准确率也得到显著提高。
Description
技术领域
本发明涉及定位技术领域,尤其涉及一种基于RSU检测技术的GPS高精定位方法。
背景技术
在V2X(VehicleToEverything,意为车对外界信息的交换)的车路协同应用场景中,路侧单元(Road Side Unit,RSU)需要与车载单元(On Board Unit,OBU)进行实时信息交互。RSU是智能交通的重要设备,也是车路协同应用场景的关键设备之一,它安装在路侧,工作形式如红绿灯等路基设备。在车路协同的应用场景中,RSU主要负责接收车辆的位置和车身状态信息,通过相关数据的计算,对车辆的运动轨迹进行判断,并发送预警信息到OBU。常见的应用场景有闯红灯报警,绿波车速引导等。
但目前在RSU与OBU协同进行车辆定位的手段仍存在技术缺陷:
1)车辆自身的GPS定位精度普遍不高,一般是5~10米,OBU上传给RSU的定位信息与真实位置偏差较大;
2)在RSU的传感器***中,机器视觉只能识别车辆,雷达***只能测距,检测***缺乏对车辆GPS定位信息判断方法,依赖OBU上传的定位信息,导致RSU在进行应用场景计算的时候出现误报或预警不及时的现象,RSU预警准确率较低,影响了车路协同技术的普及和应用。
发明内容
本发明提供一种基于RSU检测技术的GPS高精定位方法,解决的技术问题是,在V2X的车路协同应用场景中,现有OBU的GPS定位精度较低,依赖OBU上传的定位信息的RSU的预警准确率较低。
为解决以上技术问题,本发明提供一种基于RSU检测技术的GPS高精定位方法,包括步骤:
S1.车载单元根据路侧单元的GPS定位信息计算车辆与所述路侧单元之间的第一车距,并反馈到所述路侧单元;
S2.所述路侧单元判断所述第一车距与测得的自身与车辆之间的第二车距是否一致,若是则返回到所述步骤S1,若否则对所述车载单元的GPS定位信息进行修正。
进一步地,在所述步骤S1前还包括步骤:
S01.所述车载单元定期将自身检测的GPS定位信息和车身状态信息发送到所述路侧单元;
S02.所述路侧单元将自身检测的GPS定位信息发送到所述车载单元。
进一步地,所述步骤S2具体包括步骤:
S21.所述路侧单元接收所述车载单元发送而至的所述GPS定位信息、所述车身状态信息和所述第一车距;
S22.所述路侧单元判断所述车载单元对应的车辆是否在对应的车道上,若是则进行下一步,若否则返回至上一步;
S23.所述路侧单元检测自身与所述车辆之间的所述第二车距是否与所述第一车距一致,若否则进行下一步,如是则返回至所述步骤S01;
S24.根据所述车载单元上传的所述GPS定位信息和所述车身状态信息对所述车载单元的GPS定位信息进行修正。
进一步地,所述步骤S23具体包括步骤:
S23-1.提取所述车载单元的GPS定位信息中的航向角和所述车身状态信息中的车速;
S23-2.将所述车载单元的GPS定位信息中的大地经纬度数据参考椭圆为基准投影在高斯平面坐标系上;
S23-3.根据所述航向角将高斯平面坐标系进行平移,使得平移后的高斯平面坐标系的原点与自定义局部坐标系的原点重合;
S23-4.根据所述车速计算所述自定义局部坐标系的位置;
S23-5.将所述自定义局部坐标系的位置换算回大地经纬数据,得到纠正后大地经纬数据;
S23-6.将所述纠正后大地经纬数据发送到所述车载单元。
进一步地,所述步骤S23-2的运算过程为:
假设大地经纬度数据的经度、纬度表示为L、B,将经纬坐标(L,B)转换为高斯平面坐标(x,y)的公式为:
L0=6n-3 (4);
其中,X为赤道至纬度的平行圈的子午线弧长,N为卯酉圈曲率半径,l为投影点经度L与该点所处经度带轴子午线经度L0之差;t=tan B,μ=e′cos B;e=0.08181919为第一偏心率,e′=0.082094438为第二偏心率;n=round[(L+3)/6],即四舍五入取整数;η=0.0033528,为WGS-84椭球扁率。
进一步地,在所述步骤S23-2中,将所述高斯平面坐标系换算为所述自定义局部平面坐标系的转换公式为:
进一步地,在所述步骤S23-4中,所述自定义局部坐标系的位置(x″,y″)的运算过程为:
其中,v′是所述车身状态信息中的车速,t为2倍V2X消息传输时间。
进一步地,所述S23-5具体包括步骤:
S23-51.将所述自定义局部坐标系的位置换算回高斯平面坐标;
S23-52.将所述高斯平面坐标换算回大地经纬数据。
进一步地,在所述S23-51中,将所述自定义局部坐标系的位置(x″,y″)换算回高斯平面坐标(x,y)的转换公式为:
进一步地,在所述步骤S23-52中,基于所述公式(1)~(4)将所述高斯平面坐标(x,y)换算回大地经纬数据(L,B)。
本发明提供的一种基于RSU检测技术的GPS高精定位方法,路侧单元RSU将自身测得的与车辆的第二车距,与车载单元OBU根据自身的GPS定位信息和路侧单元的GPS定位信息计算得到的第一车距进行对比,在比对不一致时,基于OBU上传的GPS定位信息中的航向角和车身状态信息中的车速对该GPS定位信息的经纬坐标进行修正,并将修正后的GPS定位信息发回OBU,可有效提高OBU的定位精度,同时依赖OBU上传的定位信息的RSU的预警准确率也得到显著提高。
附图说明
图1是本发明实施例提供的一种基于RSU检测技术的GPS高精定位方法的步骤流程图;
图2是本发明实施例提供的一种基于RSU检测技术的GPS高精定位方法接入电路的工作流程图。
具体实施方式
下面结合附图具体阐明本发明的实施方式,实施例的给出仅仅是为了说明目的,并不能理解为对本发明的限定,包括附图仅供参考和说明使用,不构成对本发明专利保护范围的限制,因为在不脱离本发明精神和范围基础上,可以对本发明进行许多改变。
本发明实施例提供的一种基于RSU检测技术的GPS高精定位方法,如图1所示的步骤流程图,包括步骤:
S1.车载单元OBU根据路侧单元RSU的GPS定位信息计算车辆与所述路侧单元RSU之间的第一车距,并反馈到所述路侧单元RSU;
S2.所述路侧单元RSU判断所述第一车距与测得的自身与车辆之间的第二车距是否一致,若是则返回到所述步骤S1,若否则对所述车载单元OBU的GPS定位信息进行修正。
在本实施例中,在所述步骤S1前还包括步骤:
S01.所述车载单元OBU定期将自身检测的GPS定位信息和车身状态信息(包括车辆行驶方向和车速等)发送到所述路侧单元RSU;
S02.所述路侧单元RSU将自身检测的GPS定位信息发送到所述车载单元OBU。
在本实施例中,所述步骤S2具体包括步骤:
S21.所述路侧单元RSU接收所述车载单元OBU发送而至的所述GPS定位信息、所述车身状态信息和所述第一车距;
S22.所述路侧单元RSU判断所述车载单元OBU对应的车辆是否在对应的车道上(可使用视觉***),若是则进行下一步,若否则返回至上一步;
S23.所述路侧单元RSU检测自身与所述车辆之间的所述第二车距(可使用毫米波雷达测得)是否与所述第一车距一致,若否则进行下一步,如是则返回至所述步骤S01;
S24.根据所述车载单元OBU上传的所述GPS定位信息和所述车身状态信息对所述车载单元OBU的GPS定位信息进行修正。
参见图2所示的工作流程图,可对应于上述步骤。
更详细地,所述步骤S23具体包括步骤:
S23-1.提取所述车载单元OBU的GPS定位信息中的航向角和所述车身状态信息中的车速;
S23-2.将所述车载单元OBU的GPS定位信息中的大地经纬度数据参考椭圆为基准投影在高斯平面坐标系上;
S23-3.根据所述航向角将高斯平面坐标系进行平移,使得平移后的高斯平面坐标系的原点与自定义局部坐标系的原点重合;
S23-4.根据所述车速计算所述自定义局部坐标系的位置;
S23-5.将所述自定义局部坐标系的位置换算回大地经纬数据,得到纠正后大地经纬数据;
S23-6.将所述纠正后大地经纬数据发送到所述车载单元OBU。
进一步地,所述步骤S23-2的运算过程为:
假设大地经纬度数据的经度、纬度表示为L、B,将经纬坐标(L,B)转换为高斯平面坐标(x,y)的公式为:
L0=6n-3 (4);
其中,X为赤道至纬度的平行圈的子午线弧长,N为卯酉圈曲率半径,l为投影点经度L与该点所处经度带轴子午线经度L0之差;t=tan B,μ=e′cos B;e=0.08181919为第一偏心率,e′=0.082094438为第二偏心率;n=round[(L+3)/6],即四舍五入取整数;η=0.0033528,为WGS-84椭球扁率。
进一步地,在所述步骤S23-2中,将所述高斯平面坐标系换算为所述自定义局部平面坐标系的转换公式为:
进一步地,在所述步骤S23-4中,所述自定义局部坐标系的位置(x″,y″)的运算过程为:
其中,v′是所述车身状态信息中的车速,t为2倍V2X消息传输时间,RSU接收到OBU发送的车辆当前的GPS经纬度、车速和航向角后进行车辆位置估算,RSU把估算后的GPS定位信息发送给OBU,因此该时间和大小通常为消息传输时间的2倍。
进一步地,所述S23-5具体包括步骤:
S23-51.将所述自定义局部坐标系的位置换算回高斯平面坐标;
S23-52.将所述高斯平面坐标换算回大地经纬数据。
进一步地,在所述S23-51中,将所述自定义局部坐标系的位置(x″,y″)换算回高斯平面坐标(x,y)的转换公式为:
进一步地,在所述步骤S23-52中,基于所述公式(1)~(4)将所述高斯平面坐标(x,y)换算回大地经纬数据(L,B)。
本发明实施例提供的一种基于RSU检测技术的GPS高精定位方法,路侧单元RSU将自身测得的与车辆的第二车距,与车载单元OBU根据自身的GPS定位信息与路侧单元RSU的GPS定位信息计算得到的第一车距进行对比,在比对不一致时(比如相差超过预设的阈值1m时,阈值可根据实际情况设定),基于OBU上传的GPS定位信息中的车速和航向角对该GPS定位信息的经纬坐标进行修正,并将修正后的GPS定位信息发回OBU,可有效提高OBU的定位精度,同时依赖OBU上传的定位信息的RSU的预警准确率也得到显著提高。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
Claims (8)
1.一种基于RSU检测技术的GPS高精定位方法,其特征在于,包括步骤:
S1.车载单元根据路侧单元的GPS定位信息计算车辆与所述路侧单元之间的第一车距,并反馈到所述路侧单元;
S2.所述路侧单元判断所述第一车距与测得的自身与车辆之间的第二车距是否一致,若是则返回到所述步骤S1,若否则对所述车载单元的GPS定位信息进行修正;
在所述步骤S1前还包括步骤:
S01.所述车载单元定期将自身检测的GPS定位信息和车身状态信息发送到所述路侧单元;
S02.所述路侧单元将自身检测的GPS定位信息发送到所述车载单元;
所述步骤S2具体包括步骤:
S21.所述路侧单元接收所述车载单元发送而至的所述GPS定位信息、所述车身状态信息和所述第一车距;
S22.所述路侧单元判断所述车载单元对应的车辆是否在对应的车道上,若是则进行下一步,若否则返回至上一步;
S23.所述路侧单元检测自身与所述车辆之间的所述第二车距是否与所述第一车距一致,若否则进行下一步,如是则返回至所述步骤S01;
S24.根据所述车载单元上传的所述GPS定位信息和所述车身状态信息对所述车载单元的GPS定位信息进行修正。
2.如权利要求1所述的一种基于RSU检测技术的GPS高精定位方法,其特征在于,所述步骤S23具体包括步骤:
S23-1.提取所述车载单元的GPS定位信息中的航向角和所述车身状态信息中的车速;
S23-2.将所述车载单元的GPS定位信息中的大地经纬度数据参考椭圆为基准投影在高斯平面坐标系上;
S23-3.根据所述航向角将高斯平面坐标系进行平移,使得平移后的高斯平面坐标系的原点与自定义局部坐标系的原点重合;
S23-4.根据所述车速计算所述自定义局部坐标系的位置;
S23-5.将所述自定义局部坐标系的位置换算回大地经纬数据,得到纠正后大地经纬数据;
S23-6.将所述纠正后大地经纬数据发送到所述车载单元。
6.如权利要求5所述的一种基于RSU检测技术的GPS高精定位方法,其特征在于,所述S23-5具体包括步骤:
S23-51.将所述自定义局部坐标系的位置换算回高斯平面坐标;
S23-52.将所述高斯平面坐标换算回大地经纬数据。
8.如权利要求7所述的一种基于RSU检测技术的GPS高精定位方法,其特征在于:在所述步骤S23-52中,基于所述公式(1)~(4)将所述高斯平面坐标(x,y)换算回大地经纬数据(L,B)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910368943.2A CN110133697B (zh) | 2019-05-05 | 2019-05-05 | 一种基于rsu检测技术的gps高精定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910368943.2A CN110133697B (zh) | 2019-05-05 | 2019-05-05 | 一种基于rsu检测技术的gps高精定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110133697A CN110133697A (zh) | 2019-08-16 |
CN110133697B true CN110133697B (zh) | 2021-05-14 |
Family
ID=67576190
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910368943.2A Active CN110133697B (zh) | 2019-05-05 | 2019-05-05 | 一种基于rsu检测技术的gps高精定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110133697B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110906939A (zh) * | 2019-11-28 | 2020-03-24 | 安徽江淮汽车集团股份有限公司 | 自动驾驶定位方法、装置、电子设备、存储介质及汽车 |
CN111770451B (zh) * | 2020-05-26 | 2022-02-18 | 同济大学 | 一种基于车路协同的道路车辆定位及感知方法和装置 |
CN111832774B (zh) * | 2020-06-02 | 2024-04-12 | 深圳市金溢科技股份有限公司 | 网约车的轨迹追踪方法、云平台和网约车obu |
US11558716B2 (en) * | 2020-08-21 | 2023-01-17 | Hyundai Motor Company | Device and method for positioning personal mobility vehicle |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105807295B (zh) * | 2014-12-30 | 2018-07-20 | 北京握奇智能科技有限公司 | 一种校正车辆位置偏差的方法和*** |
CN204360576U (zh) * | 2014-12-30 | 2015-05-27 | 北京握奇智能科技有限公司 | 一种用于校正车辆位置偏差的路侧单元 |
CN105974453A (zh) * | 2015-11-05 | 2016-09-28 | 乐卡汽车智能科技(北京)有限公司 | 基于智能车路协同***的差分定位方法及智能车路协同*** |
CN106056972A (zh) * | 2016-06-29 | 2016-10-26 | 江苏科技大学 | 一种基于车辆行驶速度和位置信息融合的安全防撞预警方法 |
CN107767679B (zh) * | 2016-08-17 | 2021-04-02 | 上海交通大学 | 基于专用短程通信的信号灯路口车速引导装置及方法 |
CN106405601A (zh) * | 2016-10-21 | 2017-02-15 | 北京汽车集团有限公司 | 车辆定位方法、装置和车辆 |
-
2019
- 2019-05-05 CN CN201910368943.2A patent/CN110133697B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110133697A (zh) | 2019-08-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110133697B (zh) | 一种基于rsu检测技术的gps高精定位方法 | |
CN106297342B (zh) | 一种提前、实时提示交通信号灯信息的提醒装置及方法 | |
CN109747659B (zh) | 车辆驾驶的控制方法和装置 | |
CN106767853B (zh) | 一种基于多信息融合的无人驾驶车辆高精度定位方法 | |
CN107430819B (zh) | 车辆信息处理装置及车辆信息处理方法 | |
CN111200796A (zh) | 用于评估车辆的环境感测***的操作的***及方法 | |
US10369995B2 (en) | Information processing device, information processing method, control device for vehicle, and control method for vehicle | |
CN105319565B (zh) | 车载gps设备过滤定位漂移数据的方法和装置 | |
US20220373353A1 (en) | Map Updating Method and Apparatus, and Device | |
CN112995899B (zh) | 车路协同定位方法、装置、车载定位***及路侧设备 | |
US20160055745A1 (en) | Method and Device for Communication Between Road Users and/or Pedestrians and a Traffic Infrastructure on the Basis of an Ad-Hoc Wireless Motor Vehicle Communications System for Traffic Control | |
CN206147953U (zh) | 一种提前、实时提示交通信号灯信息的提醒装置 | |
CN102542830B (zh) | 对电子眼信息进行提示的方法及车载终端 | |
CN109050530B (zh) | 一种巡航加速控制***及方法 | |
CN105810012A (zh) | 一种基于车载终端的车辆碰撞预警的方法及装置 | |
WO2023273512A1 (zh) | 预警方法、电子设备和计算机可读存储介质 | |
US11002553B2 (en) | Method and device for executing at least one measure for increasing the safety of a vehicle | |
KR102528421B1 (ko) | 차량용 통신 단말 및 이를 이용한 차량 측위 방법 | |
CN109474910B (zh) | 一种基于实体航标位置的注册虚拟航标方法 | |
CN116434604A (zh) | 一种智能交通锥桶安全警示***及控制方法 | |
CN114152256A (zh) | 用于第一车辆并且用于在第一车辆处估计第二车辆的方位的装置、方法和计算机程序、车辆 | |
CN113179303A (zh) | 用于上报交通事件的方法、设备和程序载体 | |
CN208422117U (zh) | 一种基于车联网络的闯红灯预警*** | |
CN116416588A (zh) | 车道线预测方法、装置、电子设备及存储介质 | |
US20210348944A1 (en) | Vehicle, apparatus, method, and computer program for determining a merged environmental map |
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 |