CN118172938B - Vehicle trajectory full-course tracking method based on distributed optical fiber and laser radar - Google Patents
Vehicle trajectory full-course tracking method based on distributed optical fiber and laser radar Download PDFInfo
- Publication number
- CN118172938B CN118172938B CN202410591409.9A CN202410591409A CN118172938B CN 118172938 B CN118172938 B CN 118172938B CN 202410591409 A CN202410591409 A CN 202410591409A CN 118172938 B CN118172938 B CN 118172938B
- Authority
- CN
- China
- Prior art keywords
- target
- optical fiber
- laser radar
- distributed optical
- time series
- 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
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0125—Traffic data processing
- G08G1/0129—Traffic data processing for creating historical data or processing based on historical data
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V10/00—Arrangements for image or video recognition or understanding
- G06V10/20—Image preprocessing
- G06V10/30—Noise filtering
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V10/00—Arrangements for image or video recognition or understanding
- G06V10/40—Extraction of image or video features
- G06V10/62—Extraction of image or video features relating to a temporal dimension, e.g. time-based feature extraction; Pattern tracking
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V10/00—Arrangements for image or video recognition or understanding
- G06V10/70—Arrangements for image or video recognition or understanding using pattern recognition or machine learning
- G06V10/74—Image or video pattern matching; Proximity measures in feature spaces
- G06V10/761—Proximity, similarity or dissimilarity measures
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V10/00—Arrangements for image or video recognition or understanding
- G06V10/70—Arrangements for image or video recognition or understanding using pattern recognition or machine learning
- G06V10/762—Arrangements for image or video recognition or understanding using pattern recognition or machine learning using clustering, e.g. of similar faces in social networks
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V10/00—Arrangements for image or video recognition or understanding
- G06V10/70—Arrangements for image or video recognition or understanding using pattern recognition or machine learning
- G06V10/764—Arrangements for image or video recognition or understanding using pattern recognition or machine learning using classification, e.g. of video objects
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/52—Surveillance or monitoring of activities, e.g. for recognising suspicious objects
- G06V20/54—Surveillance or monitoring of activities, e.g. for recognising suspicious objects of traffic, e.g. cars on the road, trains or boats
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0137—Measuring and analyzing of parameters relative to traffic conditions for specific applications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/052—Detecting movement of traffic to be counted or controlled with provision for determining speed or overspeed
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/123—Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Multimedia (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Databases & Information Systems (AREA)
- Artificial Intelligence (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Computing Systems (AREA)
- General Health & Medical Sciences (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
Description
技术领域Technical Field
本发明涉及交通工程技术领域,特别涉及一种基于分布式光纤与激光雷达的车辆轨迹全程追踪方法。The present invention relates to the technical field of traffic engineering, and in particular to a vehicle trajectory full-course tracking method based on distributed optical fiber and laser radar.
背景技术Background technique
本部分的陈述仅仅是提供了与本发明相关的背景技术,并不必然构成现有技术。The statements in this section merely provide background art related to the present invention and do not necessarily constitute prior art.
智慧交通系统致力于利用先进的传感器技术、通信技术、信息技术、控制技术等综合地集成并应用于交通建设与运营中,建立起实时、准确、高效的地面交通系统,从而更好地保障交通安全并提高交通资源的效率。在智慧公路的建设中,行人、车辆、道路与交通环境的信息协同是一项关键内容;其中,车辆轨迹的感知、探测与追踪,在智慧公路全系统、全阶段的建设中,起着基础性的作用:一方面,它可以为交通流量监测、交通密度监测、道路通行能力监测等宏观交通信息提供数据基础支持;另一方面,精细准确的车辆轨迹追踪可以为交通冲突识预警、个性化导航、交通行为分析、驾驶行为预测等微观的交通服务提供依据。The intelligent transportation system is committed to using advanced sensor technology, communication technology, information technology, control technology, etc. to integrate and apply them to transportation construction and operation, and establish a real-time, accurate, and efficient ground transportation system, so as to better ensure traffic safety and improve the efficiency of transportation resources. In the construction of smart highways, the information coordination of pedestrians, vehicles, roads, and traffic environment is a key content; among them, the perception, detection, and tracking of vehicle trajectories play a fundamental role in the construction of the entire system and all stages of smart highways: on the one hand, it can provide data support for macro traffic information such as traffic flow monitoring, traffic density monitoring, and road capacity monitoring; on the other hand, precise and accurate vehicle trajectory tracking can provide a basis for micro traffic services such as traffic conflict recognition and warning, personalized navigation, traffic behavior analysis, and driving behavior prediction.
在目前的车辆轨迹追踪和识别技术中,基于激光雷达(Laser Radar,LR)的技术可以建立识别范围内的3D点云图像,清晰地分辨车辆的位置、形状与运动等信息,但其成本较高,难以实现长距离的连续车辆轨迹检测;基于分布式光纤传感(Distributed AcousticSensing,DAS)的技术可以以较低成本实现长距离的连续车辆轨迹检测,但其对于路段交叉口、合流区等车辆密度大的区域识别精确率不佳;现有技术中存在采用毫米波雷达和激光雷达相融合以进行车辆轨迹监测的方案,但是大多只针对路口车辆,无法实现大范围内的在途目标车辆的全过程追踪。Among the current vehicle trajectory tracking and recognition technologies, the technology based on Laser Radar (LR) can establish a 3D point cloud image within the recognition range and clearly distinguish the vehicle's position, shape, movement and other information, but its cost is relatively high and it is difficult to achieve long-distance continuous vehicle trajectory detection; the technology based on Distributed Acoustic Sensing (DAS) can achieve long-distance continuous vehicle trajectory detection at a relatively low cost, but its recognition accuracy is poor for areas with high vehicle density such as road intersections and merging areas; there are solutions in the existing technology that use the fusion of millimeter-wave radar and LiDAR to monitor vehicle trajectories, but most of them are only for vehicles at intersections and cannot achieve full-process tracking of target vehicles on the way within a large range.
发明内容Summary of the invention
为了解决现有技术的不足,本发明提供了一种基于分布式光纤与激光雷达的车辆轨迹全程追踪方法,充分发挥了分布式光纤监测设备和激光雷达的优势,实现了大范围内的在途目标车辆轨迹的全程追踪。In order to address the deficiencies in the prior art, the present invention provides a method for full-course tracking of vehicle trajectories based on distributed optical fiber and laser radar, which fully utilizes the advantages of distributed optical fiber monitoring equipment and laser radar to achieve full-course tracking of on-the-way target vehicle trajectories within a large range.
为了实现上述目的,本发明采用如下技术方案:In order to achieve the above object, the present invention adopts the following technical solution:
第一方面,本发明提供了一种基于分布式光纤与激光雷达的车辆轨迹全程追踪方法。In a first aspect, the present invention provides a method for full-course tracking of vehicle trajectories based on distributed optical fiber and laser radar.
一种基于分布式光纤与激光雷达的车辆轨迹全程追踪方法,分布式光纤监测设备安装在无交叉口路段,激光雷达安装在道路交叉口,包括以下过程:A vehicle trajectory tracking method based on distributed optical fiber and laser radar, wherein the distributed optical fiber monitoring equipment is installed on a road section without intersections, and the laser radar is installed at a road intersection, including the following processes:
获取由分布式光纤监测设备和激光雷达识别到的在途目标状态数据,建立在途目标实时状态数据库,在途目标被分配识别编号;Obtain the status data of the in-transit targets identified by the distributed optical fiber monitoring equipment and the laser radar, establish a real-time status database of the in-transit targets, and assign identification numbers to the in-transit targets;
在分布式光纤监测设备和激光雷达的识别交叉区域,获取由分布式光纤监测设备识别到的第一目标位置时间序列,以及由激光雷达识别到的第二目标位置时间序列;In the identification intersection area of the distributed optical fiber monitoring device and the laser radar, a first target position time series identified by the distributed optical fiber monitoring device and a second target position time series identified by the laser radar are obtained;
经坐标系转换后,判断第一目标位置时间序列与第二目标位置时间序列的相似性,如果相似性大于设定阈值,则认为两条目标位置时间序列来自同一在途目标;After the coordinate system conversion, the similarity between the first target position time series and the second target position time series is determined. If the similarity is greater than a set threshold, it is considered that the two target position time series are from the same en-route target.
将此在途目标的监测数据合并后更新在途目标实时状态数据库,结合分布式光纤和激光雷达单独识别到的车辆轨迹,得到此在途目标的全程轨迹。The monitoring data of the in-transit target is merged to update the real-time status database of the in-transit target, and the full trajectory of the in-transit target is obtained by combining the vehicle trajectories identified separately by the distributed optical fiber and the lidar.
作为本发明第一方面进一步的限定,根据分布式光纤监测设备识别到的在途目标状态数据,生成的识别编号的字段包括:分布式光纤监测设备标识位、目标类型、相对位置、实时车速和绝对位置;As a further limitation of the first aspect of the present invention, the fields of the identification number generated according to the in-transit target state data identified by the distributed optical fiber monitoring device include: the identification bit of the distributed optical fiber monitoring device, the target type, the relative position, the real-time vehicle speed and the absolute position;
根据激光雷达识别到的在途目标状态数据,生成的识别编号的字段包括:激光雷达标识位、目标类型、相对位置、实时车速和绝对位置;According to the status data of the on-road target identified by the laser radar, the fields of the generated identification number include: laser radar identification bit, target type, relative position, real-time vehicle speed and absolute position;
识别编号中的字段,包括:在分布式光纤监测标识位、在激光雷达监测标识位、目标类型、相对位置、实时车速和绝对位置。The fields in the identification number include: the distributed optical fiber monitoring identification position, the lidar monitoring identification position, the target type, the relative position, the real-time vehicle speed and the absolute position.
作为本发明第一方面更进一步的限定,当在途目标正在被分布式光纤监测设备监测时,分布式光纤监测设备标识位的位值为当前正监测的分布式光纤监测设备的编号;否则,位值为0;As a further limitation of the first aspect of the present invention, when the in-transit target is being monitored by a distributed optical fiber monitoring device, the bit value of the distributed optical fiber monitoring device identification bit is the serial number of the distributed optical fiber monitoring device currently being monitored; otherwise, the bit value is 0;
当在途目标正在被激光雷达监测时,激光雷达标识位的位值为当前正监测的激光雷达的编号;否则,位值为0。When the on-the-way target is being monitored by the laser radar, the bit value of the laser radar identification bit is the number of the laser radar currently being monitored; otherwise, the bit value is 0.
作为本发明第一方面进一步的限定,第一目标位置时间序列的获取,包括:As a further limitation of the first aspect of the present invention, acquiring the first target position time series includes:
当在途目标处在激光雷达的监测中时,以激光雷达安装位置为坐标原点,获取坐标原点的经纬度坐标,激光雷达坐标系轴与正北方向对齐,轴与正东方向对齐;When the target in transit is under the monitoring of the laser radar, the laser radar installation position is taken as the coordinate origin, and the longitude and latitude coordinates of the coordinate origin are obtained. The laser radar coordinate system The axis is aligned with true north, The axis is aligned with due east;
根据在途目标的相对位置为以及坐标原点的经纬度坐标,得到在途目标的绝对位置,根据设定时间段内的绝对位置生成第一目标位置时间序列。The absolute position of the in-transit target is obtained according to the relative position of the in-transit target and the longitude and latitude coordinates of the coordinate origin, and the first target position time series is generated according to the absolute position within a set time period.
作为本发明第一方面进一步的限定,第二目标位置时间序列的获取,包括:As a further limitation of the first aspect of the present invention, acquiring the second target position time series includes:
获取光纤上个标记点的经纬度坐标分别为,以及这些标记点在这段光纤中的相对位置,以分布式光纤监测设备坐标系中的坐标表示为;Get fiber optic The latitude and longitude coordinates of the marker points are , and the relative positions of these marking points in this section of optical fiber are expressed in the coordinate system of the distributed optical fiber monitoring device as ;
在某时刻,在途目标的相对位置为,若有,则该在途目标的绝对位置可以确定为;若有,则该在途目标的绝对位置由线性插值的方法确定。At a certain moment, the relative position of the on-the-way target is , if any , then the absolute position of the en-route target can be determined as If any , then the absolute position of the in-transit target is determined by the linear interpolation method.
作为本发明第一方面进一步的限定,判断第一目标位置时间序列与第二目标位置时间序列的相似性,包括:As a further limitation of the first aspect of the present invention, determining the similarity between the first target position time series and the second target position time series includes:
根据两个时间序列中的每个数据点之间的距离或相似度,创建一个距离矩阵;Create a distance matrix based on the distance or similarity between each data point in the two time series;
创建一个与距离矩阵相同大小的动态规划表格,其中每个表格元素表示从起始点到当前点的最佳对齐路径的距离;Create a dynamic programming table of the same size as the distance matrix, where each table element represents the distance of the best alignment path from the starting point to the current point;
从起始点开始,通过逐步更新动态规划表格中的元素,计算到达每个点时的最佳对齐路径的距离,更新的方式是选择当前点周围三个相邻点中距离最小的一个,并将其与当前点的距离相加;Starting from the starting point, the distance of the best alignment path to each point is calculated by gradually updating the elements in the dynamic programming table. The updating method is to select the one with the smallest distance among the three adjacent points around the current point and add its distance to the current point.
根据动态规划表格中的最后一个元素,回溯找到最佳对齐路径,所述最佳对齐路径表示两个时间序列之间的最佳匹配方式;According to the last element in the dynamic programming table, backtrack to find the best alignment path, where the best alignment path represents the best matching method between the two time series;
根据最佳对齐路径上的点计算两个时间序列之间的相似度或距离,使用路径上所有点的距离之和或者平均距离作为相似度度量。The similarity or distance between two time series is calculated based on the points on the best alignment path, and the sum or average distance of all points on the path is used as the similarity measure.
作为本发明第一方面进一步的限定,更新在途目标实时状态数据库,包括:As a further limitation of the first aspect of the present invention, updating the real-time status database of in-transit targets includes:
在途目标的唯一编号保留为激光雷达监测时的值,实时车速与绝对位置均以分布式光纤监测设备与激光雷达的监测数值的算术平均确定。The unique number of the target in transit is retained as the value during lidar monitoring, and the real-time vehicle speed and absolute position are determined by the arithmetic mean of the monitoring values of the distributed fiber optic monitoring equipment and the lidar.
第二方面,本发明提供了一种基于分布式光纤与激光雷达的车辆轨迹全程追踪系统。In a second aspect, the present invention provides a vehicle trajectory full-range tracking system based on distributed optical fiber and laser radar.
一种基于分布式光纤与激光雷达的车辆轨迹全程追踪系统,分布式光纤监测设备安装在无交叉口路段,激光雷达安装在道路交叉口,包括:A vehicle trajectory tracking system based on distributed optical fiber and laser radar, where the distributed optical fiber monitoring equipment is installed on the road section without intersections and the laser radar is installed at the road intersection, including:
轨迹数据获取模块,被配置为:获取由分布式光纤监测设备和激光雷达识别到的在途目标状态数据,建立在途目标实时状态数据库,在途目标被分配识别编号;The trajectory data acquisition module is configured to: acquire the state data of the in-transit targets identified by the distributed optical fiber monitoring equipment and the laser radar, establish a real-time state database of the in-transit targets, and assign identification numbers to the in-transit targets;
时间序列生成模块,被配置为:在分布式光纤监测设备和激光雷达的识别交叉区域,获取由分布式光纤监测设备识别到的第一目标位置时间序列,以及由激光雷达识别到的第二目标位置时间序列;The time series generation module is configured to: obtain a first target position time series identified by the distributed optical fiber monitoring device and a second target position time series identified by the laser radar in an identification intersection area of the distributed optical fiber monitoring device and the laser radar;
相似性判断模块,被配置为:经坐标系转换后,判断第一目标位置时间序列与第二目标位置时间序列的相似性,如果相似性大于设定阈值,则认为两条目标位置时间序列来自同一在途目标;The similarity judgment module is configured to: judge the similarity between the first target position time series and the second target position time series after the coordinate system conversion, and if the similarity is greater than a set threshold, it is considered that the two target position time series are from the same en-route target;
全程轨迹生成模块,被配置为:将此在途目标的监测数据合并后更新在途目标实时状态数据库,结合分布式光纤和激光雷达单独识别到的车辆轨迹,得到此在途目标的全程轨迹。The full-course trajectory generation module is configured to merge the monitoring data of the in-course target and update the real-time status database of the in-course target, and combine the vehicle trajectories independently identified by the distributed optical fiber and the laser radar to obtain the full-course trajectory of the in-course target.
第三方面,本发明提供了一种计算机可读存储介质,其上存储有程序,该程序被处理器执行时实现如本发明第一方面所述的基于分布式光纤与激光雷达的车辆轨迹全程追踪方法中的步骤。In a third aspect, the present invention provides a computer-readable storage medium having a program stored thereon, which, when executed by a processor, implements the steps in the method for full-course vehicle trajectory tracking based on distributed optical fiber and laser radar as described in the first aspect of the present invention.
第四方面,本发明提供了一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的程序,所述处理器执行所述程序时实现如本发明第一方面所述的基于分布式光纤与激光雷达的车辆轨迹全程追踪方法中的步骤。In a fourth aspect, the present invention provides an electronic device comprising a memory, a processor, and a program stored in the memory and executable on the processor, wherein when the processor executes the program, the steps in the method for full-course tracking of vehicle trajectories based on distributed optical fiber and laser radar as described in the first aspect of the present invention are implemented.
与现有技术相比,本发明的有益效果是:Compared with the prior art, the present invention has the following beneficial effects:
本发明创新性的提出了一种基于分布式光纤与激光雷达的车辆轨迹全程追踪方法,在无交叉口路段与交叉口交替出现的道路中,将分布式光纤监测设备安装在距离较长而无车辆交汇的无交叉口路段,将激光雷达安装在车辆交汇情况复杂但需监测范围有限的道路交叉口,充分发挥了分布式光纤监测设备和激光雷达的优势,实现了大范围内的在途目标车辆轨迹的全程追踪。The present invention innovatively proposes a method for full-course tracking of vehicle trajectories based on distributed optical fiber and laser radar. On roads where non-intersection sections and intersections appear alternately, distributed optical fiber monitoring equipment is installed on non-intersection sections with long distances and no vehicle intersections, and laser radars are installed on road intersections where vehicle intersections are complex but the monitoring range is limited. This method gives full play to the advantages of distributed optical fiber monitoring equipment and laser radars, and realizes full-course tracking of the trajectories of target vehicles on the road within a large range.
本发明附加方面的优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。Advantages of additional aspects of the present invention will be given in part in the following description, and in part will become obvious from the following description, or will be learned through practice of the present invention.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
构成本发明的一部分的说明书附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。The accompanying drawings in the specification, which constitute a part of the present invention, are used to provide a further understanding of the present invention. The exemplary embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute improper limitations on the present invention.
图1为本发明实施例1提供的基于分布式光纤与激光雷达的车辆轨迹全程追踪方法的流程示意图;FIG1 is a schematic flow chart of a method for tracking vehicle trajectories throughout the entire process based on distributed optical fiber and laser radar provided in Example 1 of the present invention;
图2为本发明实施例1提供的坐标系转换示意图;FIG2 is a schematic diagram of coordinate system conversion provided by Embodiment 1 of the present invention;
图3为本发明实施例2提供的基于分布式光纤与激光雷达的车辆轨迹全程追踪系统的示意图;FIG3 is a schematic diagram of a vehicle trajectory full-course tracking system based on distributed optical fiber and laser radar provided in Example 2 of the present invention;
其中,101-激光雷达;102-末段光纤。Among them, 101-laser radar; 102-end optical fiber.
具体实施方式Detailed ways
下面结合附图与实施例对本发明作进一步说明。The present invention will be further described below in conjunction with the accompanying drawings and embodiments.
应该指出,以下详细说明都是示例性的,旨在对本发明提供进一步的说明。除非另有指明,本文使用的所有技术和科学术语具有与本发明所属技术领域的普通技术人员通常理解的相同含义。It should be noted that the following detailed descriptions are exemplary and are intended to provide further explanation of the present invention. Unless otherwise specified, all technical and scientific terms used herein have the same meanings as those commonly understood by those skilled in the art to which the present invention belongs.
在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。In the absence of conflict, the embodiments of the present invention and the features of the embodiments may be combined with each other.
实施例1:Embodiment 1:
如图1所示,本发明实施例1提供了一种基于分布式光纤与激光雷达的车辆轨迹全程追踪方法的流程示意图,包括以下过程:As shown in FIG1 , Embodiment 1 of the present invention provides a schematic flow chart of a method for tracking vehicle trajectories throughout the entire process based on distributed optical fiber and laser radar, including the following processes:
S1:经由分布式光纤和激光雷达识别所有的在途目标,建立在途目标实时状态数据库,为每个目标分配唯一的识别编号;S1: Identify all en-route targets through distributed optical fiber and laser radar, establish a real-time status database of en-route targets, and assign a unique identification number to each target;
S2:分布式光纤与激光雷达坐标系匹配;S2: Matching of distributed optical fiber and lidar coordinate systems;
S3:分布式光纤与激光雷达追踪的在途目标融合认定;S3: Fusion identification of in-transit targets using distributed fiber and lidar tracking;
S4:更新在途目标状态数据库。S4: Update the in-transit target status database.
S1中,建立在途目标状态数据库,具体的,包括:In S1, a database of in-transit target status is established, including:
构建实时数据库,以分布式光纤或激光雷达检测到的在途目标,在数据库中分配唯一的识别编号,作为一条数据,该条数据具有的其他字段包括:Build a real-time database to assign a unique identification number to the in-transit target detected by distributed optical fiber or lidar in the database as a piece of data. Other fields of the data include:
(1)在DAS监测标识位:该字段表示了当前在途目标是否在DAS系统监测下,在监测下时,此数据位值为当前正被监测的DAS设备的编号;否则,此数据位值为0。(1) DAS monitoring flag: This field indicates whether the current in-transit target is under DAS system monitoring. If it is under monitoring, the value of this data bit is the number of the DAS device currently being monitored; otherwise, the value of this data bit is 0.
(2)在激光雷达监测标识位:该字段表示了当前在途目标是否在激光雷达监测下,在监测下时,此数据位值为当前正被监测的激光雷达的编号;否则,此数据位值为0。(2) Laser radar monitoring flag: This field indicates whether the target is currently under laser radar monitoring. If it is, the value of this data bit is the number of the laser radar currently being monitored; otherwise, the value of this data bit is 0.
(3)目标类型:该字段表示了依托现有算法得到的对目标车辆的类型的估计;其中,DAS系统可以通过数据去噪、特征提取、模式识别的步骤得到检测目标的车型分类,激光雷达可以通过背景滤除、点云聚类、模式识别的步骤得到目标的车型分类,该字段的可选值包括:1-小型车,2-SUV,3-大型车,4-其他。(3) Target type: This field indicates the estimation of the target vehicle type based on the existing algorithm. The DAS system can obtain the target vehicle type classification through data denoising, feature extraction, and pattern recognition. The LiDAR system can obtain the target vehicle type classification through background filtering, point cloud clustering, and pattern recognition. The optional values of this field include: 1-small car, 2-SUV, 3-large car, 4-other.
(4)相对位置:该字段表示目标在当前被监测的传感器的坐标系下的坐标。(4) Relative position: This field indicates the coordinates of the target in the coordinate system of the sensor currently being monitored.
(4-1)激光雷达对目标进行追踪后,可以给出在以激光雷达为原点的正交坐标系中,目标的几何中心点在3D点云中的位移矢量:(4-1) After the laser radar tracks the target, it can give the displacement vector of the geometric center point of the target in the 3D point cloud in the orthogonal coordinate system with the laser radar as the origin: :
(1); (1);
其中,分别为沿着轴的单位向量,则在时刻,目标的相对位置为,、和为目标的几何中心点坐标。in, Along the The unit vector of the axis is , the relative position of the target is , , and The coordinates of the geometric center point of the target.
(4-2)DAS系统对目标进行追踪后,可以给出在一维坐标系中目标的位移矢量:(2);(4-2) After the DAS system tracks the target, it can give the displacement vector of the target in the one-dimensional coordinate system: (2);
其中,为沿着轴的单位向量。in, For along The unit vector of the axis.
则在时刻,目标的相对位置为。At the time , the relative position of the target is .
(5)实时车速:该字段表示目标的实时车速。(5) Real-time vehicle speed: This field indicates the target’s real-time vehicle speed.
(5-1)在激光雷达中,目标的速度矢量为:(5-1) In laser radar, the velocity vector of the target is:
(3); (3);
实时车速(即瞬时速率)为上式的模值:(4)。The real-time vehicle speed (i.e. instantaneous speed) is the modulus of the above formula: (4).
(5-2)在DAS系统中,目标的速度矢量为:(5);(5-2) In the DAS system, the velocity vector of the target is: (5);
实时车速(即瞬时速率)为上式的模值:(6)。The real-time vehicle speed (i.e. instantaneous speed) is the modulus of the above formula: (6).
(6)绝对位置:该字段表示目标在地面的实际位置,以经纬度坐标表示,下面给出该字段的确定方法。(6) Absolute position: This field indicates the actual position of the target on the ground, expressed in longitude and latitude coordinates. The method for determining this field is given below.
(6-1)当目标处在激光雷达的监测中时,设当前正在监测此目标的激光雷达的编号为LR-1,预先测得其安装位置(即坐标原点)的经纬度坐标为,并使其坐标系轴与正北方向对齐,轴与正东方向对齐。(6-1) When the target is under the monitoring of the laser radar, let the laser radar currently monitoring the target be numbered LR-1, and the longitude and latitude coordinates of its installation position (i.e., the origin of the coordinates) measured in advance are , and make its coordinate system The axis is aligned with true north, The axis is aligned with due east.
在某时刻,监测目标的相对位置为,单位长度为1米。At a certain moment, the relative position of the monitoring target is , the unit length is 1 meter.
则目标的纬度可由下式求得:(7);The latitude of the target can be obtained by the following formula: (7);
经度由下式求得:(8)。The longitude is obtained by the following formula: (8).
(6-2)当目标处在DAS系统的监测中时,设当前正在监测此目标的光纤段的编号为DAS-1,预先测得该段光纤上个标记点的经纬度坐标分别为;同时,还需测得这些标记点在这段光纤中的相对位置(沿光纤行进方向),以DAS坐标系中的坐标表示为,标记点选取的方法是:在较直的路段稀疏,而在弯曲的路段密集,使得在设计精度下,相邻两个标记点之间可以近似看作直线。(6-2) When the target is under the monitoring of the DAS system, let the fiber segment currently monitoring the target be numbered DAS-1. The latitude and longitude coordinates of the marker points are At the same time, the relative positions of these marking points in this section of optical fiber (along the direction of optical fiber travel) need to be measured, expressed as the coordinates in the DAS coordinate system: ,The method of selecting marking points is : sparse in straight sections and dense in curved sections, so that under the design accuracy, the distance between two adjacent marking points can be approximately regarded as a straight line.
在某时刻,监测目标的相对位置为;At a certain moment, the relative position of the monitoring target is ;
若有,为DAS坐标系中的第k个坐标,则该目标的绝对位置可以确定为,为监测目标的纬度坐标,为监测目标的经度坐标;If yes , is the kth coordinate in the DAS coordinate system, then the absolute position of the target can be determined as , is the latitude coordinate of the monitoring target, is the longitude coordinate of the monitoring target;
若有,为DAS坐标系中的第k+1个坐标,则该目标的绝对位置可以由线性插值的方法确定:If yes , is the k+ 1th coordinate in the DAS coordinate system, then the absolute position of the target can be determined by the linear interpolation method:
纬度:(9);latitude: (9);
经度:(10);longitude: (10);
其中,为监测目标的纬度,为监测目标的经度,为位置的纬度,为位置的纬度,为位置的经度,为位置的经度,的计算方法为:(11);in, To monitor the latitude of the target, To monitor the longitude of the target, for The latitude of the location, for The latitude of the location, for The longitude of the location, for The longitude of the location, The calculation method is: (11);
以上经纬度与距离的换算关系是在忽略地球曲率的前提下做出的,由于本发明的应用场景中的距离范围与赤道长度相较处于更低的数量级,这种简化是合理的。The above conversion relationship between longitude and latitude and distance is made under the premise of ignoring the curvature of the earth. Since the distance range in the application scenario of the present invention is at a lower order of magnitude than the equatorial length, this simplification is reasonable.
S2中,分布式光纤与激光雷达坐标系匹配,具体的,包括:In S2, the distributed optical fiber matches the laser radar coordinate system, including:
由于激光雷达监测范围小而DAS系统监测范围大,在每个激光雷达安装位置的附近,存在两设备监测范围重叠的区域,这部分区域是将追踪目标从DAS系统传递到激光雷达(或反之)的关键,首先进行的是在重叠区域的两系统坐标系的匹配,具体如图2所示,以其中安装在十字路口的一个激光雷达101及其附近的末段光纤102为例,在激光雷达101的三维坐标系中,该末段光纤102体现为一条线段。Since the monitoring range of the laser radar is small and the monitoring range of the DAS system is large, there is an area where the monitoring ranges of the two devices overlap near each laser radar installation location. This area is the key to transferring the tracking target from the DAS system to the laser radar (or vice versa). The first thing to do is to match the coordinate systems of the two systems in the overlapping area. As shown in Figure 2, taking a laser radar 101 installed at a crossroads and the terminal optical fiber 102 near it as an example, in the three-dimensional coordinate system of the laser radar 101, the terminal optical fiber 102 is reflected as a line segment.
坐标系为激光雷达101的坐标系,为激光雷达101安装位置在地面的竖直投影点,预先测得激光雷达101离地面的安装高度为,末段光纤102的方向与正北方向的夹角为,与该末段光纤102的垂直距离为,激光雷达101的坐标系的原点位于激光雷达101的中心,轴与正北方向对齐,轴与正东方向对齐,轴与竖直向上方向对齐。 The coordinate system is the coordinate system of the laser radar 101, is the vertical projection point of the laser radar 101 installation position on the ground. The installation height of the laser radar 101 from the ground is measured in advance. , the angle between the direction of the end optical fiber 102 and the north direction is , The vertical distance from the end optical fiber 102 is , the origin of the coordinate system of the laser radar 101 Located at the center of LiDAR 101, The axis is aligned with true north, The axis is aligned with due east, The axis is aligned with the vertical upward direction.
则在该末段光纤102上,坐标为的点在激光雷达101的坐标系中表示为:(12);Then, on the last section of optical fiber 102, the coordinates are The point is expressed in the coordinate system of the laser radar 101 as: (12);
S3中,分布式光纤与激光雷达追踪的在途目标融合认定,具体的,包括:In S3, the fusion identification of in-transit targets tracked by distributed optical fiber and lidar includes:
现有DAS系统与激光雷达在时间内各获得的车辆轨迹数据与 ,其数据形式为时间序列,其数据值为经由上一步骤坐标转换后的目标位置坐标;通过判别两条时间序列的相似性,超过一定阈值,则认为两条车辆轨迹的数据来自同一目标,完成融合认定,具体如下:Existing DAS systems and LiDAR in time The vehicle trajectory data obtained and , whose data form is a time series, and whose data value is the target position coordinate after the coordinate conversion in the previous step; by judging the similarity of the two time series, if it exceeds a certain threshold, it is considered that the data of the two vehicle trajectories come from the same target, and the fusion identification is completed, as follows:
由于激光雷达与DAS设备的工作频率通常不相同,在相同时间内,得到的时间序列长度不同,本发明采用动态时间规整(Dynamic Time Warping,DTW)算法,可以抹除两种传感器之间的频率差别,从长度不同的时间序列中有效分辨两信号的相似性。Since the operating frequencies of lidar and DAS equipment are usually different, the lengths of time series obtained in the same time are different. The present invention adopts a dynamic time warping (DTW) algorithm to eliminate the frequency difference between the two sensors and effectively distinguish the similarities of the two signals from time series of different lengths.
S3.1:创建距离矩阵,根据两个时间序列中的每个数据点之间的距离或相似度,创建一个距离矩阵,通常使用欧氏距离、曼哈顿距离或相关系数等度量方法来计算数据点之间的距离;S3.1: Create a distance matrix. Create a distance matrix based on the distance or similarity between each data point in the two time series. Usually, a metric such as Euclidean distance, Manhattan distance, or correlation coefficient is used to calculate the distance between data points.
S3.2:初始化动态规划表格,创建一个与距离矩阵相同大小的动态规划表格,其中每个表格元素表示从起始点到当前点的最佳对齐路径的距离;S3.2: Initialize the dynamic programming table and create a dynamic programming table of the same size as the distance matrix, where each table element represents the distance of the best alignment path from the starting point to the current point;
S3.3:动态规划计算,从起始点开始,通过逐步更新动态规划表格中的元素,计算到达每个点时的最佳对齐路径的距离。更新的方式是选择当前点周围三个相邻点中距离最小的一个,并将其与当前点的距离相加;S3.3: Dynamic programming calculation, starting from the starting point, by gradually updating the elements in the dynamic programming table, calculate the distance of the best alignment path to each point. The updating method is to select the one with the smallest distance among the three adjacent points around the current point and add its distance to the current point;
S3.4:回溯最佳路径,根据动态规划表格中的最后一个元素,回溯找到最佳对齐路径。所述最佳对齐路径表示两个时间序列之间的最佳匹配方式;S3.4: Backtrack the best path, and find the best alignment path according to the last element in the dynamic programming table. The best alignment path represents the best matching method between the two time series;
S3.5:计算相似度,根据最佳对齐路径上的点计算两个时间序列之间的相似度或距离,可以使用路径上所有点的距离之和或者平均距离作为相似度度量。S3.5: Calculate similarity. Calculate the similarity or distance between the two time series based on the points on the optimal alignment path. The sum of the distances of all points on the path or the average distance can be used as the similarity measure.
S4中,更新在途目标状态数据库,具体的,包括:In S4, the in-transit target status database is updated, specifically including:
当S3中,将来自两传感器的时间序列完成了融合认定,同时两条数据的车辆类型判断相同,则在在途目标状态数据库中,将两条数据合并为一条。When the time series from the two sensors are fused and identified in S3, and the vehicle types of the two data are judged to be the same, the two data are merged into one in the in-transit target status database.
本实施例中,优选的,唯一编号保留为激光雷达监测时的值。In this embodiment, preferably, the unique number is retained as the value during laser radar monitoring.
本实施例中,优选的,“实时车速”与“绝对位置”以两传感器数值的算术平均来确定。In this embodiment, preferably, the "real-time vehicle speed" and the "absolute position" are determined by the arithmetic average of the values of the two sensors.
实施例2:Embodiment 2:
本发明实施例2提供了一种基于分布式光纤与激光雷达的车辆轨迹全程追踪系统,分布式光纤监测设备安装在无交叉口路段,激光雷达安装在道路交叉口,如图3所示,包括:Embodiment 2 of the present invention provides a vehicle trajectory full-course tracking system based on distributed optical fiber and laser radar, wherein the distributed optical fiber monitoring equipment is installed on a road section without intersections, and the laser radar is installed at a road intersection, as shown in FIG3 , including:
轨迹数据获取模块,被配置为:获取由分布式光纤监测设备和激光雷达识别到的在途目标状态数据,建立在途目标实时状态数据库,在途目标被分配识别编号;The trajectory data acquisition module is configured to: acquire the state data of the in-transit targets identified by the distributed optical fiber monitoring equipment and the laser radar, establish a real-time state database of the in-transit targets, and assign identification numbers to the in-transit targets;
时间序列生成模块,被配置为:在分布式光纤监测设备和激光雷达的识别交叉区域,获取由分布式光纤监测设备识别到的第一目标位置时间序列,以及由激光雷达识别到的第二目标位置时间序列;The time series generation module is configured to: obtain a first target position time series identified by the distributed optical fiber monitoring device and a second target position time series identified by the laser radar in an identification intersection area of the distributed optical fiber monitoring device and the laser radar;
相似性判断模块,被配置为:经坐标系转换后,判断第一目标位置时间序列与第二目标位置时间序列的相似性,如果相似性大于设定阈值,则认为两条目标位置时间序列来自同一在途目标;The similarity judgment module is configured to: judge the similarity between the first target position time series and the second target position time series after the coordinate system conversion, and if the similarity is greater than a set threshold, it is considered that the two target position time series are from the same en-route target;
全程轨迹生成模块,被配置为:将此在途目标的监测数据合并后更新在途目标实时状态数据库,结合分布式光纤和激光雷达单独识别到的车辆轨迹,得到此在途目标的全程轨迹。The full-course trajectory generation module is configured to merge the monitoring data of the in-course target and update the real-time status database of the in-course target, and combine the vehicle trajectories independently identified by the distributed optical fiber and the laser radar to obtain the full-course trajectory of the in-course target.
所述系统的各个模块的工作方法与实施例1中提供的S1-S4的过程相同,这里不再赘述。The working methods of each module of the system are the same as the processes S1-S4 provided in Example 1, and will not be repeated here.
实施例3:Embodiment 3:
本发明实施例3提供了一种计算机可读存储介质,其上存储有程序,该程序被处理器执行时实现如本发明实施例1所述的基于分布式光纤与激光雷达的车辆轨迹全程追踪方法中的步骤。Embodiment 3 of the present invention provides a computer-readable storage medium having a program stored thereon, which, when executed by a processor, implements the steps in the method for full-course tracking of vehicle trajectories based on distributed optical fiber and laser radar as described in Embodiment 1 of the present invention.
实施例4:Embodiment 4:
本发明实施例4提供了一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的程序,所述处理器执行所述程序时实现如本发明实施例1所述的基于分布式光纤与激光雷达的车辆轨迹全程追踪方法中的步骤。Embodiment 4 of the present invention provides an electronic device, including a memory, a processor, and a program stored in the memory and executable on the processor. When the processor executes the program, the steps in the method for full-course tracking of vehicle trajectories based on distributed optical fiber and laser radar as described in Embodiment 1 of the present invention are implemented.
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.
Claims (9)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410591409.9A CN118172938B (en) | 2024-05-14 | 2024-05-14 | Vehicle trajectory full-course tracking method based on distributed optical fiber and laser radar |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410591409.9A CN118172938B (en) | 2024-05-14 | 2024-05-14 | Vehicle trajectory full-course tracking method based on distributed optical fiber and laser radar |
Publications (2)
Publication Number | Publication Date |
---|---|
CN118172938A CN118172938A (en) | 2024-06-11 |
CN118172938B true CN118172938B (en) | 2024-07-23 |
Family
ID=91351324
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202410591409.9A Active CN118172938B (en) | 2024-05-14 | 2024-05-14 | Vehicle trajectory full-course tracking method based on distributed optical fiber and laser radar |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN118172938B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118349694B (en) * | 2024-06-17 | 2024-08-20 | 山东大学 | Method and system for generating ramp converging region vehicle track database |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110045390A (en) * | 2019-05-23 | 2019-07-23 | 李俊 | A kind of optical-fiber laser radar train recognition methods based on energy spectral factorization |
CN115410403A (en) * | 2022-04-19 | 2022-11-29 | 北京见合八方科技发展有限公司 | Passive perception-based road vehicle positioning and tracking method and device and readable medium |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112703506B (en) * | 2020-04-22 | 2022-04-08 | 华为技术有限公司 | Lane line detection method and device |
US20230134717A1 (en) * | 2021-11-04 | 2023-05-04 | Board Of Regents Of The Nevada System Of Higher Education, On Behalf Of The University Of Nevada | METHODS AND SYSTEMS FOR PROCESSING AND INTERPRETING ROADSIDE LiDAR DATA |
CN117008129A (en) * | 2023-07-17 | 2023-11-07 | 清华大学 | Vehicle track analysis method, device, apparatus, medium and program product |
-
2024
- 2024-05-14 CN CN202410591409.9A patent/CN118172938B/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110045390A (en) * | 2019-05-23 | 2019-07-23 | 李俊 | A kind of optical-fiber laser radar train recognition methods based on energy spectral factorization |
CN115410403A (en) * | 2022-04-19 | 2022-11-29 | 北京见合八方科技发展有限公司 | Passive perception-based road vehicle positioning and tracking method and device and readable medium |
Also Published As
Publication number | Publication date |
---|---|
CN118172938A (en) | 2024-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11536575B2 (en) | Information processing device, measurement device and control method | |
US9563808B2 (en) | Target grouping techniques for object fusion | |
JP6197393B2 (en) | Lane map generation device and program | |
JP5162849B2 (en) | Fixed point position recorder | |
JP5301448B2 (en) | Analysis method around the vehicle | |
CN109144072A (en) | A kind of intelligent robot barrier-avoiding method based on three-dimensional laser | |
CN106781478B (en) | A Trajectory Tracking Method Based on LTE Signaling Data | |
CN105788273A (en) | Urban intersection automatic identification method based on low precision space-time trajectory data | |
JP5404861B2 (en) | Stationary object map generator | |
CN109101939B (en) | Method, system, terminal and readable storage medium for determining vehicle motion state | |
CN102879003A (en) | GPS (global position system) terminal-based map matching method for vehicle position tracking | |
CN110779534A (en) | System for creating a vehicle environment model | |
JP2016180980A (en) | Information processing device, program, and map data updating system | |
CN109100730A (en) | A method for multi-vehicle cooperative rapid map building | |
CN118172938B (en) | Vehicle trajectory full-course tracking method based on distributed optical fiber and laser radar | |
JP2016057750A (en) | Estimation device and program of own vehicle travel lane | |
Blazquez et al. | Simple map-matching algorithm applied to intelligent winter maintenance vehicle data | |
JP2008065087A (en) | Stationary object map generator | |
CN111033591B (en) | Method and server device for determining the course of a road lane of a road network | |
CN113743171A (en) | Target detection method and device | |
CN114973195A (en) | Vehicle tracking method, device and system based on multi-information fusion | |
Trogh et al. | Map matching and lane detection based on Markovian behavior, GIS, and IMU data | |
CN115792891A (en) | Target track tracking method based on fusion of multi-millimeter-wave radar and laser radar | |
JP2017072423A (en) | Estimation device, control method, program, and storage medium | |
JP2023174739A (en) | Data structure, information processing device, and map data generator |
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 |