CN109443370A - 一种检测轨迹偏离的方法 - Google Patents

一种检测轨迹偏离的方法 Download PDF

Info

Publication number
CN109443370A
CN109443370A CN201811067073.7A CN201811067073A CN109443370A CN 109443370 A CN109443370 A CN 109443370A CN 201811067073 A CN201811067073 A CN 201811067073A CN 109443370 A CN109443370 A CN 109443370A
Authority
CN
China
Prior art keywords
point
track
route
setting
threshold value
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
Application number
CN201811067073.7A
Other languages
English (en)
Inventor
王祥
刘佳宁
张利岩
孙重阳
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Tong National Pulse Technology Nanjing Co Ltd
Original Assignee
China Tong National Pulse Technology Nanjing Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China Tong National Pulse Technology Nanjing Co Ltd filed Critical China Tong National Pulse Technology Nanjing Co Ltd
Priority to CN201811067073.7A priority Critical patent/CN109443370A/zh
Publication of CN109443370A publication Critical patent/CN109443370A/zh
Pending legal-status Critical Current

Links

Classifications

    • 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/34—Route searching; Route guidance
    • G01C21/3407—Route searching; Route guidance specially adapted for specific applications
    • G01C21/3415—Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

本发明涉及一种检测轨迹偏离的方法，现有网约车在行驶过程中是否按照规划路线的判断通过GPS定位无法做出正确的判断。为了解决以上问题，一种检测轨迹偏离的方法，包括以下步骤：第一步：实时选取相邻的坐标点A点和B点，和A点和B点直线设为线路L，第二步：计算车辆的实时位置P到线路L的每个线段的最近距离集合，找出集合中的最小值；第三步：将最小值和设定的阈值比较，如果大于设定的阈值，则判定偏离轨迹，如果小于设定的阈值，则判定没有偏离轨迹。本发明提供的检测轨迹偏离的方法能够准确的判断网约车的行驶是否偏离了规划路线。

Description

一种检测轨迹偏离的方法
技术领域
本发明属于网约车是否按导航轨迹行驶，涉及一种检测轨迹偏离的方法。
背景技术
乘客在打车的时候，手机地图会给出最佳路线，但是在实际行驶中，司机有意或无意的没有按设定好的路线行驶，这时候需要提醒司机和乘客偏移了规划路线。一般对于是否偏离规划路线是通过车辆的GPS定位，看定位是否在规划的路线上，但是，GPS导航定位包括下列六种误差:.星历误差—予报的卫星位置的误差；.星钟差—予报的卫星钟差,包括SA；电离层误差—由于电离层效应引起的观测值的误差；对流层误差—由于对流层效应引起的观测值的误差；多径误差—由于反射信号进入接收机天线引起的观测值的误差；接收机误差—由于热噪声、软件和各通道之间的偏差引起的观测值误差。定位距离误差至少有15米。但有时由于信号的强弱变化，这个数可能达20－30米了。另外，如果GPS接收设备太灵敏，会出现漂移，这种漂移就会更大了，有时会到百米以上。所以行驶车辆定位是否在规划路径上，这种方式，只能作为参考，也无法确定是否偏离轨迹。
发明内容
1、所要解决的技术问题：
现有网约车在行驶过程中是否按照规划路线的判断通过GPS定位无法做出正确的判断。
2、技术方案：
为了解决以上问题，一种检测轨迹偏离的方法，包括以下步骤：第一步：实时选取相邻的坐标点A点和B点，和A点和B点直线设为线路L，第二步：计算车辆的实时位置P到线路L的每个线段的最近距离集合，找出集合中的最小值；第三步：将最小值和设定的阈值比较，如果大于设定的阈值，则判定偏离轨迹，如果小于设定的阈值，则判定没有偏离轨迹。计算当前坐标点距离其中一个线段的最短距离的计算方法为：当前点P到AB线上的垂线(1)若在AB线段上，则是当前点到AB线段的最短距离，(2)若在AB线段外，在分别计算P点到A，B点的距离取最小为最短距离；设 其中x为经度坐标，y为纬度坐标，AB斜率：斜率： AB直线：直线：解出计算出每条线段的最短距离，找出最短的距离点。
3、有益效果：
本发明提供的检测轨迹偏离的方法能够准确的判断网约车的行驶是否偏离了规划路线。
附图说明
图1为本发明的原理图。
具体实施方式
下面结合附图和实施例来对本发明进行详细说明。
一种检测轨迹偏离的方法，包括以下步骤：第一步：实时选取相邻的坐标点A点和B点，和A点和B点直线设为线路L，第二步：计算车辆的实时位置P到线路L的每个线段的最近距离集合，找出集合中的最小值；第三步：将最小值和设定的阈值比较，如果大于设定的阈值，则判定偏离轨迹，如果小于设定的阈值，则判定没有偏离轨迹。实时检测司机当前坐标点距离这条规划的路线的最短距离，在一定的阈值内，就可以认为司机按规划的路线在行驶，所以给出的解决方案是：路线是坐标点的集合，相邻的二个点的线段的集合，就能绘制出行驶路线，所以只要计算出当前点距离这条行驶路线的每个线段的最短距离集合，找出集合中最小值，再和设定的阈值比较，就能判断结果。
实施例1
设定阈值为20米
打车时给导航会给出设定好的路线，可以得到路线的坐标点集合，在行驶过程中，每隔几秒，计算出当前司机距离该条路线的最短距离点，如果最短距离点大于20米，就可以认为司机没有按规划路线行驶。
实施例2
设定阈值为30米。
打车时给导航会给出设定好的路线，可以得到路线的坐标点集合，在行驶过程中，每隔几秒，计算出当前司机距离该条路线的最短距离点，如图1所示，当连续的P1和P2点的最短距离点大于30米，就可以认为司机没有按规划路线行驶，如果P1点的最短距离大于30米，P2点的最短距离点小于30米，认为司机按规划路线行驶。
虽然本发明已以较佳实施例公开如上，但它们并不是用来限定本发明的，任何熟习此技艺者，在不脱离本发明之精神和范围内，自当可作各种变化或润饰，因此本发明的保护范围应当以本申请的权利要求保护范围所界定的为准。

