WO2022199440A1 - Roadside radar calibration method and apparatus, computer device, and storage medium - Google Patents

Roadside radar calibration method and apparatus, computer device, and storage medium Download PDF

Info

Publication number
WO2022199440A1
WO2022199440A1 PCT/CN2022/081142 CN2022081142W WO2022199440A1 WO 2022199440 A1 WO2022199440 A1 WO 2022199440A1 CN 2022081142 W CN2022081142 W CN 2022081142W WO 2022199440 A1 WO2022199440 A1 WO 2022199440A1
Authority
WO
WIPO (PCT)
Prior art keywords
radar
coordinate
lane
positioning
center line
Prior art date
Application number
PCT/CN2022/081142
Other languages
French (fr)
Chinese (zh)
Inventor
魏吉敏
张长隆
佘咸宁
王泽涛
Original Assignee
长沙智能驾驶研究院有限公司
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 长沙智能驾驶研究院有限公司 filed Critical 长沙智能驾驶研究院有限公司
Publication of WO2022199440A1 publication Critical patent/WO2022199440A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/40Means for monitoring or calibrating

Definitions

  • the present application relates to the technical field of intelligent transportation, and in particular, to a roadside radar calibration method, device, computer equipment and storage medium.
  • the roadside perception system plays an increasingly important role. It senses the road in real time by arranging sensors (including cameras, millimeter-wave radar, lidar, etc.) Traffic information and real-time transmission of perception information to vehicles on the road can effectively make up for the blind spot of vehicle perception and improve the safety of traffic.
  • sensors including cameras, millimeter-wave radar, lidar, etc.
  • the roadside radar In the intelligent traffic scenario, for the roadside radar, it is necessary to obtain the positioning data of the target, and the data of the roadside perception is represented by the radar coordinate system. Therefore, the parameters of the roadside radar need to be calibrated.
  • the traditional way of calibrating the roadside radar requires the coordination of a calibration object (such as a corner reflector) with a positioning function on the road, which is cumbersome to operate, and the calibration process is time-consuming and labor-intensive.
  • a roadside radar calibration method comprising:
  • the parameters of the roadside radar are calibrated according to the radar coordinate information of the lane center line and the first positioning coordinate information.
  • extracting vehicle driving coordinate data on each lane from the vehicle driving coordinate data including:
  • the vehicle travel coordinate data on each lane is extracted.
  • the obtaining the first positioning coordinate information of the lane center line in the positioning coordinate system includes:
  • the obtaining the first positioning coordinate information of the lane center line in the positioning coordinate system includes:
  • the first positioning coordinate information of the lane center line in the positioning coordinate system obtained by the positioning vehicle traveling in each lane is acquired.
  • the vehicle driving coordinate data on each lane is fitted to obtain the radar coordinate information of the lane center line in the radar coordinate system, including:
  • performing parameter calibration on the roadside radar according to the radar coordinate information of the lane centerline and the first positioning coordinate information including:
  • the radar coordinate information convert the coordinate point of the lane center line to the positioning coordinate system, and obtain the positioning coordinate point of the coordinate point after the conversion of the positioning coordinate system;
  • the calibration parameters of the roadside radar are obtained with the goal of minimizing the distance between the transformed positioning coordinate point and the first positioning coordinate point.
  • the objective function of the target satisfies the following constraints: the distance difference between the first distance and the second distance satisfies a distance deviation threshold, and the first distance is the converted location point and the road The distance between the positioning coordinate point of the side radar in the positioning coordinate system; the second distance is the distance between the radar coordinate point and the radar of the lane center line in the radar coordinate system.
  • a roadside radar calibration device comprising:
  • the acquisition module is used to acquire the vehicle traveling coordinate data on the road for a period of time collected by the roadside radar;
  • a lane data extraction module for extracting vehicle travel coordinate data on each lane from the vehicle travel coordinate data
  • a fitting module used for fitting the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system
  • a positioning information acquisition module used for acquiring the first positioning coordinate information of the lane center line in the positioning coordinate system
  • a calibration module configured to perform parameter calibration on the roadside radar according to the radar coordinate information of the lane center line and the first positioning coordinate information.
  • a computer device includes a memory and a processor, the memory stores a computer program, and the processor implements the following steps when executing the computer program:
  • the parameters of the roadside radar are calibrated according to the radar coordinate information of the lane center line and the first positioning coordinate information.
  • a computer-readable storage medium on which a computer program is stored the memory stores a computer program, and the processor implements the following steps when executing the computer program:
  • the parameters of the roadside radar are calibrated according to the radar coordinate information of the lane center line and the first positioning coordinate information.
  • the above roadside radar calibration method, device, computer equipment and storage medium based on the vehicle driving coordinate data collected by the roadside radar, fit to obtain the radar coordinate information of the lane center line in the radar coordinate system, and obtain the lane center line in the positioning coordinate information.
  • the first positioning coordinate information is used to calibrate the parameters of the roadside radar according to the coordinate information of the lane line in the two coordinate systems.
  • the radar coordinate information of the lane center line in the radar coordinate system is obtained by lane segmentation and fitting according to the data collected by the roadside radar, without the need to assist other calibration objects, so it can be directly processed by the radar data of ordinary vehicles. , the method is simple and convenient.
  • 1 is an application environment diagram of a roadside radar calibration method in one embodiment
  • FIG. 2 is a schematic flowchart of a roadside radar calibration method in one embodiment
  • 3 is a schematic diagram of vehicle travel coordinate data in one embodiment
  • FIG. 4 is a schematic diagram of a region of interest in vehicle driving coordinate data in one embodiment
  • FIG. 5 is a schematic diagram of vehicle traveling coordinate data on a lane extracted according to the region of interest of FIG. 4 in one embodiment
  • FIG. 6 is a schematic structural diagram of roadside radar calibration in one embodiment
  • FIG. 7 is a diagram of the internal structure of a computer device in one embodiment.
  • the roadside radar calibration method provided in this application can be applied to the application environment shown in FIG. 1 .
  • it includes a roadside unit 104 disposed on one side of a road 102, an edge computing unit 106 connected to the roadside unit 104 through a network, and a vehicle 108 running on the road.
  • the roadside radar collects vehicle travel coordinate data of vehicles traveling on the road for a period of time, and sends the data to the edge computing unit 106, where the edge computing unit processes and implements the roadside radar calibration method.
  • a roadside radar calibration method is provided, and the method is applied to the edge computing unit in FIG. 1 as an example to illustrate, including the following steps:
  • Step 202 acquiring coordinate data of vehicle traveling on the road for a period of time collected by the roadside radar.
  • the roadside radar can be millimeter wave radar and lidar.
  • the location information of the target collected by the roadside radar is based on the roadside radar coordinate system, such as the millimeter wave radar coordinate system or the lidar coordinate system.
  • the roadside radar collects the radar data of the vehicles on the road for a period of time, and expresses the coordinate data of the vehicle at each time in the form of data points in the radar coordinate system to obtain the vehicle driving coordinate data, that is, the vehicle driving coordinate data is the roadside radar coordinates of the vehicle.
  • the vehicle's driving coordinate data in the form of data points in the roadside radar coordinate system through the continuity of the changes of the vehicle's coordinate points, the vehicle's driving trajectory in this time period can be obtained.
  • the vehicle driving coordinate data in one embodiment is shown in FIG. 3 , and the coordinate position of the vehicle is represented by data points.
  • the vehicle is a vehicle running on the road, which can be an ordinary vehicle, and there is no need to clear the road environment for calibration, nor to set up specific networked vehicle cooperation for calibration.
  • the traditional calibration method requires only the only connected vehicle to drive on the intersection or road during calibration, and the traffic situation on the open intersection or road cannot be controlled.
  • the calibration method of the present application has no special requirements on the traffic conditions on the intersection or road, and only requires that there are normal vehicles driving at the intersection or road, which reduces the requirements for traffic control during calibration and improves the convenience of operation, so that the method is suitable for use. In urban intersections and various traffic sections of expressways, it is not affected by the traffic flow of the road section where the roadside radar is located.
  • Step 204 extracting vehicle traveling coordinate data on each lane from the vehicle traveling coordinate data.
  • Lanes also known as lanes and lanes, are roads used for vehicles to travel. There are settings on general roads and highways. If a road has three lanes, it has three lanes, and the vehicle can drive in three lanes.
  • the vehicle travel coordinate data on the lane is identified.
  • the roadside radar data and the position data of the lane line can be fused, and the lane line can be marked on the vehicle traveling coordinate data, so as to extract the vehicle traveling coordinate data on the lane.
  • the area of interest in the vehicle driving coordinate data delineated according to the distribution characteristics of the lanes and the coordinate changes of the vehicle is obtained, and the area of interest corresponds to the lane area; Vehicle travel coordinate data.
  • the distribution characteristics of the lanes include the number of lanes and the characteristics of the lane curve.
  • the number of lanes refers to the number of lanes on the road, for example, the number of lanes corresponding to two lanes is 2, or the number of lanes corresponding to three lanes is 3.
  • the lane curve feature refers to the shape of the lane corresponding to the detection range of the roadside radar. The lane shape usually matches the road shape.
  • the lane curve feature reflects the curvature of the lane line of the lane, for example, the lane in one area is a straight line, and the lane in one area is a curve with a certain curvature.
  • the distribution characteristics of the vehicle lanes can only roughly determine the lane data and shape, and cannot realize the segmentation of the vehicle travel coordinate data of the lanes.
  • the vehicle traveling trajectory in this time period can be obtained through the continuity of the vehicle coordinate point changes. Therefore, combined with the coordinate changes of the vehicle driving and the distribution characteristics of the lanes embodied in the vehicle driving coordinate data, an area of interest corresponding to the vehicle driving coordinate data range driving along the fixed lane is delineated in the vehicle driving coordinate data, and driving along the fixed lane.
  • the vehicle driving coordinate data of must be in the lane area, therefore, the area of interest corresponds to the lane area, and specifically, the area of interest is within the range of the lane area.
  • the area of interest delineated in the vehicle driving coordinate data is shown in FIG.
  • area A and area B indicate that there is a lane change
  • two interest areas C and D in FIG. 4 can be determined.
  • the shape of represents the two lanes on the road, and the coordinate points in the area of interest are the coordinate data of the vehicle traveling along the fixed lane.
  • the vehicle driving coordinate data of the corresponding lane extracted from the region of interest is shown in FIG. 5 .
  • the coordinate data of vehicles changing lanes are excluded.
  • the vehicle driving coordinate data range is demarcated along the fixed lane to obtain the area of interest.
  • extracting the coordinates of the centerlines of multiple lanes in the roadside radar coordinate system requires clustering the coordinates of the targets detected by the roadside radar.
  • Common clustering methods include k-means, DBSCAN clustering, etc. Due to the irregularity of the target area detected by the roadside radar, the k-means method cannot be used for clustering, and at the same time, different lanes are in the roadside radar coordinate system due to vehicle lane changes. There is a connection in , so it cannot be distinguished by DBSCAN clustering method.
  • the area of interest in the vehicle driving coordinate data is delineated according to the distribution characteristics of the lane and the coordinate changes of the vehicle driving, and then according to the interest area
  • the area extracts the vehicle traveling coordinate data on the lane, and can eliminate the coordinate data of the lane changing lane to obtain the vehicle traveling coordinate data of at least one lane.
  • Step 206 fitting the vehicle traveling coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system.
  • the fitting method may be polynomial fitting. Specifically, polynomial fitting is performed on the vehicle driving coordinate data in each lane to obtain the trajectory of the lane center line in the roadside radar coordinate system; the trajectory of the lane center line in the roadside radar coordinate system is sampled to obtain the lane center The radar coordinate information of the line in the roadside radar coordinate system. Specifically, by performing polynomial fitting on the roadside coordinate data corresponding to each lane, the trajectory of the lane centerline in the roadside radar coordinate system can be obtained.
  • y radar a+b*x radar +c*x radar 2 +d*x radar 3
  • the polynomial parameters a, b, c, d in the formula can be obtained by the least square method. After obtaining the polynomial trajectory of each lane, evenly select N (N is an integer greater than 3) sampling points in each lane to realize the sampling of the lane centerline in the roadside radar coordinate system, and obtain N roadsides for each lane centerline radar coordinates
  • Step 208 Obtain first positioning coordinate information of the lane center line in the positioning coordinate system.
  • the positioning coordinate system refers to the coordinate system that realizes the positioning function.
  • the positioning coordinate system can be the GPS coordinate system that realizes GPS positioning.
  • the GPS coordinate system is the WGS-84 coordinate system (World Geodetic System 1984 Coordinate System, an The positioning coordinate system can also be the Beidou coordinate system for realizing Beidou positioning, or the GLONASS coordinate system.
  • the first positioning coordinate information of the lane center line in the positioning coordinate system is obtained from the high-precision map.
  • the domestic high-precision map adopts the OpenDRIVE format standard
  • the OpenDRIVE format standard contains the WGS-84 coordinates corresponding to the centerline of each lane or virtual lane (intersection).
  • the first positioning coordinate information of the lane center line in the positioning coordinate system obtained by the positioning vehicle traveling in each lane is acquired.
  • Positioning vehicles with positioning functions such as connected vehicles with RTK positioning function, can use the connected vehicles with RTK positioning function to drive once in each lane to obtain the WGS-84 coordinates of the center line of each lane (including longitude and latitude) .
  • Step 210 Perform parameter calibration on the roadside radar according to the radar coordinate information of the lane center line and the first positioning coordinate information.
  • the radar coordinate information is the representation of the lane centerline in the roadside radar coordinate system
  • the first positioning coordinate information is the representation of the lane centerline in the positioning coordinate system.
  • the roadside can be realized.
  • the radar is calibrated relative to the parameters of the positioning system, so that the position information of the target collected by the roadside radar can be converted into the positioning system coordinate system by using the parameters, and the coordinates of the target in the positioning coordinate system can be directly input. That is to say, roadside radar calibration is ultimately to obtain the positioning position of the target (such as GPS positioning)
  • the coordinate point of the lane center line is converted to the positioning coordinate system, and the positioning coordinate point of the coordinate point after the conversion of the positioning coordinate system is obtained; after the conversion to the positioning coordinate system, in the first positioning coordinate information Obtain the first positioning coordinate point closest to the converted coordinate point; with the goal of minimizing the distance between the converted positioning coordinate point and the first positioning coordinate point, the calibration parameters of the roadside radar are obtained.
  • mapping relationship between the roadside radar coordinate system and the positioning coordinate system is as follows:
  • the parameters of the objective function need to meet the following distance constraints: the distance difference between the first distance and the second distance satisfies the distance deviation threshold, and the first distance is the difference between the converted positioning point and the positioning coordinate point of the roadside radar in the positioning coordinate system. Distance; the second distance is the distance between the center line of the lane in the radar coordinate system and the radar coordinate point of the radar.
  • dist_th max and dist_th min are the upper and lower thresholds of the distance deviation, respectively, which are adjusted according to the actual situation.
  • nonlinear optimization methods such as effective set method, sequential quadratic programming method, interior point method, genetic algorithm, particle swarm optimization, etc.
  • This method can be applied to the calibration of roadside lidar, or the calibration of roadside millimeter-wave radar.
  • the above roadside radar calibration method based on the vehicle driving coordinate data collected by the roadside radar, fits the radar coordinate information of the lane center line in the radar coordinate system, and obtains the first positioning coordinate information of the lane center line in the positioning coordinate information.
  • the coordinate information of the lane line in the two coordinate systems is used to calibrate the parameters of the roadside radar.
  • the radar coordinate information of the lane center line in the radar coordinate system is obtained by lane segmentation and fitting according to the data collected by the roadside radar, without the need to assist other calibration objects, so it can be directly processed by the radar data of ordinary vehicles. , the method is simple and convenient.
  • a roadside radar calibration device including:
  • the acquisition module 602 is used for acquiring the vehicle traveling coordinate data on the road for a period of time collected by the roadside radar;
  • a lane data extraction module 604 configured to extract vehicle travel coordinate data on each lane from the vehicle travel coordinate data
  • the fitting module 606 is used for fitting the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system;
  • a positioning information obtaining module 608, configured to obtain the first positioning coordinate information of the lane center line in the positioning coordinate system
  • the calibration module 610 is configured to perform parameter calibration on the roadside radar according to the radar coordinate information of the lane center line and the first positioning coordinate information.
  • the above roadside radar calibration device based on the vehicle driving coordinate data collected by the roadside radar, fits to obtain the radar coordinate information of the lane center line in the radar coordinate system, and obtains the first positioning coordinate information of the lane center line in the positioning coordinate information.
  • the coordinate information of the line in the two coordinate systems is used to calibrate the parameters of the roadside radar.
  • the radar coordinate information of the lane center line in the radar coordinate system is obtained by lane segmentation and fitting according to the data collected by the roadside radar, without the need to assist other calibration objects, so it can be directly processed by the radar data of ordinary vehicles. , the method is simple and convenient.
  • a lane data extraction module is configured to obtain an area of interest in the vehicle driving coordinate data delineated according to the distribution characteristics of the lane and the coordinate changes of vehicle driving, and the area of interest corresponds to the lane area; area, and extract the vehicle travel coordinate data on each lane.
  • the positioning information obtaining module is configured to obtain the first positioning coordinate information of the lane center line in the positioning coordinate system from the high-precision map.
  • the positioning information acquisition module is configured to acquire the first positioning coordinate information of the center line of the lane in the positioning coordinate system obtained by the positioning vehicle traveling in each lane and collecting.
  • the fitting module is configured to perform polynomial fitting on the vehicle driving coordinate data on each lane to obtain the trajectory of the lane centerline in the roadside radar coordinate system; the lane centerline is in the roadside radar coordinates The trajectory in the system is sampled to obtain the radar coordinate information of the lane center line in the roadside radar coordinate system.
  • the calibration module is configured to convert the coordinate point of the lane center line to the positioning coordinate system according to the radar coordinate information, and obtain the positioning coordinate point of the coordinate point after the conversion of the positioning coordinate system;
  • the first positioning coordinate point closest to the converted coordinate point is obtained from the information;
  • the calibration parameters of the roadside radar are obtained with the goal of minimizing the distance between the converted positioning coordinate point and the first positioning coordinate point.
  • the objective function of the target satisfies the following constraints: the distance difference between the first distance and the second distance satisfies the distance deviation threshold, and the first distance is the distance between the converted positioning point and the positioning coordinate point of the roadside radar in the positioning coordinate system; The second distance is the distance between the radar coordinate point and the radar of the lane center line in the radar coordinate system.
  • each module in the above-mentioned roadside radar calibration device may be implemented in whole or in part by software, hardware and combinations thereof.
  • the above-mentioned modules can be embedded in or independent of the processor in the computer device in the form of hardware, or can be stored in the memory in the computer device in the form of software, so that the processor can call and execute the corresponding operations of the above-mentioned modules.
  • a computer device may be an edge computing unit, and an internal structure diagram of which may be shown in FIG. 7 .
  • the computer device includes a processor, memory, and a communication interface connected by a system bus. Among them, the processor of the computer device is used to provide computing and control capabilities.
  • the memory of the computer device includes a non-volatile storage medium, an internal memory.
  • the nonvolatile storage medium stores an operating system and a computer program.
  • the internal memory provides an environment for the execution of the operating system and computer programs in the non-volatile storage medium.
  • the communication interface of the computer device is used for wired or wireless communication with an external terminal, and the wireless communication can be realized by WIFI, operator network, NFC (Near Field Communication) or other technologies.
  • the computer program when executed by the processor, implements a roadside radar calibration method.
  • FIG. 7 is only a block diagram of a partial structure related to the solution of the present application, and does not constitute a limitation on the computer equipment to which the solution of the present application is applied. Include more or fewer components than shown in the figures, or combine certain components, or have a different arrangement of components.
  • a computer device including a memory and a processor, where a computer program is stored in the memory, and the processor implements the methods of the foregoing embodiments when the processor executes the computer program.
  • a computer-readable storage medium on which a computer program is stored, and when the computer program is executed by a processor, implements the methods of the foregoing embodiments.
  • Non-volatile memory may include read-only memory (Read-Only Memory, ROM), magnetic tape, floppy disk, flash memory, or optical memory, and the like.
  • Volatile memory may include random access memory (RAM) or external cache memory.
  • RAM can be in various forms, such as static random access memory (Static Random Access Memory, SRAM) or dynamic random access memory (Dynamic Random Access Memory, DRAM).

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Traffic Control Systems (AREA)

Abstract

The present application relates to a roadside radar calibration method and apparatus, a computer device, and a storage medium. The method comprises: acquiring vehicle traveling coordinate data on a road for a period of time collected by a roadside radar; extracting vehicle traveling coordinate data on each lane from the vehicle traveling coordinate data; fitting the vehicle traveling coordinate data on each lane to obtain radar coordinate information of a lane center line in a radar coordinate system; acquiring first positioning coordinate information of the lane center line in a positioning coordinate system; and performing parameter calibration on the roadside radar according to the radar coordinate information and the first positioning coordinate information of the lane center line. The method is simple to operate and is convenient.

Description

路侧雷达标定方法、装置、计算机设备和存储介质Roadside radar calibration method, device, computer equipment and storage medium 技术领域technical field
本申请涉及智能交通技术领域,特别是涉及一种路侧雷达标定方法、装置、计算机设备和存储介质。The present application relates to the technical field of intelligent transportation, and in particular, to a roadside radar calibration method, device, computer equipment and storage medium.
背景技术Background technique
随着智能交通系统和智能网联汽车产业的发展,路侧感知系统发挥着越来越重要的作用,它通过在路侧布置传感器(包括摄像头、毫米波雷达、激光雷达等)实时感知道路上交通信息并实时将感知信息发送给行驶在道路上的车辆,能够有效弥补车载感知的盲区,提升交通通行的安全性。With the development of the intelligent transportation system and the intelligent networked automobile industry, the roadside perception system plays an increasingly important role. It senses the road in real time by arranging sensors (including cameras, millimeter-wave radar, lidar, etc.) Traffic information and real-time transmission of perception information to vehicles on the road can effectively make up for the blind spot of vehicle perception and improve the safety of traffic.
在智能交通场景,对于路侧雷达来说,需要获得目标的定位数据,而路侧感知的数据是用雷达坐标系表示,因此,需要对路侧雷达进行参数标定。传统的对路侧雷达进行标定的方式,需要在道路上具有定位功能的标定物(如角反射器)配合,操作繁琐,标定过程费时费力。In the intelligent traffic scenario, for the roadside radar, it is necessary to obtain the positioning data of the target, and the data of the roadside perception is represented by the radar coordinate system. Therefore, the parameters of the roadside radar need to be calibrated. The traditional way of calibrating the roadside radar requires the coordination of a calibration object (such as a corner reflector) with a positioning function on the road, which is cumbersome to operate, and the calibration process is time-consuming and labor-intensive.
发明内容SUMMARY OF THE INVENTION
基于此,有必要针对上述技术问题,提供一种能够方便快捷的路侧雷达标定方法、装置、计算机设备和存储介质。Based on this, it is necessary to provide a roadside radar calibration method, device, computer equipment and storage medium that can be convenient and quick to address the above technical problems.
一种路侧雷达标定方法,所述方法包括:A roadside radar calibration method, the method comprising:
获取路侧雷达采集的一段时间道路上的车辆行驶坐标数据;Obtain the vehicle driving coordinate data on the road for a period of time collected by the roadside radar;
从所述车辆行驶坐标数据提取各车道上的车辆行驶坐标数据;extracting vehicle driving coordinate data on each lane from the vehicle driving coordinate data;
对各车道上的所述车辆行驶坐标数据进行拟合,得到车道中心线在雷达坐标系的雷达坐标信息;Fitting the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system;
获取车道中心线在定位坐标系的第一定位坐标信息;Obtain the first positioning coordinate information of the lane center line in the positioning coordinate system;
根据所述车道中心线的所述雷达坐标信息和所述第一定位坐标信息对路侧雷达进行参数标定。The parameters of the roadside radar are calibrated according to the radar coordinate information of the lane center line and the first positioning coordinate information.
在其中一个实施例中,从所述车辆行驶坐标数据提取各车道上的车辆行驶 坐标数据,包括:In one embodiment, extracting vehicle driving coordinate data on each lane from the vehicle driving coordinate data, including:
获取根据车道的分布特征以及车辆行驶的坐标变化划定的所述车辆行驶坐标数据中的感兴趣区域,所述感兴趣区域与车道区域对应;acquiring an area of interest in the vehicle driving coordinate data delineated according to the distribution characteristics of the lanes and the coordinate changes of the vehicle driving, and the area of interest corresponds to the lane area;
根据所述感兴趣区域,提取在各车道上的车辆行驶坐标数据。According to the region of interest, the vehicle travel coordinate data on each lane is extracted.
在其中一个实施例中,所述获取车道中心线在定位坐标系的第一定位坐标信息,包括:In one embodiment, the obtaining the first positioning coordinate information of the lane center line in the positioning coordinate system includes:
从高精度地图中,获取所述车道中心线在定位坐标系的第一定位坐标信息。Obtain the first positioning coordinate information of the lane center line in the positioning coordinate system from the high-precision map.
在其中一个实施例中,所述获取车道中心线在定位坐标系的第一定位坐标信息,包括:In one embodiment, the obtaining the first positioning coordinate information of the lane center line in the positioning coordinate system includes:
获取定位车辆在各车道行驶采集得到的所述车道中心线在定位坐标系的第一定位坐标信息。The first positioning coordinate information of the lane center line in the positioning coordinate system obtained by the positioning vehicle traveling in each lane is acquired.
在其中一个实施例中,所述对各车道上的所述车辆行驶坐标数据进行拟合,得到车道中心线在雷达坐标系的雷达坐标信息,包括:In one embodiment, the vehicle driving coordinate data on each lane is fitted to obtain the radar coordinate information of the lane center line in the radar coordinate system, including:
对各车道上的所述车辆行驶坐标数据进行多项式拟合,得到车道中心线在路侧雷达坐标系中的轨迹;Perform polynomial fitting on the vehicle driving coordinate data on each lane to obtain the trajectory of the lane center line in the roadside radar coordinate system;
在所述车道中心线在路侧雷达坐标系中的轨迹进行采样,得到车道中心线在所述路侧雷达坐标系的雷达坐标信息。Sampling the trajectory of the lane centerline in the roadside radar coordinate system to obtain radar coordinate information of the lane centerline in the roadside radar coordinate system.
在其中一个实施例中,根据所述车道中心线的所述雷达坐标信息和所述第一定位坐标信息对路侧雷达进行参数标定,包括:In one embodiment, performing parameter calibration on the roadside radar according to the radar coordinate information of the lane centerline and the first positioning coordinate information, including:
根据所述雷达坐标信息,将所述车道中心线的坐标点转换到定位坐标系,得到该坐标点在定位坐标系的转换后定位坐标点;According to the radar coordinate information, convert the coordinate point of the lane center line to the positioning coordinate system, and obtain the positioning coordinate point of the coordinate point after the conversion of the positioning coordinate system;
在所述第一定位坐标信息中获取与所述转换后坐标点距离最近的第一定位坐标点;Obtain the first positioning coordinate point closest to the converted coordinate point in the first positioning coordinate information;
以最小化所述转换后定位坐标点和第一定位坐标点的距离为目标,得到路侧雷达的标定参数。The calibration parameters of the roadside radar are obtained with the goal of minimizing the distance between the transformed positioning coordinate point and the first positioning coordinate point.
在其中一个实施例中,所述目标的目标函数满足以下约束条件:第一距离和第二距离的距离差值满足距离偏差阈值,所述第一距离为所述转换后定位点与所述路侧雷达在定位坐标系的定位坐标点的距离;所述第二距离为车道中心线 在雷达坐标系下雷达坐标点与雷达的距离。In one of the embodiments, the objective function of the target satisfies the following constraints: the distance difference between the first distance and the second distance satisfies a distance deviation threshold, and the first distance is the converted location point and the road The distance between the positioning coordinate point of the side radar in the positioning coordinate system; the second distance is the distance between the radar coordinate point and the radar of the lane center line in the radar coordinate system.
一种路侧雷达标定装置,所述装置包括:A roadside radar calibration device, the device comprising:
采集模块,用于获取路侧雷达采集的一段时间道路上的车辆行驶坐标数据;The acquisition module is used to acquire the vehicle traveling coordinate data on the road for a period of time collected by the roadside radar;
车道数据提取模块,用于从所述车辆行驶坐标数据提取各车道上的车辆行驶坐标数据;a lane data extraction module for extracting vehicle travel coordinate data on each lane from the vehicle travel coordinate data;
拟合模块,用于对各车道上的所述车辆行驶坐标数据进行拟合,得到车道中心线在雷达坐标系的雷达坐标信息;a fitting module, used for fitting the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system;
定位信息获取模块,用于获取车道中心线在定位坐标系的第一定位坐标信息;a positioning information acquisition module, used for acquiring the first positioning coordinate information of the lane center line in the positioning coordinate system;
标定模块,用于根据所述车道中心线的所述雷达坐标信息和所述第一定位坐标信息对路侧雷达进行参数标定。A calibration module, configured to perform parameter calibration on the roadside radar according to the radar coordinate information of the lane center line and the first positioning coordinate information.
一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现以下步骤:A computer device includes a memory and a processor, the memory stores a computer program, and the processor implements the following steps when executing the computer program:
获取路侧雷达采集的一段时间道路上的车辆行驶坐标数据;Obtain the vehicle driving coordinate data on the road for a period of time collected by the roadside radar;
从所述车辆行驶坐标数据提取各车道上的车辆行驶坐标数据;extracting vehicle driving coordinate data on each lane from the vehicle driving coordinate data;
对各车道上的所述车辆行驶坐标数据进行拟合,得到车道中心线在雷达坐标系的雷达坐标信息;Fitting the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system;
获取车道中心线在定位坐标系的第一定位坐标信息;Obtain the first positioning coordinate information of the lane center line in the positioning coordinate system;
根据所述车道中心线的所述雷达坐标信息和所述第一定位坐标信息对路侧雷达进行参数标定。The parameters of the roadside radar are calibrated according to the radar coordinate information of the lane center line and the first positioning coordinate information.
一种计算机可读存储介质,其上存储有计算机程序,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现以下步骤:A computer-readable storage medium on which a computer program is stored, the memory stores a computer program, and the processor implements the following steps when executing the computer program:
获取路侧雷达采集的一段时间道路上的车辆行驶坐标数据;Obtain the vehicle driving coordinate data on the road for a period of time collected by the roadside radar;
从所述车辆行驶坐标数据提取各车道上的车辆行驶坐标数据;extracting vehicle driving coordinate data on each lane from the vehicle driving coordinate data;
对各车道上的所述车辆行驶坐标数据进行拟合,得到车道中心线在雷达坐 标系的雷达坐标信息;Fitting the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system;
获取车道中心线在定位坐标系的第一定位坐标信息;Obtain the first positioning coordinate information of the lane center line in the positioning coordinate system;
根据所述车道中心线的所述雷达坐标信息和所述第一定位坐标信息对路侧雷达进行参数标定。The parameters of the roadside radar are calibrated according to the radar coordinate information of the lane center line and the first positioning coordinate information.
上述路侧雷达标定方法、装置、计算机设备和存储介质,基于路侧雷达采集的车辆行驶坐标数据,拟合得到车道中心线在雷达坐标系的雷达坐标信息,获取车道中心线在定位坐标信息的第一定位坐标信息,根据车道线在两个坐标系下的坐标信息,对路侧雷达进行参数标定。该方法中,车道中心线在雷达坐标系的雷达坐标信息,根据路侧雷达采集的数据进行车道分割和拟合得到,无需辅助其它的标定物,因而可直接利用普通车辆的雷达数据进行处理得到,该方法操作简单,具有便捷性。The above roadside radar calibration method, device, computer equipment and storage medium, based on the vehicle driving coordinate data collected by the roadside radar, fit to obtain the radar coordinate information of the lane center line in the radar coordinate system, and obtain the lane center line in the positioning coordinate information. The first positioning coordinate information is used to calibrate the parameters of the roadside radar according to the coordinate information of the lane line in the two coordinate systems. In this method, the radar coordinate information of the lane center line in the radar coordinate system is obtained by lane segmentation and fitting according to the data collected by the roadside radar, without the need to assist other calibration objects, so it can be directly processed by the radar data of ordinary vehicles. , the method is simple and convenient.
附图说明Description of drawings
图1为一个实施例中路侧雷达标定方法的应用环境图;1 is an application environment diagram of a roadside radar calibration method in one embodiment;
图2为一个实施例中路侧雷达标定方法的流程示意图;2 is a schematic flowchart of a roadside radar calibration method in one embodiment;
图3为一个实施例中车辆行驶坐标数据的示意图;3 is a schematic diagram of vehicle travel coordinate data in one embodiment;
图4为一个实施例中车辆行驶坐标数据中感兴趣区域的示意图;4 is a schematic diagram of a region of interest in vehicle driving coordinate data in one embodiment;
图5为一个实施例中根据图4的感兴趣区域提取的车道上的车辆行驶坐标数据的示意图;5 is a schematic diagram of vehicle traveling coordinate data on a lane extracted according to the region of interest of FIG. 4 in one embodiment;
图6为一个实施例中路侧雷达标定的结构示意图;6 is a schematic structural diagram of roadside radar calibration in one embodiment;
图7为一个实施例中计算机设备的内部结构图。FIG. 7 is a diagram of the internal structure of a computer device in one embodiment.
具体实施方式Detailed ways
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。In order to make the purpose, technical solutions and advantages of the present application more clearly understood, the present application will be described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application, but not to limit the present application.
本申请提供的路侧雷达标定方法,可以应用于如图1所示的应用环境中。如图1所示,包括设置在道路102一侧的路侧单元104,与路侧单元104通过网 络连接的边缘计算单元106,以及行驶在道路上的车辆108。标定时,路侧雷达采集一段时间道路上行驶车辆的车辆行驶坐标数据,发送至边缘计算单元106,由边缘计算单元处理实现路侧雷达标定方法。The roadside radar calibration method provided in this application can be applied to the application environment shown in FIG. 1 . As shown in FIG. 1 , it includes a roadside unit 104 disposed on one side of a road 102, an edge computing unit 106 connected to the roadside unit 104 through a network, and a vehicle 108 running on the road. During calibration, the roadside radar collects vehicle travel coordinate data of vehicles traveling on the road for a period of time, and sends the data to the edge computing unit 106, where the edge computing unit processes and implements the roadside radar calibration method.
在一个实施例中,如图2所示,提供了一种路侧雷达标定方法,以该方法应用于图1中的边缘计算单元为例进行说明,包括以下步骤:In one embodiment, as shown in FIG. 2 , a roadside radar calibration method is provided, and the method is applied to the edge computing unit in FIG. 1 as an example to illustrate, including the following steps:
步骤202,获取路侧雷达采集的一段时间道路上的车辆行驶坐标数据。Step 202 , acquiring coordinate data of vehicle traveling on the road for a period of time collected by the roadside radar.
路侧雷达可以为毫米波雷达和激光雷达。路侧雷达采集的目标的位置信息以路侧雷达坐标系为基础,如毫米波雷达坐标系或激光雷达坐标系。路侧雷达采集一段时间道路上的车辆的雷达数据,将各时间的车辆的坐标数据在雷达坐标系以数据点形式表示,得到车辆行驶坐标数据,即车辆行驶坐标数据为车辆在路侧雷达坐标系下的车辆行驶运动的坐标数据,根据在路侧雷达坐标系下以数据点形式表示的车辆行驶坐标数据,通过车辆的坐标点变化的连续性,可以得到车辆在该时间段的行驶轨迹。一个实施例中的车辆行驶坐标数据如图3所示,以数据点表示车辆的坐标位置。The roadside radar can be millimeter wave radar and lidar. The location information of the target collected by the roadside radar is based on the roadside radar coordinate system, such as the millimeter wave radar coordinate system or the lidar coordinate system. The roadside radar collects the radar data of the vehicles on the road for a period of time, and expresses the coordinate data of the vehicle at each time in the form of data points in the radar coordinate system to obtain the vehicle driving coordinate data, that is, the vehicle driving coordinate data is the roadside radar coordinates of the vehicle. According to the coordinate data of the vehicle's driving motion in the roadside radar coordinate system, according to the vehicle's driving coordinate data in the form of data points in the roadside radar coordinate system, through the continuity of the changes of the vehicle's coordinate points, the vehicle's driving trajectory in this time period can be obtained. The vehicle driving coordinate data in one embodiment is shown in FIG. 3 , and the coordinate position of the vehicle is represented by data points.
其中,车辆为在道路上行驶的车辆,可以为普通车辆,无需为标定清理道路环境,也无需为标定设置特定的网联车配合。传统的标定方法需要标定时只有唯一的网联车在路口或者道路上行驶,而开放路口或者道路上的交通情况无法控制。本申请的标定方法对路口或者道路上的交通情况无特殊要求,只需要路口或者道路正常有车行驶即可,降低了标定时对交通管控的要求,提高了操作便捷性,从而使得该方法适用于城市路口及高速公路各种交通路段,不受路侧雷达所在路段的交通流影响。Among them, the vehicle is a vehicle running on the road, which can be an ordinary vehicle, and there is no need to clear the road environment for calibration, nor to set up specific networked vehicle cooperation for calibration. The traditional calibration method requires only the only connected vehicle to drive on the intersection or road during calibration, and the traffic situation on the open intersection or road cannot be controlled. The calibration method of the present application has no special requirements on the traffic conditions on the intersection or road, and only requires that there are normal vehicles driving at the intersection or road, which reduces the requirements for traffic control during calibration and improves the convenience of operation, so that the method is suitable for use. In urban intersections and various traffic sections of expressways, it is not affected by the traffic flow of the road section where the roadside radar is located.
步骤204,从车辆行驶坐标数据提取各车道上的车辆行驶坐标数据。Step 204 , extracting vehicle traveling coordinate data on each lane from the vehicle traveling coordinate data.
道路具有车道划分,车道,又称行车线、车行道,是用在供车辆行经的道路。在一般公路和高速公路都有设置。如一条道路为三车道,则具有三个车道,车辆可以三个车道行驶。Roads are divided into lanes. Lanes, also known as lanes and lanes, are roads used for vehicles to travel. There are settings on general roads and highways. If a road has three lanes, it has three lanes, and the vehicle can drive in three lanes.
通过对车辆行驶坐标数据,识别车道上的车辆行驶坐标数据。Through the vehicle travel coordinate data, the vehicle travel coordinate data on the lane is identified.
一种实施方式中,可将路侧雷达数据与车道线的位置数据融合,在车辆行驶坐标数据上标识车道线,以提取车道上的车辆行驶坐标数据。In one embodiment, the roadside radar data and the position data of the lane line can be fused, and the lane line can be marked on the vehicle traveling coordinate data, so as to extract the vehicle traveling coordinate data on the lane.
一种实施方式中,获取根据车道的分布特征以及车辆行驶的坐标变化划定的车辆行驶坐标数据中的感兴趣区域,感兴趣区域与车道区域对应;根据感兴趣区域,提取在各车道上的车辆行驶坐标数据。In one embodiment, the area of interest in the vehicle driving coordinate data delineated according to the distribution characteristics of the lanes and the coordinate changes of the vehicle is obtained, and the area of interest corresponds to the lane area; Vehicle travel coordinate data.
其中,车道的分布特征包括车道数量和车道曲线特征。车道数量是指道路上的车道数量,如,两车道对应的车道数量为2,或三车道对应的车道数量为3。车道曲线特征是指路侧雷达的探测范围对应的车道的形状。车道形状通常与道路形状一致。车道曲线特征体现车道的车道线条的曲度上,如,一个区域的车道为直线,一个区域的车道为具有一定曲率的曲线。Among them, the distribution characteristics of the lanes include the number of lanes and the characteristics of the lane curve. The number of lanes refers to the number of lanes on the road, for example, the number of lanes corresponding to two lanes is 2, or the number of lanes corresponding to three lanes is 3. The lane curve feature refers to the shape of the lane corresponding to the detection range of the roadside radar. The lane shape usually matches the road shape. The lane curve feature reflects the curvature of the lane line of the lane, for example, the lane in one area is a straight line, and the lane in one area is a curve with a certain curvature.
然而车辆的车道的分布特征只能够大致确定车道数据以及形状,并不能够实现车道的车辆行驶坐标数据的分割。However, the distribution characteristics of the vehicle lanes can only roughly determine the lane data and shape, and cannot realize the segmentation of the vehicle travel coordinate data of the lanes.
进一步地,本实施例中,根据在路侧雷达坐标系下以数据点形式表示的车辆行驶坐标数据,通过车辆的坐标点变化的连续性,可以得到车辆在该时间段的行驶轨迹。因此,结合车辆行驶坐标数据所体现的车辆行驶的坐标变化以及车道的分布特征,在车辆行驶坐标数据中划定与沿固定车道行驶的车辆行驶坐标数据范围对应的感兴趣区域,沿固定车道行驶的车辆行驶坐标数据是一定在车道区域内的,因而,感兴趣区域与车道区域对应,具体地,感兴趣区域在车道区域范围内。Further, in this embodiment, according to the vehicle traveling coordinate data expressed in the form of data points in the roadside radar coordinate system, the vehicle traveling trajectory in this time period can be obtained through the continuity of the vehicle coordinate point changes. Therefore, combined with the coordinate changes of the vehicle driving and the distribution characteristics of the lanes embodied in the vehicle driving coordinate data, an area of interest corresponding to the vehicle driving coordinate data range driving along the fixed lane is delineated in the vehicle driving coordinate data, and driving along the fixed lane. The vehicle driving coordinate data of , must be in the lane area, therefore, the area of interest corresponds to the lane area, and specifically, the area of interest is within the range of the lane area.
对图3的车辆行驶坐标数据,结合车辆行驶坐标数据所体现的车辆行驶的坐标变化以及车道的分布特征,在车辆行驶坐标数据中划定的感兴趣区域如图图4所示。其中,根据车辆行驶的坐标变化,区域A和区域B表示存在车道变更,根据车道分布特征可车辆行驶的坐标变化,可确定图4中的两个感兴趣区域C和D,两个感兴趣区域的形状一致,表示道路上的两条车道,在该感兴趣区域内的坐标点为沿固定车道行驶的车辆行驶坐标数据。从感兴趣区域提取的相应车道的车辆行驶坐标数据如图5所示,相对于图4完整的车辆行驶坐标数据而言,剔除了变道的车辆的坐标数据。For the vehicle driving coordinate data in FIG. 3 , the area of interest delineated in the vehicle driving coordinate data is shown in FIG. Among them, according to the coordinate change of vehicle driving, area A and area B indicate that there is a lane change, and according to the coordinate change of vehicle driving according to the lane distribution characteristics, two interest areas C and D in FIG. 4 can be determined. The shape of , represents the two lanes on the road, and the coordinate points in the area of interest are the coordinate data of the vehicle traveling along the fixed lane. The vehicle driving coordinate data of the corresponding lane extracted from the region of interest is shown in FIG. 5 . Compared with the complete vehicle driving coordinate data in FIG. 4 , the coordinate data of vehicles changing lanes are excluded.
在实际应用中,由工作人员在车辆行驶坐标数据的基础上,根据对路侧雷达探测范围的车道的分布特征,结合经验划定沿固定车道行驶的车辆行驶坐标数据范围,得到感兴趣区域。In practical applications, based on the vehicle driving coordinate data, according to the distribution characteristics of the lanes detected by the roadside radar, combined with experience, the vehicle driving coordinate data range is demarcated along the fixed lane to obtain the area of interest.
通常而言,提取路侧雷达坐标系中多条车道中心线的坐标需要对路侧雷达检测的目标的坐标进行聚类。常见的聚类方法有k-means、DBSCAN聚类等,由于路侧雷达检测的目标区域的不规则无法采用k-means方法聚类,同时不同车道由于车辆变道导致其在路侧雷达坐标系中是存在连接因而无法用DBSCAN聚类方法区分。针对在路侧雷达坐标系中提取车道中心线存在的难点,本实施例中,通过根据车道的分布特征以及车辆行驶的坐标变化划定的车辆行驶坐标数据中的感兴趣区域,进而根据感兴趣区域提取车道上的车辆行驶坐标数据,能够剔除变道的车道的坐标数据,得到至少一个车道车辆行驶坐标数据。采用该方法,无需对路侧雷达检测的目标的坐标进行聚类,只需根据感兴趣区域提取沿固定车道行驶的车辆行驶坐标数据,即可得到至少一个分割出来的车道上的车辆的坐标数据。Generally speaking, extracting the coordinates of the centerlines of multiple lanes in the roadside radar coordinate system requires clustering the coordinates of the targets detected by the roadside radar. Common clustering methods include k-means, DBSCAN clustering, etc. Due to the irregularity of the target area detected by the roadside radar, the k-means method cannot be used for clustering, and at the same time, different lanes are in the roadside radar coordinate system due to vehicle lane changes. There is a connection in , so it cannot be distinguished by DBSCAN clustering method. Aiming at the difficulty of extracting the lane center line in the roadside radar coordinate system, in this embodiment, the area of interest in the vehicle driving coordinate data is delineated according to the distribution characteristics of the lane and the coordinate changes of the vehicle driving, and then according to the interest area The area extracts the vehicle traveling coordinate data on the lane, and can eliminate the coordinate data of the lane changing lane to obtain the vehicle traveling coordinate data of at least one lane. By adopting this method, it is not necessary to cluster the coordinates of the targets detected by the roadside radar, and it is only necessary to extract the coordinate data of the vehicles traveling along the fixed lane according to the region of interest, and then the coordinate data of the vehicles on at least one segmented lane can be obtained. .
步骤206,对各车道上的车辆行驶坐标数据进行拟合得到车道中心线在雷达坐标系的雷达坐标信息。Step 206 , fitting the vehicle traveling coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system.
其中,拟合方式可以为多项式拟合。具体地,对各车道上的车辆行驶坐标数据进行多项式拟合,得到车道中心线在路侧雷达坐标系中的轨迹;在车道中心线在路侧雷达坐标系中的轨迹进行采样,得到车道中心线在路侧雷达坐标系的雷达坐标信息。具体地,通过对每个车道对应的路侧坐标数据进行多项式拟合可获得车道中心线在路侧雷达坐标系中的轨迹。The fitting method may be polynomial fitting. Specifically, polynomial fitting is performed on the vehicle driving coordinate data in each lane to obtain the trajectory of the lane center line in the roadside radar coordinate system; the trajectory of the lane center line in the roadside radar coordinate system is sampled to obtain the lane center The radar coordinate information of the line in the roadside radar coordinate system. Specifically, by performing polynomial fitting on the roadside coordinate data corresponding to each lane, the trajectory of the lane centerline in the roadside radar coordinate system can be obtained.
y radar=a+b*x radar+c*x radar 2+d*x radar 3 y radar = a+b*x radar +c*x radar 2 +d*x radar 3
其中,公式中的多项式参数a、b、c、d可以通过最小二乘法获得。获得每个车道的多项式轨迹后在每个车道均匀选取N(N为大于3的整数)采样点,实现车道中心线在路侧雷达坐标系中的采样,每条车道中心线获得N个路侧雷达坐标点
Figure PCTCN2022081142-appb-000001
Among them, the polynomial parameters a, b, c, d in the formula can be obtained by the least square method. After obtaining the polynomial trajectory of each lane, evenly select N (N is an integer greater than 3) sampling points in each lane to realize the sampling of the lane centerline in the roadside radar coordinate system, and obtain N roadsides for each lane centerline radar coordinates
Figure PCTCN2022081142-appb-000001
步骤208,获取车道中心线在定位坐标系的第一定位坐标信息。Step 208: Obtain first positioning coordinate information of the lane center line in the positioning coordinate system.
定位坐标系是指实现定位功能的坐标系,如定位坐标系可以为实现GPS定位的GPS坐标系,GPS坐标系为WGS-84坐标系(World Geodetic System 1984 Coordinate System,一种国际上采用的地心坐标系),定位坐标系还可以为实现北斗定位的北斗坐标系,还可以为GLONASS坐标系。The positioning coordinate system refers to the coordinate system that realizes the positioning function. For example, the positioning coordinate system can be the GPS coordinate system that realizes GPS positioning. The GPS coordinate system is the WGS-84 coordinate system (World Geodetic System 1984 Coordinate System, an The positioning coordinate system can also be the Beidou coordinate system for realizing Beidou positioning, or the GLONASS coordinate system.
一种实施方式中,从高精度地图中,获取车道中心线在定位坐标系的第一定位坐标信息。目前国内的高精度地图采用OpenDRIVE格式标准,在OpenDRIVE格式标准包含了每个车道或者虚拟车道(路口)中心线对应的WGS-84坐标。In one embodiment, the first positioning coordinate information of the lane center line in the positioning coordinate system is obtained from the high-precision map. At present, the domestic high-precision map adopts the OpenDRIVE format standard, and the OpenDRIVE format standard contains the WGS-84 coordinates corresponding to the centerline of each lane or virtual lane (intersection).
一种实施方式中,获取定位车辆在各车道行驶采集得到的车道中心线在定位坐标系的第一定位坐标信息。定位车辆具有定位功能,如RTK定位功能的网联车,可使用具备RTK定位功能的网联车在每个车道行驶一遍即可获取每条车道中心线的WGS-84坐标(包含经度和纬度)。In one embodiment, the first positioning coordinate information of the lane center line in the positioning coordinate system obtained by the positioning vehicle traveling in each lane is acquired. Positioning vehicles with positioning functions, such as connected vehicles with RTK positioning function, can use the connected vehicles with RTK positioning function to drive once in each lane to obtain the WGS-84 coordinates of the center line of each lane (including longitude and latitude) .
步骤210,根据车道中心线的雷达坐标信息和第一定位坐标信息对路侧雷达进行参数标定。Step 210: Perform parameter calibration on the roadside radar according to the radar coordinate information of the lane center line and the first positioning coordinate information.
具体地,雷达坐标信息是车道中心线在路侧雷达坐标系下的表示,第一定位坐标信息是车道中心线在定位坐标系下的表示,根据二者之间的映射关系,可实现路侧雷达相对于定位系统的参数标定,从而利用参数可将路侧雷达采集的目标的位置信息转换到定位系统坐标系下,直接输入目标在定位坐标系下的坐标。也就是说,路侧雷达标定最终是要获得目标的定位位置(如GPS定位)Specifically, the radar coordinate information is the representation of the lane centerline in the roadside radar coordinate system, and the first positioning coordinate information is the representation of the lane centerline in the positioning coordinate system. According to the mapping relationship between the two, the roadside can be realized. The radar is calibrated relative to the parameters of the positioning system, so that the position information of the target collected by the roadside radar can be converted into the positioning system coordinate system by using the parameters, and the coordinates of the target in the positioning coordinate system can be directly input. That is to say, roadside radar calibration is ultimately to obtain the positioning position of the target (such as GPS positioning)
具体地,根据雷达坐标信息,将车道中心线的坐标点转换到定位坐标系,得到该坐标点在定位坐标系的转换后定位坐标点;转换到定位坐标系后,在第一定位坐标信息中获取与转换后坐标点距离最近的第一定位坐标点;以最小化转换后定位坐标点和第一定位坐标点的距离为目标,得到路侧雷达的标定参数。Specifically, according to the radar coordinate information, the coordinate point of the lane center line is converted to the positioning coordinate system, and the positioning coordinate point of the coordinate point after the conversion of the positioning coordinate system is obtained; after the conversion to the positioning coordinate system, in the first positioning coordinate information Obtain the first positioning coordinate point closest to the converted coordinate point; with the goal of minimizing the distance between the converted positioning coordinate point and the first positioning coordinate point, the calibration parameters of the roadside radar are obtained.
其中,路侧雷达坐标系与定位坐标系的映射关系如下所示:Among them, the mapping relationship between the roadside radar coordinate system and the positioning coordinate system is as follows:
Figure PCTCN2022081142-appb-000002
Figure PCTCN2022081142-appb-000002
其中,
Figure PCTCN2022081142-appb-000003
分别表示车道中心线第i个点雷达坐标点的x坐标和y坐标,单位为m,lon i表示车道中心线第i个雷达坐标点映射的定位坐标系中的经度,单位为deg;lat i表示车道中心线第i个雷达坐标映射的定位坐标系中的纬度,a 1,a 2,b 1,b 2,c 1,c 2为标定参数。标定的过程关键是如何求取上述公式中的标定参数x=[a 1 b 1 c 1 a 2 b 2 c 2],让车道中心线的雷达坐标与第一定位坐标信息对应起来。
in,
Figure PCTCN2022081142-appb-000003
Represents the x-coordinate and y-coordinate of the radar coordinate point of the ith point of the lane center line, the unit is m, lon i represents the longitude in the positioning coordinate system mapped by the ith radar coordinate point of the lane center line, the unit is deg; lat i Indicates the latitude in the positioning coordinate system of the ith radar coordinate mapping of the lane centerline, a 1 , a 2 , b 1 , b 2 , c 1 , c 2 are calibration parameters. The key to the calibration process is how to obtain the calibration parameter x=[a 1 b 1 c 1 a 2 b 2 c 2 ] in the above formula, so that the radar coordinates of the lane center line correspond to the first positioning coordinate information.
具体地,定义了如下目标的目标函数:Specifically, the objective function of the following objectives is defined:
Figure PCTCN2022081142-appb-000004
Figure PCTCN2022081142-appb-000004
or
Figure PCTCN2022081142-appb-000005
Figure PCTCN2022081142-appb-000005
其中,
Figure PCTCN2022081142-appb-000006
是通过映射关系计算获得的雷达坐标数据中车道中心线的点在定位坐标系的转换后定位坐标点,
Figure PCTCN2022081142-appb-000007
为转换后定位坐标点
Figure PCTCN2022081142-appb-000008
离车道中心线中最近的一定位坐标点(包含经度和纬度),即第一定位点坐标点,N为选取的每条车道中心线对应路雷达坐标总数量,M为车道的总数量。
in,
Figure PCTCN2022081142-appb-000006
is the point of the lane center line in the radar coordinate data obtained by the mapping relationship calculation after the transformation of the positioning coordinate system to locate the coordinate point,
Figure PCTCN2022081142-appb-000007
Position the coordinates for the transformed point
Figure PCTCN2022081142-appb-000008
A positioning coordinate point (including longitude and latitude) closest to the lane center line, that is, the first positioning point coordinate point, N is the total number of road radar coordinates corresponding to each selected lane center line, and M is the total number of lanes.
同时目标函数的参数需要满足如下的距离约束条件:第一距离和第二距离的距离差值满足距离偏差阈值,第一距离为转换后定位点与路侧雷达在定位坐标系的定位坐标点的距离;第二距离为车道中心线在雷达坐标系雷达坐标点与雷达的距离。At the same time, the parameters of the objective function need to meet the following distance constraints: the distance difference between the first distance and the second distance satisfies the distance deviation threshold, and the first distance is the difference between the converted positioning point and the positioning coordinate point of the roadside radar in the positioning coordinate system. Distance; the second distance is the distance between the center line of the lane in the radar coordinate system and the radar coordinate point of the radar.
距离约束条件具体为:The distance constraints are specifically:
Figure PCTCN2022081142-appb-000009
Figure PCTCN2022081142-appb-000009
其中,
Figure PCTCN2022081142-appb-000010
表示第二距离,即车道中心线第i个雷达坐标点至雷达的距离,单位为m,gps r为路侧雷达所在位置在定位坐标系的定位坐标点(包含经度和纬度),该坐标在雷达安装时通过GPS采集工具获得。
Figure PCTCN2022081142-appb-000011
表示第一距离,即转换后定位点与路侧雷达在定位坐标系的定位坐标点的距离。dist_th max和dist_th min分别为距离偏差的上下限阈值,根据实际情况调整。
in,
Figure PCTCN2022081142-appb-000010
Represents the second distance, that is, the distance from the ith radar coordinate point of the lane center line to the radar, in m, and gps r is the positioning coordinate point (including longitude and latitude) of the roadside radar position in the positioning coordinate system. Obtained through GPS acquisition tool when the radar is installed.
Figure PCTCN2022081142-appb-000011
Indicates the first distance, that is, the distance between the converted positioning point and the positioning coordinate point of the roadside radar in the positioning coordinate system. dist_th max and dist_th min are the upper and lower thresholds of the distance deviation, respectively, which are adjusted according to the actual situation.
通过上述目标函数和距离约束采用非线性优化方法(如有效集法、序列二次规划法、内点法、遗传算法、粒子群优化等)可以求解出最优的路侧雷达标定参数x,从而获得路侧雷达坐标系与定位坐标系之间的映射关系,实现路侧雷达的标定。该方法可适用于路侧激光雷达的标定,或是路侧毫米波雷达的标定。Through the above objective function and distance constraints, nonlinear optimization methods (such as effective set method, sequential quadratic programming method, interior point method, genetic algorithm, particle swarm optimization, etc.) can be used to solve the optimal roadside radar calibration parameter x, so that The mapping relationship between the roadside radar coordinate system and the positioning coordinate system is obtained, and the roadside radar calibration is realized. This method can be applied to the calibration of roadside lidar, or the calibration of roadside millimeter-wave radar.
上述的路侧雷达标定方法,基于路侧雷达采集的车辆行驶坐标数据,拟合得到车道中心线在雷达坐标系的雷达坐标信息,获取车道中心线在定位坐标信息的第一定位坐标信息,根据车道线在两个坐标系下的坐标信息,对路侧雷达进行参数标定。该方法中,车道中心线在雷达坐标系的雷达坐标信息,根据路侧雷达 采集的数据进行车道分割和拟合得到,无需辅助其它的标定物,因而可直接利用普通车辆的雷达数据进行处理得到,该方法操作简单,具有便捷性。The above roadside radar calibration method, based on the vehicle driving coordinate data collected by the roadside radar, fits the radar coordinate information of the lane center line in the radar coordinate system, and obtains the first positioning coordinate information of the lane center line in the positioning coordinate information. The coordinate information of the lane line in the two coordinate systems is used to calibrate the parameters of the roadside radar. In this method, the radar coordinate information of the lane center line in the radar coordinate system is obtained by lane segmentation and fitting according to the data collected by the roadside radar, without the need to assist other calibration objects, so it can be directly processed by the radar data of ordinary vehicles. , the method is simple and convenient.
在实际应用中,在智慧高速项目和城市路口智能化项目中存在路侧雷达因为损坏更换、震动及安装不牢固、热胀冷缩等原因导致路侧雷达等路侧传感器在安装时的标定参数无法适用于传感器变动后的情况,导致传感器检测目标的位置误差偏大,影响多传感器融合的效果。而采用本申请的方法,当路侧雷达因为重新安装、松动、热胀冷缩需要重新标定时,只需采集调整后的路侧雷达检测的一段时间的普通车辆的数据及该路段高精度地图信息即可实现路侧雷达的标定。In practical applications, there are roadside radars and other roadside sensors calibration parameters during installation due to damage and replacement, vibration and unstable installation, thermal expansion and contraction in smart high-speed projects and urban intersection intelligent projects. It cannot be applied to the situation after the sensor changes, resulting in a large position error of the sensor detection target, which affects the effect of multi-sensor fusion. With the method of the present application, when the roadside radar needs to be re-calibrated due to re-installation, loosening, thermal expansion and contraction, it is only necessary to collect the data of ordinary vehicles detected by the adjusted roadside radar for a period of time and the high-precision map of the road section. The information can realize the calibration of roadside radar.
应该理解的是,虽然图2的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图2中的至少一部分步骤可以包括多个步骤或者多个阶段,这些步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤中的步骤或者阶段的至少一部分轮流或者交替地执行。It should be understood that although the various steps in the flowchart of FIG. 2 are shown in sequence according to the arrows, these steps are not necessarily executed in the sequence shown by the arrows. Unless explicitly stated herein, the execution of these steps is not strictly limited to the order, and these steps may be performed in other orders. Moreover, at least a part of the steps in FIG. 2 may include multiple steps or multiple stages, and these steps or stages are not necessarily executed at the same time, but may be executed at different times, and the execution sequence of these steps or stages is also It does not have to be performed sequentially, but may be performed alternately or alternately with other steps or at least a portion of the steps or stages within the other steps.
在一个实施例中,如图6所示,提供了一种路侧雷达标定装置,包括:In one embodiment, as shown in FIG. 6, a roadside radar calibration device is provided, including:
采集模块602,用于获取路侧雷达采集的一段时间道路上的车辆行驶坐标数据;The acquisition module 602 is used for acquiring the vehicle traveling coordinate data on the road for a period of time collected by the roadside radar;
车道数据提取模块604,用于从车辆行驶坐标数据提取各车道上的车辆行驶坐标数据;A lane data extraction module 604, configured to extract vehicle travel coordinate data on each lane from the vehicle travel coordinate data;
拟合模块606,用于对各车道上的车辆行驶坐标数据进行拟合,得到车道中心线在雷达坐标系的雷达坐标信息;The fitting module 606 is used for fitting the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system;
定位信息获取模块608,用于获取车道中心线在定位坐标系的第一定位坐标信息;a positioning information obtaining module 608, configured to obtain the first positioning coordinate information of the lane center line in the positioning coordinate system;
标定模块610,用于根据车道中心线的雷达坐标信息和第一定位坐标信息对路侧雷达进行参数标定。The calibration module 610 is configured to perform parameter calibration on the roadside radar according to the radar coordinate information of the lane center line and the first positioning coordinate information.
上述路侧雷达标定装置,基于路侧雷达采集的车辆行驶坐标数据,拟合得到 车道中心线在雷达坐标系的雷达坐标信息,获取车道中心线在定位坐标信息的第一定位坐标信息,根据车道线在两个坐标系下的坐标信息,对路侧雷达进行参数标定。该方法中,车道中心线在雷达坐标系的雷达坐标信息,根据路侧雷达采集的数据进行车道分割和拟合得到,无需辅助其它的标定物,因而可直接利用普通车辆的雷达数据进行处理得到,该方法操作简单,具有便捷性。The above roadside radar calibration device, based on the vehicle driving coordinate data collected by the roadside radar, fits to obtain the radar coordinate information of the lane center line in the radar coordinate system, and obtains the first positioning coordinate information of the lane center line in the positioning coordinate information. The coordinate information of the line in the two coordinate systems is used to calibrate the parameters of the roadside radar. In this method, the radar coordinate information of the lane center line in the radar coordinate system is obtained by lane segmentation and fitting according to the data collected by the roadside radar, without the need to assist other calibration objects, so it can be directly processed by the radar data of ordinary vehicles. , the method is simple and convenient.
在另一个实施例中,车道数据提取模块,用于获取根据车道的分布特征以及车辆行驶的坐标变化划定的车辆行驶坐标数据中的感兴趣区域,感兴趣区域与车道区域对应;根据感兴趣区域,提取在各车道上的车辆行驶坐标数据。In another embodiment, a lane data extraction module is configured to obtain an area of interest in the vehicle driving coordinate data delineated according to the distribution characteristics of the lane and the coordinate changes of vehicle driving, and the area of interest corresponds to the lane area; area, and extract the vehicle travel coordinate data on each lane.
在另一个实施例中,定位信息获取模块,用于从高精度地图中,获取车道中心线在定位坐标系的第一定位坐标信息。In another embodiment, the positioning information obtaining module is configured to obtain the first positioning coordinate information of the lane center line in the positioning coordinate system from the high-precision map.
在另一个实施例中,定位信息获取模块,用于获取定位车辆在各车道行驶采集,得到的车道中心线在定位坐标系的第一定位坐标信息。In another embodiment, the positioning information acquisition module is configured to acquire the first positioning coordinate information of the center line of the lane in the positioning coordinate system obtained by the positioning vehicle traveling in each lane and collecting.
在另一个实施例中,拟合模块,用于对各车道上的车辆行驶坐标数据进行多项式拟合,得到车道中心线在路侧雷达坐标系中的轨迹;在车道中心线在路侧雷达坐标系中的轨迹进行采样,得到车道中心线在路侧雷达坐标系的雷达坐标信息。In another embodiment, the fitting module is configured to perform polynomial fitting on the vehicle driving coordinate data on each lane to obtain the trajectory of the lane centerline in the roadside radar coordinate system; the lane centerline is in the roadside radar coordinates The trajectory in the system is sampled to obtain the radar coordinate information of the lane center line in the roadside radar coordinate system.
在另一个实施例中,标定模块,用于根据雷达坐标信息,将车道中心线的坐标点转换到定位坐标系,得到该坐标点在定位坐标系的转换后定位坐标点;在第一定位坐标信息中获取与转换后坐标点距离最近的第一定位坐标点;以最小化转换后定位坐标点和第一定位坐标点的距离为目标,得到路侧雷达的标定参数。In another embodiment, the calibration module is configured to convert the coordinate point of the lane center line to the positioning coordinate system according to the radar coordinate information, and obtain the positioning coordinate point of the coordinate point after the conversion of the positioning coordinate system; The first positioning coordinate point closest to the converted coordinate point is obtained from the information; the calibration parameters of the roadside radar are obtained with the goal of minimizing the distance between the converted positioning coordinate point and the first positioning coordinate point.
其中,目标的目标函数满足以下约束条件:第一距离和第二距离的距离差值满足距离偏差阈值,第一距离为转换后定位点与路侧雷达在定位坐标系的定位坐标点的距离;第二距离为车道中心线在雷达坐标系下雷达坐标点与雷达的距离。Wherein, the objective function of the target satisfies the following constraints: the distance difference between the first distance and the second distance satisfies the distance deviation threshold, and the first distance is the distance between the converted positioning point and the positioning coordinate point of the roadside radar in the positioning coordinate system; The second distance is the distance between the radar coordinate point and the radar of the lane center line in the radar coordinate system.
关于路侧雷达标定装置的具体限定可以参见上文中对于路侧雷达标定方法的限定,在此不再赘述。上述路侧雷达标定装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以 便于处理器调用执行以上各个模块对应的操作。For the specific limitation of the roadside radar calibration device, reference may be made to the definition of the roadside radar calibration method above, which will not be repeated here. Each module in the above-mentioned roadside radar calibration device may be implemented in whole or in part by software, hardware and combinations thereof. The above-mentioned modules can be embedded in or independent of the processor in the computer device in the form of hardware, or can be stored in the memory in the computer device in the form of software, so that the processor can call and execute the corresponding operations of the above-mentioned modules.
在一个实施例中,提供了一种计算机设备,该计算机设备可以是边缘计算单元,其内部结构图可以如图7所示。该计算机设备包括通过系统总线连接的处理器、存储器和通信接口。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统和计算机程序。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的通信接口用于与外部的终端进行有线或无线方式的通信,无线方式可通过WIFI、运营商网络、NFC(近场通信)或其他技术实现。该计算机程序被处理器执行时以实现一种路侧雷达标定方法。In one embodiment, a computer device is provided, the computer device may be an edge computing unit, and an internal structure diagram of which may be shown in FIG. 7 . The computer device includes a processor, memory, and a communication interface connected by a system bus. Among them, the processor of the computer device is used to provide computing and control capabilities. The memory of the computer device includes a non-volatile storage medium, an internal memory. The nonvolatile storage medium stores an operating system and a computer program. The internal memory provides an environment for the execution of the operating system and computer programs in the non-volatile storage medium. The communication interface of the computer device is used for wired or wireless communication with an external terminal, and the wireless communication can be realized by WIFI, operator network, NFC (Near Field Communication) or other technologies. The computer program, when executed by the processor, implements a roadside radar calibration method.
本领域技术人员可以理解,图7中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。Those skilled in the art can understand that the structure shown in FIG. 7 is only a block diagram of a partial structure related to the solution of the present application, and does not constitute a limitation on the computer equipment to which the solution of the present application is applied. Include more or fewer components than shown in the figures, or combine certain components, or have a different arrangement of components.
在一个实施例中,提供了一种计算机设备,包括存储器和处理器,存储器中存储有计算机程序,该处理器执行计算机程序时实现上述各实施例的方法。In one embodiment, a computer device is provided, including a memory and a processor, where a computer program is stored in the memory, and the processor implements the methods of the foregoing embodiments when the processor executes the computer program.
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现上述各实施例的方法。In one embodiment, a computer-readable storage medium is provided, on which a computer program is stored, and when the computer program is executed by a processor, implements the methods of the foregoing embodiments.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和易失性存储器中的至少一种。非易失性存储器可包括只读存储器(Read-Only Memory,ROM)、磁带、软盘、闪存或光存储器等。易失性存储器可包括随机存取存储器(Random Access Memory,RAM)或外部高速缓冲存储器。作为说明而非局限,RAM可以是多 种形式,比如静态随机存取存储器(Static Random Access Memory,SRAM)或动态随机存取存储器(Dynamic Random Access Memory,DRAM)等。Those skilled in the art can understand that all or part of the processes in the methods of the above embodiments can be implemented by instructing relevant hardware through a computer program, and the computer program can be stored in a non-volatile computer-readable storage medium , when the computer program is executed, it may include the processes of the above-mentioned method embodiments. Wherein, any reference to memory, storage, database or other media used in the various embodiments provided in this application may include at least one of non-volatile and volatile memory. Non-volatile memory may include read-only memory (Read-Only Memory, ROM), magnetic tape, floppy disk, flash memory, or optical memory, and the like. Volatile memory may include random access memory (RAM) or external cache memory. By way of illustration and not limitation, RAM can be in various forms, such as static random access memory (Static Random Access Memory, SRAM) or dynamic random access memory (Dynamic Random Access Memory, DRAM).
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。The technical features of the above embodiments can be combined arbitrarily. In order to make the description simple, all possible combinations of the technical features in the above embodiments are not described. However, as long as there is no contradiction in the combination of these technical features It is considered to be the range described in this specification.
以上实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。The above examples only represent several embodiments of the present application, and the descriptions thereof are relatively specific and detailed, but should not be construed as a limitation on the scope of the invention patent. It should be pointed out that for those skilled in the art, without departing from the concept of the present application, several modifications and improvements can be made, which all belong to the protection scope of the present application. Therefore, the scope of protection of the patent of the present application shall be subject to the appended claims.

Claims (10)

  1. 一种路侧雷达标定方法,所述方法包括:A roadside radar calibration method, the method comprising:
    获取路侧雷达采集的一段时间道路上的车辆行驶坐标数据;Obtain the vehicle driving coordinate data on the road for a period of time collected by the roadside radar;
    从所述车辆行驶坐标数据提取各车道上的车辆行驶坐标数据;extracting vehicle driving coordinate data on each lane from the vehicle driving coordinate data;
    对各车道上的所述车辆行驶坐标数据进行拟合,得到车道中心线在雷达坐标系的雷达坐标信息;Fitting the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system;
    获取车道中心线在定位坐标系的第一定位坐标信息;Obtain the first positioning coordinate information of the lane center line in the positioning coordinate system;
    根据所述车道中心线的所述雷达坐标信息和所述第一定位坐标信息对路侧雷达进行参数标定。The parameters of the roadside radar are calibrated according to the radar coordinate information of the lane center line and the first positioning coordinate information.
  2. 根据权利要求1所述的方法,其特征在于,从所述车辆行驶坐标数据提取各车道上的车辆行驶坐标数据,包括:The method according to claim 1, wherein extracting the vehicle driving coordinate data on each lane from the vehicle driving coordinate data comprises:
    获取根据车道的分布特征以及车辆行驶的坐标变化划定的所述车辆行驶坐标数据中的感兴趣区域,所述感兴趣区域与车道区域对应;acquiring an area of interest in the vehicle driving coordinate data delineated according to the distribution characteristics of the lanes and the coordinate changes of the vehicle driving, and the area of interest corresponds to the lane area;
    根据所述感兴趣区域,提取在各车道上的车辆行驶坐标数据。According to the region of interest, the vehicle travel coordinate data on each lane is extracted.
  3. 根据权利要求1所述的方法,其特征在于,所述获取车道中心线在定位坐标系的第一定位坐标信息,包括:The method according to claim 1, wherein the obtaining the first positioning coordinate information of the lane center line in the positioning coordinate system comprises:
    从高精度地图中,获取所述车道中心线在定位坐标系的第一定位坐标信息。Obtain the first positioning coordinate information of the lane center line in the positioning coordinate system from the high-precision map.
  4. 根据权利要求1所述的方法,其特征在于,所述获取车道中心线在定位坐标系的第一定位坐标信息,包括:The method according to claim 1, wherein the obtaining the first positioning coordinate information of the lane center line in the positioning coordinate system comprises:
    获取定位车辆在各车道行驶采集得到的所述车道中心线在定位坐标系的第一定位坐标信息。The first positioning coordinate information of the lane center line in the positioning coordinate system obtained by the positioning vehicle traveling in each lane is acquired.
  5. 根据权利要求1所述的方法,其特征在于,所述对各车道上的所述车辆行驶坐标数据进行拟合,得到车道中心线在雷达坐标系的雷达坐标信息,包括:The method according to claim 1, wherein the fitting of the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system, comprising:
    对各车道上的所述车辆行驶坐标数据进行多项式拟合,得到车道中心线在路侧雷达坐标系中的轨迹;Perform polynomial fitting on the vehicle driving coordinate data on each lane to obtain the trajectory of the lane center line in the roadside radar coordinate system;
    在所述车道中心线在路侧雷达坐标系中的轨迹进行采样,得到车道中心线在所述路侧雷达坐标系的雷达坐标信息。Sampling the trajectory of the lane center line in the roadside radar coordinate system to obtain radar coordinate information of the lane center line in the roadside radar coordinate system.
  6. 根据权利要求1所述的方法,其特征在于,根据所述车道中心线的所述雷达坐标信息和所述第一定位坐标信息对路侧雷达进行参数标定,包括:The method according to claim 1, wherein the parameter calibration of the roadside radar according to the radar coordinate information of the lane center line and the first positioning coordinate information comprises:
    根据所述雷达坐标信息,将所述车道中心线的坐标点转换到定位坐标系,得到该坐标点在定位坐标系的转换后定位坐标点;According to the radar coordinate information, the coordinate point of the lane center line is converted to the positioning coordinate system, and the positioning coordinate point of the coordinate point after the conversion of the positioning coordinate system is obtained;
    在所述第一定位坐标信息中获取与所述转换后坐标点距离最近的第一定位坐标点;Obtain the first positioning coordinate point closest to the converted coordinate point in the first positioning coordinate information;
    以最小化所述转换后定位坐标点和第一定位坐标点的距离为目标,得到路侧雷达的标定参数。The calibration parameters of the roadside radar are obtained with the goal of minimizing the distance between the transformed positioning coordinate point and the first positioning coordinate point.
  7. 根据权利要求6所述的方法,其特征在于,所述目标的目标函数满足以下约束条件:第一距离和第二距离的距离差值满足距离偏差阈值,所述第一距离为所述转换后定位点与所述路侧雷达在定位坐标系的定位坐标点的距离;所述第二距离为车道中心线在雷达坐标系下雷达坐标点与雷达的距离。The method according to claim 6, wherein the objective function of the target satisfies the following constraints: the distance difference between the first distance and the second distance satisfies a distance deviation threshold, and the first distance is the converted The distance between the positioning point and the positioning coordinate point of the roadside radar in the positioning coordinate system; the second distance is the distance between the radar coordinate point and the radar of the lane center line in the radar coordinate system.
  8. 一种路侧雷达标定装置,其特征在于,所述装置包括:A roadside radar calibration device, characterized in that the device comprises:
    采集模块,用于获取路侧雷达采集的一段时间道路上的车辆行驶坐标数据;The acquisition module is used to acquire the vehicle traveling coordinate data on the road for a period of time collected by the roadside radar;
    车道数据提取模块,用于从所述车辆行驶坐标数据提取各车道上的车辆行驶坐标数据;a lane data extraction module for extracting vehicle travel coordinate data on each lane from the vehicle travel coordinate data;
    拟合模块,用于对各车道上的所述车辆行驶坐标数据进行拟合,得到车道中心线在雷达坐标系的雷达坐标信息;a fitting module, used for fitting the vehicle driving coordinate data on each lane to obtain the radar coordinate information of the lane center line in the radar coordinate system;
    定位信息获取模块,用于获取车道中心线在定位坐标系的第一定位坐标信息;a positioning information acquisition module, used for acquiring the first positioning coordinate information of the lane center line in the positioning coordinate system;
    标定模块,用于根据所述车道中心线的所述雷达坐标信息和所述第一定位坐标信息对路侧雷达进行参数标定。A calibration module, configured to perform parameter calibration on the roadside radar according to the radar coordinate information of the lane center line and the first positioning coordinate information.
  9. 一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至7中任一项所述方法的步骤。A computer device comprising a memory and a processor, wherein the memory stores a computer program, characterized in that, when the processor executes the computer program, the steps of the method according to any one of claims 1 to 7 are implemented.
  10. 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至7中任一项所述的方法的步骤。A computer-readable storage medium on which a computer program is stored, characterized in that, when the computer program is executed by a processor, the steps of the method according to any one of claims 1 to 7 are implemented.
PCT/CN2022/081142 2021-03-26 2022-03-16 Roadside radar calibration method and apparatus, computer device, and storage medium WO2022199440A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202110324401.2 2021-03-26
CN202110324401.2A CN115128552A (en) 2021-03-26 2021-03-26 Calibration method and device for roadside radar, computer equipment and storage medium

Publications (1)

Publication Number Publication Date
WO2022199440A1 true WO2022199440A1 (en) 2022-09-29

Family

ID=83374501

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/081142 WO2022199440A1 (en) 2021-03-26 2022-03-16 Roadside radar calibration method and apparatus, computer device, and storage medium

Country Status (2)

Country Link
CN (1) CN115128552A (en)
WO (1) WO2022199440A1 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006007940A (en) * 2004-06-24 2006-01-12 Fujitsu Ltd Calibration method of radar device, radar device, monitoring system, and program
CN110609268A (en) * 2018-11-01 2019-12-24 驭势科技(北京)有限公司 Laser radar calibration method, device and system and storage medium
CN111427019A (en) * 2020-05-14 2020-07-17 成都微视瑞达科技有限公司 Roadside radar self-adaptive correction method and system
CN112098964A (en) * 2020-09-23 2020-12-18 华人运通(上海)自动驾驶科技有限公司 Calibration method, device and equipment of road-end radar and storage medium
CN112433203A (en) * 2020-10-29 2021-03-02 同济大学 Lane alignment detection method based on millimeter wave radar data
CN112526470A (en) * 2020-12-22 2021-03-19 北京百度网讯科技有限公司 Method and device for calibrating radar parameters, electronic equipment and storage medium

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006007940A (en) * 2004-06-24 2006-01-12 Fujitsu Ltd Calibration method of radar device, radar device, monitoring system, and program
CN110609268A (en) * 2018-11-01 2019-12-24 驭势科技(北京)有限公司 Laser radar calibration method, device and system and storage medium
CN111427019A (en) * 2020-05-14 2020-07-17 成都微视瑞达科技有限公司 Roadside radar self-adaptive correction method and system
CN112098964A (en) * 2020-09-23 2020-12-18 华人运通(上海)自动驾驶科技有限公司 Calibration method, device and equipment of road-end radar and storage medium
CN112433203A (en) * 2020-10-29 2021-03-02 同济大学 Lane alignment detection method based on millimeter wave radar data
CN112526470A (en) * 2020-12-22 2021-03-19 北京百度网讯科技有限公司 Method and device for calibrating radar parameters, electronic equipment and storage medium

Also Published As

Publication number Publication date
CN115128552A (en) 2022-09-30

Similar Documents

Publication Publication Date Title
CN109901139B (en) Laser radar calibration method, device, equipment and storage medium
JP6605707B2 (en) System and method for two-stage object data processing with vehicle and server databases for generating, updating and supplying accurate road characteristic databases
JP6714688B2 (en) System and method for matching road data objects to generate and update an accurate road database
EP3745376B1 (en) Method and system for determining driving assisting data
US20210164797A1 (en) Method and apparatus for detecting a position change of a lane marker, electronic device and storage medium
JP2018525633A (en) System and method for accurate vehicle location
CN111121849B (en) Automatic calibration method for orientation parameters of sensor, edge calculation unit and roadside sensing system
JP6956268B2 (en) Driving environment information generation method, driving control method, driving environment information generation device
US20230419824A1 (en) Method and device for determining traffic stream information, electronic equipment and storage medium
CN112363167A (en) Extended target tracking method based on fusion of millimeter wave radar and monocular camera
CN110766760B (en) Method, device, equipment and storage medium for camera calibration
US20210180980A1 (en) Roadway mapping device
JP2020067402A (en) Sensor calibration method and sensor calibration apparatus
CN111325187B (en) Lane position identification method and device
JP7181997B2 (en) Vehicle control system and vehicle control method
US20230121226A1 (en) Determining weights of points of a point cloud based on geometric features
CN114485698A (en) Intersection guide line generating method and system
WO2022078342A1 (en) Dynamic occupancy grid estimation method and apparatus
CN110751693B (en) Method, apparatus, device and storage medium for camera calibration
CN115494533A (en) Vehicle positioning method, device, storage medium and positioning system
WO2022068274A1 (en) Positioning method, apparatus and system
CN113296120B (en) Obstacle detection method and terminal
WO2022199440A1 (en) Roadside radar calibration method and apparatus, computer device, and storage medium
WO2021097844A1 (en) Guardrail estimation method based on multi-sensor data fusion, and vehicle-mounted device
US20230082106A1 (en) Vehicle Localization to Map Data

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22774101

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 22774101

Country of ref document: EP

Kind code of ref document: A1