CN113627270A - 一种基于图像拼接和标线检测的公路里程定位方法 - Google Patents

一种基于图像拼接和标线检测的公路里程定位方法 Download PDF

Info

Publication number
CN113627270A
CN113627270A CN202110805920.0A CN202110805920A CN113627270A CN 113627270 A CN113627270 A CN 113627270A CN 202110805920 A CN202110805920 A CN 202110805920A CN 113627270 A CN113627270 A CN 113627270A
Authority
CN
China
Prior art keywords
point
mileage
marking
image
points
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.)
Granted
Application number
CN202110805920.0A
Other languages
English (en)
Other versions
CN113627270B (zh
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.)
Chengdu Guimu Robot Co ltd
Original Assignee
Chengdu Guimu Robot 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 Chengdu Guimu Robot Co ltd filed Critical Chengdu Guimu Robot Co ltd
Priority to CN202110805920.0A priority Critical patent/CN113627270B/zh
Publication of CN113627270A publication Critical patent/CN113627270A/zh
Application granted granted Critical
Publication of CN113627270B publication Critical patent/CN113627270B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/40—Correcting position, velocity or attitude
    • 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/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
    • 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
    • G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T3/00—Geometric image transformations in the plane of the image
    • G06T3/40—Scaling of whole images or parts thereof, e.g. expanding or contracting
    • G06T3/4038—Image mosaicing, e.g. composing plane images from plane sub-images
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/10—Internal combustion engine [ICE] based vehicles
    • Y02T10/40—Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Theoretical Computer Science (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明公开了一种基于图像拼接和标线检测的公路里程定位方法，包括：获得任一图像的GPS定位和航向角；根据GPS定位和航向角对任一图像进行全局拼接；利用图像目标检测算法获取拼接图中的标线端部中心点；在里程整桩处的标线端部中心点线段上标记里程整桩点；对全部标线端部中心点和里程整桩点进行排序，并用线段连接相邻点；遍历求取与待测目标点最近的标记点；求取待测目标点与最近标记点相邻两条线段的垂足点，当垂足位于任一线段上时，以该线段上的垂足点为里程参考点T；沿车辆或机器人行进方向，得到里程参考点T与最近的里程整桩点之间的线段长度累计和M；根据最近的里程整桩点的里程与线段长度累计和M，求得目标点的里程值。

Description

一种基于图像拼接和标线检测的公路里程定位方法
技术领域
本发明涉及公路里程定位技术领域，尤其是一种基于图像拼接和标线检测的公路里程定位方法。
背景技术
随着高速公路建设工程的推进，高速公路里程逐年增加，对应高速公路相关智能装备逐渐投入工程使用。目前，现有技术中的通常采用参考起始里程桩号由车载里程计测量相对里程实现车辆或设备的公路里程定位，而车载里程计存在累计误差，并且受辆或设备实际行驶路径与理论里程参考线存在不确定偏差，从而现行技术公路里程定位精度较低，并且随行车距离越远误差越大。随着车载或智能装备对路面成像的技术的发展，可捕获具有路面视觉信息和高精度定位的图像数据，可作为建立高精度里程定位地图的数据源。
因此，急需要提出一种逻辑简单、准确可靠的基于图像拼接和标线检测的公路里程定位方法。
发明内容
针对上述问题，本发明的目的在于提供一种基于图像拼接和标线检测的公路里程定位方法，本发明采用的技术方案如下：
一种基于图像拼接和标线检测的公路里程定位方法，其采用沿道面方向行进的车辆或机器人进行定位，行进的车辆或机器人搭载垂直朝向地面的CCD相机，所述公路里程定位方法包括以下步骤：
利用RTK和惯导进行车辆或机器人实时GPS定位；获得任一图像的GPS定位和航向角；
根据GPS定位和航向角对全部图像进行全局拼接，得到拼接图；
利用图像目标检测算法获取拼接图中的标线端部中心点；
连接相邻标线端部中心点，得到数段标线连接线段；
在标线连接线段上实际里程整桩号处标记整桩号标记点；
对全部线端部中心点和整桩号标记点进行排序，获得公路路线标记点，并将相邻公路路线标记点连接；
以待测目标点遍历求得与全部公路路线标记点的距离，并求得最小距离对应的公路路线标记点；
分别求得待测目标点与距离最小公路线路标记点相邻两条线段的垂足点，当垂足点在任一一条线段内时，以该垂足点为里程参考点T；沿车辆或机器人行进方向，得到里程参考点T与最近的里程整桩点之间的线段长度累计和M；
根据最近的里程整桩点的里程与线段长度累计和M，求得目标点的里程值。
与现有技术相比，本发明具有以下有益效果：
本发明巧妙地利用图像识别和全局拼接检测得到标线端部中心点；其中，拼接图像中每个像素位置均具有GPS坐标。本发明利用目标点与标线端部中心点组成线段的垂足点与最近的里程整桩点的线段和求得目标点的里程，从而基于高精度GPS定位图像数据实现任意GPS目标点高精度里程定位。综上所述，本发明具有逻辑简单、准确可靠等优点，在公路里程定位技术领域具有很高的实用价值和推广价值。
附图说明
为了更清楚地说明本发明实施例的技术方案，下面将对实施例中所需使用的附图作简单介绍，应当理解，以下附图仅示出了本发明的某些实施例，因此不应被看作是对保护范围的限定，对于本领域技术人员来说，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。
图1为本发明的道路全局拼接示意图。
图2为本发明的标线端部中心点的示意图。
图3为本发明的里程整桩点布设示意图。
图4为本发明的公路路线标记点的连线示意图。
图5为本发明的目标点的垂线连接示意图。
具体实施方式
为使本申请的目的、技术方案和优点更为清楚，下面结合附图和实施例对本发明作进一步说明，本发明的实施方式包括但不限于下列实施例。基于本申请中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本申请保护的范围。
实施例
如图1至图5所示，本实施例提供了一种基于图像拼接和标线检测的公路里程定位方法，其采用沿道面方向行进的车辆或机器人进行定位，行进的车辆或机器人搭载朝向地面的CCD相机。
具体来说，公路里程定位方法包括以下步骤：
第一步，车辆或机器人沿道路方向行进，并利用CCD相机垂直朝向路面采集道路图像；同时，利用RTK和惯导进行车辆或机器人实时GPS定位；获得任一图像的GPS定位和航向角；
第二步，根据GPS定位和航向角对任一图像进行全局拼接，得到拼接图。其中，全局拼接为现有技术。
第三步，利用图像目标检测算法获取拼接图中的标线端部中心点，连接相邻标线端部中心点形成标记线段。
第四步，根据现场整数桩号路牌在拼接图像对应标记线段上标记里程整桩点。对全部标线端部中心点和里程整桩点按行车方向进行排序获得公路路线标记点，依次为P1、P2…PN。相邻点间以直线连接获得线段L1、L2…LN-1。
第五步，以待测目标点遍历求得与全部公路路线标记点的距离，并求得最小距离对应的公路路线标记点Pi；
第六步，分别求得待测目标点与Pi相邻两条线段Li、L(i+1)的垂足点，当垂足点在任一一条线段内时，以该垂足点为里程参考点T。
第七步，沿车辆或机器人行进方向，得到里程参考点T与最近的里程整桩点之间的线段长度累计和M。
第八步，根据最近的里程整桩点的里程与线段长度累计和M，求得目标点的里程值。例如以车辆或机器人行进方向上的前一里程整桩点的里程为K为例，则目标点的里程为K+M。
上述实施例仅为本发明的优选实施例，并非对本发明保护范围的限制，但凡采用本发明的设计原理，以及在此基础上进行非创造性劳动而作出的变化，均应属于本发明的保护范围之内。

Claims (1)

1.一种基于图像拼接和标线检测的公路里程定位方法，其特征在于，采用沿道面方向行进的车辆或机器人进行定位，行进的车辆或机器人搭载垂直朝向地面的CCD相机，所述公路里程定位方法包括以下步骤：
利用RTK和惯导进行车辆或机器人实时GPS定位；获得任一图像的GPS定位和航向角；
根据GPS定位和航向角对全部图像进行全局拼接，得到拼接图；
利用图像目标检测算法获取拼接图中的所有标线端部中心点；
连接相邻标线端部中心点，得到数段标线连接线段；
在标线连接线段上实际里程整桩号处标记整桩号标记点；
对全部线端部中心点和整桩号标记点进行排序，获得公路路线标记点，并将相邻公路路线标记点连接；
以待测目标点遍历求得与全部公路路线标记点的距离，并求得最小距离对应的公路路线标记点；
分别求得待测目标点与距离最小公路线路标记点相邻两条线段的垂足点，当垂足点在任一一条线段内时，以该垂足点为里程参考点T；
沿车辆或机器人行进方向，得到里程参考点T与最近的里程整桩点之间的线段长度累计和M；
根据最近的里程整桩点的里程与线段长度累计和M，求得目标点的里程值。
CN202110805920.0A 2021-07-19 2021-07-19 一种基于图像拼接和标线检测的公路里程定位方法 Active CN113627270B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110805920.0A CN113627270B (zh) 2021-07-19 2021-07-19 一种基于图像拼接和标线检测的公路里程定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110805920.0A CN113627270B (zh) 2021-07-19 2021-07-19 一种基于图像拼接和标线检测的公路里程定位方法

Publications (2)

Publication Number Publication Date
CN113627270A true CN113627270A (zh) 2021-11-09
CN113627270B CN113627270B (zh) 2023-05-26

Family

ID=78379949

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110805920.0A Active CN113627270B (zh) 2021-07-19 2021-07-19 一种基于图像拼接和标线检测的公路里程定位方法

Country Status (1)

Country Link
CN (1) CN113627270B (zh)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008194095A (ja) * 2007-02-08 2008-08-28 Nippon Hoso Kyokai <Nhk> 走行距離映像生成装置及び走行距離映像生成プログラム
CN108759823A (zh) * 2018-05-28 2018-11-06 浙江大学 基于图像匹配的指定道路上低速自动驾驶车辆定位及纠偏方法
CN110345968A (zh) * 2019-07-18 2019-10-18 南京市测绘勘察研究院股份有限公司 一种对移动三维激光扫描隧道成果里程配付的方法
CN110803200A (zh) * 2019-11-05 2020-02-18 武汉市市政建设集团有限公司 一种基于cpiii控制点的轨道里程定位方法及装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008194095A (ja) * 2007-02-08 2008-08-28 Nippon Hoso Kyokai <Nhk> 走行距離映像生成装置及び走行距離映像生成プログラム
CN108759823A (zh) * 2018-05-28 2018-11-06 浙江大学 基于图像匹配的指定道路上低速自动驾驶车辆定位及纠偏方法
CN110345968A (zh) * 2019-07-18 2019-10-18 南京市测绘勘察研究院股份有限公司 一种对移动三维激光扫描隧道成果里程配付的方法
CN110803200A (zh) * 2019-11-05 2020-02-18 武汉市市政建设集团有限公司 一种基于cpiii控制点的轨道里程定位方法及装置

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
LIMING DU等: "Cross-section positioning based on a dynamic MLS tunnel monitoring system", 《THE PHOTOGRAMMETRIC RECORD》 *
王宇桐等: "基于垂向定位与灰度投影的地铁扣件定位方法", 《铁道建筑》 *
赵嘉珩等: "一种融合点线特征的视觉里程计架构设计与定位实现", 《北京理工大学学报》 *

Also Published As

Publication number Publication date
CN113627270B (zh) 2023-05-26

Similar Documents

Publication Publication Date Title
US8239131B2 (en) Navigation device, navigation method, and navigation program
CN111380539B (zh) 车辆定位、导航方法和装置及相关***
CN110160542B (zh) 车道线的定位方法和装置、存储介质、电子装置
Rose et al. An integrated vehicle navigation system utilizing lane-detection and lateral position estimation systems in difficult environments for GPS
EP2034271B1 (en) Positioning device
US10240934B2 (en) Method and system for determining a position relative to a digital map
EP3604680B1 (en) Magnetic marker installation method and working system
Brenner Extraction of features from mobile laser scanning data for future driver assistance systems
US7463974B2 (en) Systems, methods, and programs for determining whether a vehicle is on-road or off-road
US20070021912A1 (en) Current position information management systems, methods, and programs
JP2006047291A (ja) デジタルレーンマーク作成装置
CN108645420B (zh) 一种基于差分导航的自动驾驶车辆多路径地图的创建方法
JP2001331787A (ja) 道路形状推定装置
EP2132584A2 (en) System and method for vehicle navigation and piloting including absolute and relative coordinates
JP2019534513A (ja) 航空画像または衛星画像と車両によって検出されたデータとからディジタル道路モデルを生成するためのシステムおよび方法
KR102115004B1 (ko) 항공사진을 이용하여 3차원 지도를 생성하는 장치 및 방법
JP3941499B2 (ja) 車両位置検出装置及び、車両位置検出方法
CN110018503B (zh) 车辆的定位方法及定位***
CN113566817B (zh) 一种车辆定位方法及装置
EP1674827A1 (en) System for detecting a lane change of a vehicle
JP2019120629A (ja) 位置計算装置、位置計算プログラム及び座標マーカ
JP2000338865A (ja) デジタル道路地図のデータ収集装置
CN111811467B (zh) 高速铁路轨面长波不均匀沉降动态检测方法、装置
CN113627270B (zh) 一种基于图像拼接和标线检测的公路里程定位方法
KR102137043B1 (ko) 환경센서와 정밀지도를 이용한 측위 정확도 개선 시스템

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