Claims (3)

1.一种检测轨迹偏离的方法，包括以下步骤：第一步：实时选取相邻的坐标点A点和B点，和A点和B点直线设为线路L，第二步：计算车辆的实时位置P到线路L的每个线段的最近距离集合，找出集合中的最小值；第三步：将最小值和设定的阈值比较，如果大于设定的阈值，则判定偏离轨迹，如果小于设定的阈值，则判定没有偏离轨迹。
2.如权利要求1所述的方法，其特征在于：计算当前坐标点距离其中一个线段的最短距离的计算方法为：当前点P到AB线上的垂线(1)若在AB线段上，则是当前点到AB线段的最短距离，(2)若在AB线段外，在分别计算P点到A，B点的距离取最小为最短距离；设其中x为经度坐标，y为纬度坐标，AB斜率： 斜率：AB直线： 直线：解出计算出每条线段的最短距离，找出最短的距离点。
3.如权利要求1或2所述的方法，其特征在于：所述的阈值为20-30米。
CN201811067073.7A 2018-09-13 2018-09-13 一种检测轨迹偏离的方法 Pending CN109443370A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811067073.7A CN109443370A (zh) 2018-09-13 2018-09-13 一种检测轨迹偏离的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811067073.7A CN109443370A (zh) 2018-09-13 2018-09-13 一种检测轨迹偏离的方法

Publications (1)

Publication Number Publication Date
CN109443370A true CN109443370A (zh) 2019-03-08

Family

ID=65530370

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811067073.7A Pending CN109443370A (zh) 2018-09-13 2018-09-13 一种检测轨迹偏离的方法

Country Status (1)

Country Link
CN (1) CN109443370A (zh)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110986980A (zh) * 2019-11-28 2020-04-10 北京百度网讯科技有限公司 一种规划路线检测方法、装置和电子设备
CN111027653A (zh) * 2019-12-05 2020-04-17 上海凯京信达科技集团有限公司 电子封签控制***、方法、计算机存储介质及电子设备
CN111829525A (zh) * 2020-07-22 2020-10-27 深圳市微能信息科技有限公司 Uwb室内外一体智能导航定位方法和***
CN112240770A (zh) * 2020-10-15 2021-01-19 浙江欣奕华智能科技有限公司 一种生成机器人运动轨迹的方法、装置及终端
CN112632450A (zh) * 2020-12-30 2021-04-09 中国电子科技集团公司电子科学研究院 一种广域空间异常轨迹识别方法、装置及可读存储介质
CN112785062A (zh) * 2021-01-26 2021-05-11 余嘉娴 一种基于大数据的物流运输路径规划***
CN112817259A (zh) * 2019-10-29 2021-05-18 鸿富锦精密工业（深圳）有限公司 用于无人物流车的控制方法、监控设备及运输***
CN113670325A (zh) * 2021-08-20 2021-11-19 联通智网睿行科技(北京)有限公司 路径偏离检测方法、***以及电子设备
CN113902210A (zh) * 2021-10-22 2022-01-07 南京领行科技股份有限公司 一种网约车偏航检测方法、装置、电子设备及存储介质
CN114550402A (zh) * 2022-03-02 2022-05-27 福建至简至一信息科技有限公司 规划路线内物流运输中偷换货品行为告警方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015057782A1 (en) * 2013-10-16 2015-04-23 Mapquest, Inc. Systems and methods for initiating mapping exit routines and rating highway exits
CN105137412A (zh) * 2015-08-19 2015-12-09 重庆大学 一种2d激光雷达距离图像中线段特征精确拟合方法
CN106094812A (zh) * 2015-04-27 2016-11-09 通用汽车环球科技运作有限责任公司 用于自主驾驶的反应式路径规划
CN106403979A (zh) * 2016-10-11 2017-02-15 浙江大仓信息科技股份有限公司 一种车辆导航位置偏移判定方法
CN108037519A (zh) * 2018-01-03 2018-05-15 中煤航测遥感集团有限公司 线路偏移预警方法和装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015057782A1 (en) * 2013-10-16 2015-04-23 Mapquest, Inc. Systems and methods for initiating mapping exit routines and rating highway exits
CN106094812A (zh) * 2015-04-27 2016-11-09 通用汽车环球科技运作有限责任公司 用于自主驾驶的反应式路径规划
CN105137412A (zh) * 2015-08-19 2015-12-09 重庆大学 一种2d激光雷达距离图像中线段特征精确拟合方法
CN106403979A (zh) * 2016-10-11 2017-02-15 浙江大仓信息科技股份有限公司 一种车辆导航位置偏移判定方法
CN108037519A (zh) * 2018-01-03 2018-05-15 中煤航测遥感集团有限公司 线路偏移预警方法和装置

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
邵峰等: "《21世纪技师学院通用教材——数学》", 31 August 2016, 山东科学技术出版社 *
项昭义等: "《中学金牌奥赛经典题一题多解》", 31 March 2004, 京华出版社 *

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112817259A (zh) * 2019-10-29 2021-05-18 鸿富锦精密工业（深圳）有限公司 用于无人物流车的控制方法、监控设备及运输***
CN112817259B (zh) * 2019-10-29 2024-01-12 鸿富锦精密工业（深圳）有限公司 用于无人物流车的控制方法、监控设备及运输***
CN110986980A (zh) * 2019-11-28 2020-04-10 北京百度网讯科技有限公司 一种规划路线检测方法、装置和电子设备
CN111027653A (zh) * 2019-12-05 2020-04-17 上海凯京信达科技集团有限公司 电子封签控制***、方法、计算机存储介质及电子设备
CN111027653B (zh) * 2019-12-05 2023-12-19 上海斑马来拉物流科技有限公司 电子封签控制***、方法、计算机存储介质及电子设备
CN111829525A (zh) * 2020-07-22 2020-10-27 深圳市微能信息科技有限公司 Uwb室内外一体智能导航定位方法和***
CN112240770A (zh) * 2020-10-15 2021-01-19 浙江欣奕华智能科技有限公司 一种生成机器人运动轨迹的方法、装置及终端
CN112632450A (zh) * 2020-12-30 2021-04-09 中国电子科技集团公司电子科学研究院 一种广域空间异常轨迹识别方法、装置及可读存储介质
CN112785062B (zh) * 2021-01-26 2023-12-05 源发科技(唐山市海港区)有限责任公司 一种基于大数据的物流运输路径规划***
CN112785062A (zh) * 2021-01-26 2021-05-11 余嘉娴 一种基于大数据的物流运输路径规划***
CN113670325A (zh) * 2021-08-20 2021-11-19 联通智网睿行科技(北京)有限公司 路径偏离检测方法、***以及电子设备
CN113902210A (zh) * 2021-10-22 2022-01-07 南京领行科技股份有限公司 一种网约车偏航检测方法、装置、电子设备及存储介质
CN114550402A (zh) * 2022-03-02 2022-05-27 福建至简至一信息科技有限公司 规划路线内物流运输中偷换货品行为告警方法

Similar Documents

Publication Publication Date Title
CN109443370A (zh) 一种检测轨迹偏离的方法
CN109416256B (zh) 行驶车道推定***
CN105021201B (zh) 利用交通标示牌的坐标反推汽车自身位置的***及方法
CN101819042B (zh) 导航装置及导航方法
CN103256937B (zh) 路径匹配的方法及装置
CN105180933B (zh) 基于直行路口检测的移动机器人航迹推算修正***及方法
US9857181B2 (en) Methods and apparatus for evaluating operation of a vehicle onboard navigation system using lateral offset data
KR101010678B1 (ko) 네비게이션 장치 및 이의 주행 차선 구분 방법
CN109581449A (zh) 一种自动驾驶汽车的定位方法及***
CN113447033B (zh) 一种车道级地图匹配方法及***
US10986478B2 (en) Using ranging over C-V2X to supplement and enhance GPS performance
CN107389064A (zh) 一种基于惯性导航的无人车变道控制方法
CN111065042B (zh) 改善路侧单元位置确定的方法、路侧单元和提供位置信息的***
CN101964941A (zh) 基于动态信息的智能导航与位置服务***及方法
CN106469505B (zh) 一种浮动车轨迹纠偏方法和装置
CN109186607A (zh) 一种车辆行驶轨迹点预测的方法
CN105424050B (zh) 一种确定车辆行驶路径的方法和设备
CN109343095A (zh) 一种车载导航车辆组合定位装置及其组合定位方法
CN102183256A (zh) 行进车队的地图匹配方法
US8401787B2 (en) Method of determining drive lane using steering wheel model
CN104990554A (zh) Gnss盲区中基于vanet车辆间协作的惯性导航定位方法
CN104864867B (zh) 适用gnss的车辆在vsyr盲区定位误差修正方法
Blazquez et al. Simple map-matching algorithm applied to intelligent winter maintenance vehicle data
CN109946648B (zh) 一种车路协同下基于超宽带的车辆高精度定位方法
CN104408952A (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

Application publication date: 20190308

RJ01 Rejection of invention patent application after publication