WO2024040500A1 - Coloring method and apparatus for three-dimensional road surface, and storage medium, electronic device and vehicle - Google Patents

Coloring method and apparatus for three-dimensional road surface, and storage medium, electronic device and vehicle Download PDF

Info

Publication number
WO2024040500A1
WO2024040500A1 PCT/CN2022/114717 CN2022114717W WO2024040500A1 WO 2024040500 A1 WO2024040500 A1 WO 2024040500A1 CN 2022114717 W CN2022114717 W CN 2022114717W WO 2024040500 A1 WO2024040500 A1 WO 2024040500A1
Authority
WO
WIPO (PCT)
Prior art keywords
dimensional road
road
point cloud
points
dimensional
Prior art date
Application number
PCT/CN2022/114717
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 WO2024040500A1 publication Critical patent/WO2024040500A1/en

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T15/003D [Three Dimensional] image rendering
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T3/00Geometric image transformations in the plane of the image
    • G06T3/06Topological mapping of higher dimensional structures onto lower dimensional surfaces

Definitions

  • the present application relates to the field of automotive technology, specifically, to a three-dimensional road surface coloring method, device, storage medium, electronic equipment and vehicle.
  • Electronic maps are maps that are stored and consulted digitally using computer technology. When people are walking, riding, or driving, they can get the route to their destination by consulting the electronic map, and they can also navigate in real time by turning on the intelligent navigation function. In order to improve user experience and improve the accuracy of electronic map query, it has gradually developed from two-dimensional electronic maps to three-dimensional electronic maps.
  • One of the most critical aspects of generating a three-dimensional electronic map is generating a three-dimensional road surface.
  • lidar is mainly relied on to collect radar point clouds to generate three-dimensional road surfaces.
  • road edge lines can be generated in the three-dimensional road surface as reference lines.
  • Methods for generating road edge lines in related technologies mainly include: obtaining each frame of road image collected by the camera of the collection vehicle when collecting radar point clouds based on the lidar of the collection vehicle; perceiving the road edge line in each frame of road image; based on each frame
  • the ground parameter of a pixel on the road edge line in the road image is projected onto the three-dimensional road surface to obtain a projection point, and with the projection point as the center and the ground parameter of the road image as the normal vector, a plane containing the projection point is fitted.
  • Project the pixel point onto the corresponding plane, and the intersection point with the plane is the point of the road edge line in the three-dimensional road surface.
  • This application provides a three-dimensional road surface coloring method, device, storage medium, electronic equipment and vehicle, which can solve the problem of time-consuming and inaccurate generation of road edge lines.
  • embodiments of the present application provide a three-dimensional road surface coloring method, which method includes:
  • a restoration operation is performed on the three-dimensional road surface to generate a first three-dimensional road point cloud, wherein the three-dimensional road surface is an uncolored three-dimensional road surface fitted based on the original radar point cloud.
  • the second three-dimensional road point cloud corresponding to the road image is determined, wherein the road image is the original radar collected by the laser radar of the collection vehicle.
  • the point cloud is generated, in the road image collected by the camera of the collecting vehicle, the second three-dimensional road point cloud is included in the first three-dimensional road point cloud, and the distance from the pose of the road image is less than or equal to a predetermined distance.
  • the target projection point includes the road in each frame Projection points located within a target area in the projection point cloud of the image, the target area including pixels having the same abscissa as the static road edge line perceived in the road image and a difference in ordinates within a preset difference range
  • the target three-dimensional road point includes a three-dimensional road point that has a direct mapping relationship with the target projection point, or the elevation of the three-dimensional road point that has a direct mapping relationship with the target projection point is preset. 3D pavement points obtained after height.
  • the embodiment of the present application can project the second three-dimensional road point cloud near the road image into the road image to obtain the projection point cloud, and Directly color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point located in the target area in the projection point cloud into the target color, wherein the target area includes a static road edge line that is transverse to the perceived static road edge in the road image.
  • the target 3D road points include 3D road points that have a direct mapping relationship with the target projection point or are obtained by raising the elevation of these 3D road points. 3D waypoint. It can be seen from this that in the embodiment of the present application, the second three-dimensional road point cloud in the three-dimensional road surface is directly projected onto the two-dimensional road image, and the road edge line perceived in the road image and its nearby projection points and the three-dimensional road point points are used. The mapping relationship directly determines the three-dimensional road points of the road edge line and colors them. Therefore, the embodiment of the present application does not need to construct a plane, and does not involve the problem of inconsistency between the plane and the three-dimensional road slope. Therefore, there is no need to iteratively search for nearby curved surfaces, and thus both Improving the generation efficiency of road edge lines can also improve the accuracy.
  • the method before projecting the second three-dimensional road point cloud to the corresponding road image and obtaining the projected point cloud in the road image, the method also includes:
  • Filter invalid three-dimensional road points in the second three-dimensional road point cloud under the camera coordinate system wherein the invalid three-dimensional road points include three-dimensional road points with elevations outside the target elevation range, and forward coordinates less than or equal to 0. 3D pavement points;
  • Projecting the second three-dimensional road point cloud to the corresponding road image and obtaining the projected point cloud in the road image includes:
  • the embodiment of the present application can remove the road sections above and below the bridge or layered above and below the bridge by filtering out the three-dimensional road points whose elevation is outside the target elevation range, thereby making the obtained projection point cloud more accurate.
  • By filtering out the previous Three-dimensional road points with coordinates less than or equal to 0 can be filtered out three-dimensional road points located outside the camera's shooting field of view, thereby reducing the amount of data converted from the camera coordinate system to the image coordinate system and improving the efficiency of road edge generation.
  • the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point is colored into a target color to highlight the three-dimensional road surface.
  • the method also includes:
  • Filter invalid projection points in the projection point cloud where the invalid projection points include projection points located outside the image coordinate system, projection points located below the hood line of the collection vehicle, and projection points located on the static road edge line Projection points above and above the dynamic road edge lines.
  • the embodiment of the present application can improve the accuracy of the projected point cloud by filtering out projection points outside the drivable area (that is, invalid projection points), thereby not only improving the accuracy of generating road edges, but also improving the subsequent Accuracy in generating colored pavement or semantically segmented pavement.
  • coloring the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color includes:
  • the preset conditions include any one of the following:
  • Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
  • the three-dimensional road point obtained after raising the elevation of the three-dimensional road point with a direct mapping relationship by the preset height
  • the three-dimensional road points with a direct mapping relationship are filtered based on the drivable area point cloud.
  • the drivable area point cloud includes the filtered projection point cloud, which is located by the vehicle cover. Lines, three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the static road edge line and the dynamic road edge line;
  • the remaining three-dimensional road points are obtained by raising the elevation of the preset height.
  • the drawn road edge can avoid blocking the original road landmarks, and the three-dimensional road points in the road can be filtered out through the drivable area point cloud, thereby improving the accuracy and accuracy of the road edge. Display of results.
  • the method further includes:
  • the weight value corresponding to the three-dimensional road point to be processed is calculated, where the target The distance is the target distance between the transverse coordinate and the forward coordinate of the three-dimensional road point to be processed, and the target distance has a negative correlation with the weight value;
  • the method further includes:
  • the three-dimensional road point in the first three-dimensional road point cloud corresponding to the valid projection point is colored into the above-mentioned The color value of a valid projection point, wherein the valid projection point is a projection point included in the filtered projection point cloud;
  • the embodiment of the present application can realize the coloring of the three-dimensional road surface by coloring the three-dimensional road points in the first three-dimensional road point cloud corresponding to the effective projection point.
  • the road image is a color image
  • it can be obtained
  • the road image is a semantic segmentation image
  • the semantic segmentation of the pavement can be obtained.
  • weighted calculations can also be performed based on the weight value determined by the distance information, thereby improving the accuracy of the three-dimensional road surface coloring.
  • inventions of the present application provide a three-dimensional road surface coloring device.
  • the device includes:
  • a restoration unit configured to restore the three-dimensional road surface according to the preset spacing and the surface parameters of the three-dimensional road surface, and generate a first three-dimensional road surface point cloud, wherein the three-dimensional road surface is fitted based on the original radar point cloud. Uncolored three-dimensional pavement;
  • Determining unit configured to determine the second three-dimensional road point cloud corresponding to the road image according to the position and orientation of each frame of the road image in the first three-dimensional road point cloud, wherein the road image is the lidar of the collection vehicle
  • the road image is the lidar of the collection vehicle
  • a projection unit configured to project the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image
  • a coloring unit configured to color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface, wherein the target projection point includes Projection points located within a target area in the projection point cloud of the road image in each frame.
  • the target area includes the same abscissa as the static road edge line perceived in the road image and the difference between the ordinates is within a preset difference.
  • the area composed of pixel points within the range, the target three-dimensional road point includes a three-dimensional road point that has a direct mapping relationship with the target projection point, or the three-dimensional road point that will have a direct mapping relationship with the target projection point.
  • the three-dimensional road points obtained by raising the elevation to a preset height.
  • the device further includes:
  • a coordinate system conversion unit configured to project the second three-dimensional road point cloud to the corresponding road image and obtain the projected point cloud in the road image, converting the second three-dimensional road point cloud from Convert the station center coordinate system to the camera coordinate system;
  • the first filtering unit is used to filter invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, where the invalid three-dimensional road points include three-dimensional road points with elevations outside the target elevation range, previous Three-dimensional road points with coordinates less than or equal to 0;
  • the projection unit is configured to project the filtered second three-dimensional road point cloud in the camera coordinate system to the corresponding road image to obtain the projected point cloud in the road image.
  • the device further includes:
  • a second filtering unit configured to filter all target three-dimensional road points in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface.
  • Invalid projection points in the projection point cloud wherein the invalid projection points include projection points located outside the image coordinate system, projection points located below the hood line of the collection vehicle, and projection points located above the static road edge line Projection points and projection points above dynamic road edge lines.
  • the coloring unit is configured to determine a three-dimensional road point in the first three-dimensional road point cloud that satisfies a preset condition as the target three-dimensional road point, and The target three-dimensional road surface points are colored into the target color;
  • the preset conditions include any one of the following:
  • Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
  • the three-dimensional road point obtained after raising the elevation of the three-dimensional road point with a direct mapping relationship by the preset height
  • the three-dimensional road points with a direct mapping relationship are filtered based on the drivable area point cloud.
  • the drivable area point cloud includes the filtered projection point cloud, which is located by the vehicle cover. Lines, three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the static road edge line and the dynamic road edge line;
  • the remaining three-dimensional road points are obtained by raising the elevation of the preset height.
  • the device further includes:
  • a computing unit configured to, after filtering the invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, calculate the filtered second three-dimensional road point cloud in the camera coordinate system.
  • the target distance of each three-dimensional road point to be processed is calculated, and the weight value corresponding to the three-dimensional road point to be processed is calculated, where the target distance is between the lateral coordinate and the forward coordinate of the three-dimensional road point to be processed.
  • the target distance has a negative correlation with the weight value
  • the coloring unit is also configured to, after filtering the invalid projection points in the projection point cloud, when there is only one valid projection point corresponding to a three-dimensional road point in the first three-dimensional road point cloud,
  • the three-dimensional road points in the first three-dimensional road point cloud corresponding to the effective projection points are colored into the color values of the effective projection points, wherein the effective projection points are included in the filtered projection point cloud.
  • Projection points when there are multiple valid projection points corresponding to the same three-dimensional road point in the first three-dimensional road point cloud, weight the color values and the weight values of the multiple valid projection points. Calculate and color the three-dimensional road points corresponding to the plurality of valid projection points into weighted color values, wherein each of the plurality of valid projection points is located in a different road image.
  • the three-dimensional road surface coloring device after restoring the uncolored three-dimensional road surface to the first three-dimensional road surface point cloud, can project the second three-dimensional road surface point cloud near the road image into the road image to obtain projection points. cloud, and directly color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point located in the target area into the target color, where the target area includes the static road perceived in the road image
  • the target 3D pavement points include 3D pavement points that have a direct mapping relationship with the target projection point or the elevation of these 3D pavement points is adjusted. 3D waypoints obtained after high.
  • the second three-dimensional road point cloud in the three-dimensional road surface is directly projected onto the two-dimensional road image, and the road edge line perceived in the road image and its nearby projection points and the three-dimensional road point points are used.
  • the mapping relationship directly determines the three-dimensional road points of the road edge line and colors them. Therefore, the embodiment of the present application does not need to construct a plane, and does not involve the problem of inconsistency between the plane and the three-dimensional road slope. Therefore, there is no need to iteratively search for nearby curved surfaces, and thus both Improving the generation efficiency of road edge lines can also improve the accuracy.
  • embodiments of the present application provide a storage medium on which a computer program is stored.
  • the program is executed by a processor, the method described in any possible implementation of the first aspect is implemented.
  • inventions of the present application provide an electronic device.
  • the electronic device includes:
  • processors one or more processors
  • a storage device for storing one or more programs
  • the electronic device When one or more programs are executed by one or more processors, the electronic device implements the method described in any possible implementation manner of the first aspect.
  • embodiments of the present application provide a vehicle, which includes the device as described in any possible implementation of the second aspect, or the electronic device as described in the fourth aspect.
  • Figure 1 is a schematic flow chart of a three-dimensional road surface coloring method provided by an embodiment of the present application
  • Figure 2 is a schematic diagram of the coordinate system provided by the embodiment of the present application.
  • Figure 3 is an example diagram of an invalid projection point and a valid projection point provided by an embodiment of the present application
  • Figure 4 is a block diagram of a three-dimensional road surface coloring device provided by an embodiment of the present application.
  • Figure 5 is a schematic structural diagram of a vehicle provided by an embodiment of the present application.
  • Figure 1 is a schematic flow chart of a three-dimensional road surface coloring method. This method can be applied to electronic equipment or computer equipment, and specifically can be applied to vehicles or servers. The method can include the following steps:
  • the three-dimensional road surface is an uncolored three-dimensional road surface fitted based on the original radar point cloud.
  • the embodiments of this application do not limit the method of generating a three-dimensional road surface based on the original radar point cloud. For example, you can first filter out the radar point cloud about the road surface from the original radar point cloud, and then perform horizontal plane direction fitting on the filtered radar point cloud. , and finally perform vertical fitting to generate a three-dimensional road surface as a three-dimensional road surface.
  • the distance between adjacent three-dimensional road points in the first three-dimensional road point cloud is a preset distance.
  • the preset distance can be the same as the distance of the original radar point cloud, or it can be different, for example, it can be 0.5m.
  • Both the three-dimensional road surface and the first three-dimensional road surface point cloud can be in the station center coordinate system (east-north-celestial coordinate system ENU), or they can be converted from the world coordinate system to the station center coordinate system.
  • ENU east-north-celestial coordinate system
  • S120 Determine the second three-dimensional road point cloud corresponding to the road image based on the position and orientation of each frame of road image in the first three-dimensional road point cloud.
  • the road image is the road image collected by the camera of the collection vehicle when the lidar of the collection vehicle collects the original radar point cloud.
  • Road images can be collected through multiple trips by a collection vehicle and/or thinned out, and a reasonable amount of data can be retained.
  • the embodiment of this application does not limit the installation angle and installation position of the camera on the collection vehicle.
  • the second three-dimensional road point cloud includes three-dimensional road points in the first three-dimensional road point cloud that are less than or equal to a preset distance from the pose of the road image. Pose includes position and posture.
  • the preset distance can be determined based on the final generated road edge accuracy. For example, when the preset distance is 25m, the second three-dimensional road point cloud corresponding to the road image can be the second three-dimensional road point cloud within the circular area defined with the center point of the road image as the center and 25m as the radius. .
  • embodiments of the present application can also first divide the first three-dimensional road point cloud into multiple area blocks, and then perform the step of "according to each frame of road image on the multiple area blocks in parallel".
  • the pose in the area block is used to determine the second three-dimensional road point cloud corresponding to the road image," and subsequent steps.
  • the blocking principle can be: traverse the first three-dimensional road point cloud, when the number of traversed point clouds reaches the upper limit, stop traversing, and determine the traversed point clouds to be the same area block, and then continue to traverse the untraversed point clouds.
  • the first three-dimensional road point cloud is traversed using this method until all three-dimensional road points in the first three-dimensional road point cloud are traversed.
  • This step can first convert the second three-dimensional road point cloud from the station center coordinate system to the camera coordinate system, and then convert it from the camera coordinate system to the image coordinate system, thereby realizing the projection of the second three-dimensional road point cloud to the road image and obtaining the road image. Projection point cloud in .
  • S140 Color the target three-dimensional road surface point in the first three-dimensional road surface point cloud corresponding to the target projection point into the target color to highlight the road edge of the three-dimensional road surface.
  • the target projection points include projection points located in the target area in the projection point cloud of each frame of the road image.
  • the target area includes the same abscissa as the static road edge line perceived in the road image and the difference in the ordinate is within the preset difference range.
  • the area composed of pixels.
  • Static road edge lines include road fences and other fixed dividing lines used to distinguish roads from non-roads, while dynamic road edge lines are the rear edges of vehicles in front of the collection vehicle, so there may or may not be dynamic road edge lines.
  • the preset difference range can be determined based on the final generated road edge accuracy, for example, it can be 5 pixels.
  • the target color includes colors other than the color of the road surface, especially colors that are significantly different from the color of the road surface, for example, it can be red, green, etc.
  • the method for perceiving static road edge lines and dynamic road edge lines mentioned in the following embodiments may be: labeling at least one of these three types of lines on a large number of historical road images in advance, and then using the history data containing the labeling information.
  • the road image is used for model training to obtain a target detection model, and finally the target detection model is used to detect lines in the road image to be sensed.
  • the target detection model can be a CNN (Convolutional Neural Network, convolutional neural network) model.
  • the target three-dimensional road surface points include three-dimensional road surface points that have a direct mapping relationship with the target projection point, or three-dimensional road surface points that are obtained after raising the elevation of the three-dimensional road surface point that has a direct mapping relationship with the target projection point by a preset height.
  • the three-dimensional road surface point that has a direct mapping relationship with the target projection point means that the target projection point and the three-dimensional road surface point are the same point in different coordinate systems.
  • the preset height can be determined based on the final generated road edge accuracy.
  • the three-dimensional road points in the first three-dimensional road point cloud that meet the preset conditions can be determined as the target three-dimensional road points, and the target three-dimensional road points can be colored into the target color;
  • the preset conditions include any of the following:
  • Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
  • the three-dimensional pavement point obtained after raising the elevation of the three-dimensional pavement point with a direct mapping relationship by a preset height
  • the three-dimensional road points with direct mapping relationships are filtered based on the drivable area point cloud.
  • the drivable area point cloud includes the filtered projection point cloud, which is located between the collected vehicle cover line and the static road edge line.
  • Three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the dynamic road edge lines;
  • the three-dimensional road points After filtering the three-dimensional road points with direct mapping relationships based on the drivable area point cloud, the three-dimensional road points obtained by raising the elevation of the remaining three-dimensional road points by a preset height.
  • raising the elevation can prevent the drawn road edge from blocking the original road landmarks.
  • the three-dimensional road points in the road can be filtered out through the drivable area point cloud, thereby improving the accuracy and display effect of the road edge.
  • the embodiment of the present application can also uniformly color the three-dimensional road points corresponding to the drivable area point cloud into a certain color (different from the target color) to generate a drivable area road surface in the three-dimensional road surface, so that it can be realized based on the drivable area. Pavement can correct the three-dimensional map generated by other methods and other functions.
  • the three-dimensional road surface coloring method after restoring the uncolored three-dimensional road surface to the first three-dimensional road surface point cloud, can project the second three-dimensional road surface point cloud near the road image into the road image to obtain projection points.
  • cloud and directly color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point located in the target area into the target color, where the target area includes the static road perceived in the road image
  • the area composed of pixels with the same abscissa coordinate of the edge line and the difference between the ordinates within the preset difference range.
  • the target 3D pavement points include 3D pavement points that have a direct mapping relationship with the target projection point or the elevation of these 3D pavement points is adjusted. 3D waypoints obtained after high.
  • the second three-dimensional road point cloud in the three-dimensional road surface is directly projected onto the two-dimensional road image, and the road edge line perceived in the road image and its nearby projection points and the three-dimensional road point points are used.
  • the mapping relationship directly determines the three-dimensional road points of the road edge line and colors them. Therefore, the embodiment of the present application does not need to construct a plane, and does not involve the problem of inconsistency between the plane and the three-dimensional road slope. Therefore, there is no need to iteratively search for nearby curved surfaces, and thus both Improving the generation efficiency of road edge lines can also improve the accuracy.
  • the embodiment of the present application projects the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image.
  • the second three-dimensional road surface point cloud is projected to the corresponding road image to obtain the projected point cloud in the road image.
  • invalid three-dimensional road points include three-dimensional road points whose elevation is outside the target elevation range and three-dimensional road points whose forward coordinates are less than or equal to 0.
  • the target elevation range can be [0,3m].
  • the x-axis, y-axis and z-axis constitute the camera coordinate system with the camera optical center as the origin.
  • the z-axis is the forward coordinate axis
  • the y-axis is the coordinate axis used to represent elevation
  • the x-axis is horizontal.
  • the u-axis (horizontal axis) and v-axis (vertical axis) constitute the image coordinate system, and the z-axis passes through the center of the image coordinate system.
  • the three-dimensional road surface coloring method provided by the embodiment of the present application can remove the road sections above and below the bridge or layered above and below the bridge by filtering out the three-dimensional road points whose elevation is outside the target elevation range, thereby making the obtained projected point cloud more accurate. Filtering out three-dimensional road points with forward coordinates less than or equal to 0 can filter out three-dimensional road points located outside the camera's shooting field of view, thereby reducing the amount of data converted from the camera coordinate system to the image coordinate system and improving the efficiency of road edge generation.
  • embodiments of the present application may color the target three-dimensional road points in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the three-dimensional Before the road edge of the road surface, invalid projection points in the projection point cloud are filtered.
  • Invalid projection points include projection points located outside the image coordinate system, projection points located below the cover line of the collection vehicle, and projection points located above the static road edge line. Projection points and projection points above dynamic road edge lines. As shown in Figure 3, the shaded part is the valid projection point area, and the area formed by the valid projection points inside this area can be called the drivable area, and the non-shaded part is the invalid projection point area.
  • Valid projection points are projection points other than invalid projection points in the projection point cloud.
  • filtering invalid projection points in the projection point cloud can not only improve the accuracy of generating road edges, but also improve the accuracy of subsequent generation of colored pavement or semantic segmentation of pavement.
  • the embodiment of the present application can also filter each of the second three-dimensional road point cloud in the camera coordinate system.
  • the target distance of the three-dimensional road point to be processed is calculated, and the weight value corresponding to the three-dimensional road point to be processed is calculated.
  • the target distance is the target distance between the transverse coordinate and the forward coordinate of the three-dimensional road point to be processed.
  • the target distance and the weight are there is a negative correlation between the values; after filtering the invalid projection points in the projection point cloud, when there is only one valid projection point corresponding to a three-dimensional road point in the first three-dimensional road point cloud, the first three-dimensional road point corresponding to the valid projection point will be
  • the three-dimensional pavement points in the pavement point cloud are colored into the color values of the effective projection points, where the effective projection points are the projection points included in the filtered projection point cloud; when there are multiple valid projection points corresponding to the first three-dimensional road point cloud
  • weighted calculations are performed on the color values and weight values of multiple valid projection points, and the three-dimensional road points corresponding to the multiple valid projection points are colored into weighted color values, where multiple Each of the valid projection points is located in a different road image.
  • the three-dimensional road surface generated after coloring in the embodiment of the present application is a colored road surface; when the road image used in the embodiment of the present application is an original color road image
  • the three-dimensional road surface generated after coloring in this embodiment of the present application is a semantically segmented road surface.
  • Colored pavement is a pavement that has the same color as the road surface in the real world; semantic segmentation pavement is a three-dimensional pavement that semantically separates the landmark part and non-landmark part of the road. Pavement landmarks refer to the use of lines, arrows, text, etc. on the road surface to convey guidance to traffic participants. Signs showing restrictions, warnings and other traffic information.
  • the embodiment of the present application can also uniformly color the uncolored three-dimensional road points in the three-dimensional road surface into a certain color (such as gray) to highlight the color of the road surface.
  • the three-dimensional road surface coloring method provided by the embodiment of the present application can realize the coloring of the three-dimensional road surface by coloring the three-dimensional road surface points in the first three-dimensional road surface point cloud corresponding to the effective projection point. For example, when the road image is a color image , the colored road surface can be obtained, and when the road image is a semantic segmentation image, the semantic segmentation road surface can be obtained. And when coloring the three-dimensional road surface, weighted calculations can also be performed based on the weight value determined by the distance information, thereby improving the accuracy of the three-dimensional road surface coloring.
  • the device includes:
  • the restoration unit 21 is used to restore the three-dimensional road surface according to the preset spacing and the surface parameters of the three-dimensional road surface, and generate a first three-dimensional road surface point cloud, where the three-dimensional road surface is an uncolored image fitted based on the original radar point cloud.
  • the determination unit 22 is used to determine the second three-dimensional road point cloud corresponding to the road image according to the position and orientation of each frame of the road image in the first three-dimensional road point cloud, where the road image is the original radar point cloud collected by the lidar of the collection vehicle.
  • the second three-dimensional road point cloud includes three-dimensional road points in the first three-dimensional road point cloud that are less than or equal to the preset distance from the position of the road image;
  • the projection unit 23 is used to project the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image;
  • the coloring unit 24 is used to color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface, wherein the target projection point includes each frame of the road image.
  • the projection point in the projection point cloud is located in the target area.
  • the target area includes the area composed of pixels with the same abscissa as the static road edge line perceived in the road image and the difference between the ordinates is within the preset difference range.
  • the points include three-dimensional pavement points that have a direct mapping relationship with the target projection point, or three-dimensional pavement points that are obtained by raising the elevation of the three-dimensional pavement point that has a direct mapping relationship with the target projection point by a preset height.
  • the device further includes:
  • a coordinate system conversion unit used to convert the second three-dimensional road point cloud from the station center coordinate system to the camera coordinate system before projecting the second three-dimensional road point cloud to the corresponding road image and obtaining the projected point cloud in the road image;
  • the first filtering unit is used to filter invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, where the invalid three-dimensional road points include three-dimensional road points whose elevation is outside the target elevation range and whose forward coordinate is less than or equal to 0. three-dimensional road points;
  • the projection unit 23 is used to project the filtered second three-dimensional road point cloud in the camera coordinate system to the corresponding road image to obtain the projected point cloud in the road image.
  • the device further includes:
  • the second filtering unit is used to filter invalid projections in the projection point cloud before coloring the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into the target color to highlight the road edge of the three-dimensional road surface.
  • Points, where invalid projection points include projection points located outside the image coordinate system, projection points located below the hood line of the collection vehicle, projection points located above the static road edge line, and projection points located above the dynamic road edge line.
  • the coloring unit 24 is used to determine the three-dimensional road points that meet the preset conditions in the first three-dimensional road point cloud as the target three-dimensional road points, and color the target three-dimensional road points into the target color;
  • the preset conditions include any of the following:
  • Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
  • the three-dimensional pavement point obtained after raising the elevation of the three-dimensional pavement point with a direct mapping relationship by a preset height
  • the three-dimensional road points with direct mapping relationships are filtered based on the drivable area point cloud.
  • the drivable area point cloud includes the filtered projection point cloud, which is located between the collected vehicle cover line and the static road edge line.
  • Three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the dynamic road edge lines;
  • the three-dimensional road points After filtering the three-dimensional road points with direct mapping relationships based on the drivable area point cloud, the three-dimensional road points obtained by raising the elevation of the remaining three-dimensional road points by a preset height.
  • the device further includes:
  • a computing unit configured to, after filtering invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, target each to-be-processed three-dimensional road point in the filtered second three-dimensional road point cloud in the camera coordinate system.
  • Distance calculate the weight value corresponding to the three-dimensional road point to be processed, where the target distance is the target distance between the lateral coordinates and the forward coordinate of the three-dimensional road point to be processed, and the target distance has a negative correlation with the weight value;
  • the coloring unit 24 is also used to, after filtering the invalid projection points in the projection point cloud, when there is only one valid projection point corresponding to one three-dimensional road point in the first three-dimensional road point cloud, convert the valid projection point corresponding to the first
  • the three-dimensional road points in the three-dimensional road point cloud are colored into the color values of the effective projection points, where the effective projection points are the projection points included in the filtered projection point cloud; when there are multiple effective projection points corresponding to the first three-dimensional road point cloud
  • the three-dimensional road surface coloring device after restoring the uncolored three-dimensional road surface to the first three-dimensional road surface point cloud, can project the second three-dimensional road surface point cloud near the road image into the road image to obtain projection points. cloud, and directly color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point located in the target area into the target color, where the target area includes the static road perceived in the road image
  • the target 3D pavement points include 3D pavement points that have a direct mapping relationship with the target projection point or the elevation of these 3D pavement points is adjusted. 3D waypoints obtained after high.
  • the second three-dimensional road point cloud in the three-dimensional road surface is directly projected onto the two-dimensional road image, and the road edge line perceived in the road image and its nearby projection points and the three-dimensional road point points are used.
  • the mapping relationship directly determines the three-dimensional road points of the road edge line and colors them. Therefore, the embodiment of the present application does not need to construct a plane, and does not involve the problem of inconsistency between the plane and the three-dimensional road slope. Therefore, there is no need to iteratively search for nearby curved surfaces, and thus both Improving the generation efficiency of road edge lines can also improve the accuracy.
  • another embodiment of the present application provides a storage medium on which executable instructions are stored. When executed by a processor, the instructions cause the processor to implement the method described in any of the above embodiments.
  • an electronic device or computer device including:
  • processors one or more processors
  • a storage device for storing one or more programs
  • the electronic device or computer device is caused to implement the method described in any of the above embodiments.
  • another embodiment of the present application provides a vehicle, which includes the device as described in any of the above embodiments, or includes the electronic device as described above.
  • the vehicle includes a CPU (Central Processing Unit, central processing unit) 31, a GPS (Global Positioning System, global positioning system) positioning device 32, a T-Box (Telematics Box, a remote information processor) 33, a V2X ( Vehicle-to-Everything (Internet of Vehicles) module 34, lidar 35 and camera 36.
  • the GPS positioning device 32 is used to obtain the current geographical location of the vehicle;
  • the T-Box 33 can be used as a gateway to communicate with the server;
  • the CPU 31 can execute the three-dimensional road surface coloring method mentioned in the above embodiment;
  • the laser radar 35 is used to collect the information in front of the vehicle. Radar point cloud; camera 36 is used to collect images of the road in front of the vehicle.
  • modules in the device in the embodiment may be distributed in the device in the embodiment according to the description of the embodiment, or may be correspondingly changed and located in one or more devices different from this embodiment.
  • the modules of the above embodiments can be combined into one module, or further divided into multiple sub-modules.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Graphics (AREA)
  • Image Processing (AREA)

Abstract

Disclosed in the present application are a coloring method and apparatus for a three-dimensional road surface, and a storage medium, an electronic device and a vehicle, which can solve the problem of the generation of a road edge line being time-consuming and inaccurate. The method comprises: performing a restoration operation on a three-dimensional road surface according to a preset distance, and curved-surface parameters of the three-dimensional road surface, so as to generate a first three-dimensional road surface point cloud; according to the pose of each frame of road image in the first three-dimensional road surface point cloud, determining a second three-dimensional road surface point cloud corresponding to the road image, wherein the second three-dimensional road surface point cloud comprises three-dimensional road surface points, the distances from which to the pose of the road image are less than or equal to the preset spacing, in the first three-dimensional road surface point cloud; projecting the second three-dimensional road surface point cloud to the corresponding road image, so as to obtain a projection point cloud in the road image; and coloring, by means of a target color, target three-dimensional road surface points, which correspond to target projection points, in the first three-dimensional road surface point cloud, so as to display a road edge of the three-dimensional road surface in a highlighted manner, wherein the target projection points comprise projection points, which are located in a target area, in a projection point cloud of each frame of road image.

Description

三维路面的着色方法、装置、存储介质、电子设备及车辆Three-dimensional road surface coloring method, device, storage medium, electronic equipment and vehicle 技术领域Technical field
本申请涉及汽车技术领域,具体而言,涉及一种三维路面的着色方法、装置、存储介质、电子设备及车辆。The present application relates to the field of automotive technology, specifically, to a three-dimensional road surface coloring method, device, storage medium, electronic equipment and vehicle.
背景技术Background technique
电子地图是利用计算机技术,以数字方式存储和查阅的地图。人们在步行、骑行或者驾驶时,均可以通过查阅电子地图来获取去往目的地的路线,并且还可以通过开启智能导航功能实时导航。为了提高用户体验以及提高电子地图查询的准确度,已逐渐从二维电子地图发展为三维电子地图。生成三维电子地图最关键的环节之一就是生成三维路面。相关技术中,主要依靠激光雷达采集雷达点云生成三维路面。并且在基于该三维路面对停止线、人行道、导流带等路面要素进行质量检查和修正时,为了提高准确性和效率,可以在三维路面中生成道路边缘线作为参考线。Electronic maps are maps that are stored and consulted digitally using computer technology. When people are walking, riding, or driving, they can get the route to their destination by consulting the electronic map, and they can also navigate in real time by turning on the intelligent navigation function. In order to improve user experience and improve the accuracy of electronic map query, it has gradually developed from two-dimensional electronic maps to three-dimensional electronic maps. One of the most critical aspects of generating a three-dimensional electronic map is generating a three-dimensional road surface. In related technologies, lidar is mainly relied on to collect radar point clouds to generate three-dimensional road surfaces. In order to improve accuracy and efficiency when performing quality inspections and corrections on pavement elements such as stop lines, sidewalks, and diversion strips based on this three-dimensional road surface, road edge lines can be generated in the three-dimensional road surface as reference lines.
相关技术中生成道路边缘线的方法主要包括:获取基于采集车的激光雷达采集雷达点云时,采集车的相机采集的每帧道路图像;感知每帧道路图像中的道路边缘线;基于每帧道路图像中道路边缘线上一个像素点的对地参数向三维路面投影获得投影点,并以该投影点为中心,以该道路图像的对地参数为法向量,拟合包含该投影点的平面;将该像素点投射到对应的平面上,与平面的交点即为三维路面中道路边缘线的点。然而,当三维路面的部分曲面存在坡度,而拟合的平面没有坡度时,直接将该交点作为道路边缘线的点就会导致不准确。为了提高准确率,可以基于该交点寻找附近的曲面,逐渐迭代到正确的位置上,但是这种盲目迭代方式不仅耗时,还有可能找不到正确的曲面。Methods for generating road edge lines in related technologies mainly include: obtaining each frame of road image collected by the camera of the collection vehicle when collecting radar point clouds based on the lidar of the collection vehicle; perceiving the road edge line in each frame of road image; based on each frame The ground parameter of a pixel on the road edge line in the road image is projected onto the three-dimensional road surface to obtain a projection point, and with the projection point as the center and the ground parameter of the road image as the normal vector, a plane containing the projection point is fitted. ; Project the pixel point onto the corresponding plane, and the intersection point with the plane is the point of the road edge line in the three-dimensional road surface. However, when part of the curved surface of the three-dimensional road surface has a slope, but the fitted plane does not have a slope, directly using the intersection point as the point of the road edge line will lead to inaccuracy. In order to improve the accuracy, you can find nearby surfaces based on the intersection point and gradually iterate to the correct position. However, this blind iteration method is not only time-consuming, but also may not find the correct surface.
发明内容Contents of the invention
本申请提供了一种三维路面的着色方法、装置、存储介质、电子设备及车辆,能够解决生成道路边缘线耗时且不准确的问题。This application provides a three-dimensional road surface coloring method, device, storage medium, electronic equipment and vehicle, which can solve the problem of time-consuming and inaccurate generation of road edge lines.
具体的技术方案如下:The specific technical solutions are as follows:
第一方面,本申请实施例提供了一种三维路面的着色方法,所述方法包括:In a first aspect, embodiments of the present application provide a three-dimensional road surface coloring method, which method includes:
根据预设间距和三维路面的曲面参数,对所述三维路面进行还原操作,生成第一三维路面点云,其中,所述三维路面为基于原始雷达点云拟合而成的未着色的三维路面;According to the preset spacing and the surface parameters of the three-dimensional road surface, a restoration operation is performed on the three-dimensional road surface to generate a first three-dimensional road point cloud, wherein the three-dimensional road surface is an uncolored three-dimensional road surface fitted based on the original radar point cloud. ;
根据每帧道路图像在所述第一三维路面点云中的位姿,确定所述道路图像对应的第二三维路面点云,其中,所述道路图像为采集车的激光雷达采集所述原始雷达点云时,所述采集车的相机采集的道路图像,所述第二三维路面点云包括在所述第一三维路面点云中,与所述道路图像的所述位姿相距小于或者等于预设距离的三维路面点;According to the position and orientation of each frame of road image in the first three-dimensional road point cloud, the second three-dimensional road point cloud corresponding to the road image is determined, wherein the road image is the original radar collected by the laser radar of the collection vehicle. When the point cloud is generated, in the road image collected by the camera of the collecting vehicle, the second three-dimensional road point cloud is included in the first three-dimensional road point cloud, and the distance from the pose of the road image is less than or equal to a predetermined distance. Set the distance between the three-dimensional road points;
将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云;Project the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image;
将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示所述三维路面的道路边缘,其中,所述目标投影点包括每帧所述道路图像的所述投影点云中位于目标区域内的投影点,所述目标区域包括与所述道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域,所述目标三维路面点包括与所述目标投影点具有直接映射关系的三维路面点,或者在将与所述目标投影点具有直接映射关系的三维路面点的高程调高预设高度后获得的三维路面点。Coloring the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface, wherein the target projection point includes the road in each frame Projection points located within a target area in the projection point cloud of the image, the target area including pixels having the same abscissa as the static road edge line perceived in the road image and a difference in ordinates within a preset difference range In the constituted area, the target three-dimensional road point includes a three-dimensional road point that has a direct mapping relationship with the target projection point, or the elevation of the three-dimensional road point that has a direct mapping relationship with the target projection point is preset. 3D pavement points obtained after height.
通过上述方案可知,本申请实施例在将未着色的三维路面还原成第一三维路面点云之后,可以将道路图像附近的第二三维路面点云投影到该道路图像中获得投影点云,并且直接将投影点云中位于目标区域内的目标投影点所对应的第一三维路面点云中的目标三维路面点着色成目标颜色,其中,目标区域包括与道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域,目标三维路面点包括与目标投影点具有直接映射关系的三维路面点或者将这些三维路面点的高程调高后获得的三维路点。由此可知,由于本申请实施例是三维路面中的第二三维路面点云直接向二维的道路图像进行投影,且利用道路图像中感知的道路边缘线及其附近的投影点与三维路面点的映射关系,直接确定道路边缘线的三维路面点,并对其进行着色,所以本申请实施例无需构建平面,不涉及平面与三维路面坡度不一致的问题,从而无需迭代寻找附近曲面,进而既可以提高道路边缘线的生成效率,又可以提高准确率。It can be seen from the above solution that after restoring the uncolored three-dimensional road surface to the first three-dimensional road point cloud, the embodiment of the present application can project the second three-dimensional road point cloud near the road image into the road image to obtain the projection point cloud, and Directly color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point located in the target area in the projection point cloud into the target color, wherein the target area includes a static road edge line that is transverse to the perceived static road edge in the road image. An area composed of pixels with the same coordinates and a difference in ordinates within a preset difference range. The target 3D road points include 3D road points that have a direct mapping relationship with the target projection point or are obtained by raising the elevation of these 3D road points. 3D waypoint. It can be seen from this that in the embodiment of the present application, the second three-dimensional road point cloud in the three-dimensional road surface is directly projected onto the two-dimensional road image, and the road edge line perceived in the road image and its nearby projection points and the three-dimensional road point points are used. The mapping relationship directly determines the three-dimensional road points of the road edge line and colors them. Therefore, the embodiment of the present application does not need to construct a plane, and does not involve the problem of inconsistency between the plane and the three-dimensional road slope. Therefore, there is no need to iteratively search for nearby curved surfaces, and thus both Improving the generation efficiency of road edge lines can also improve the accuracy.
在第一方面的第一种可能的实现方式中,在所述将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云之前,所述方法还包括:In a first possible implementation of the first aspect, before projecting the second three-dimensional road point cloud to the corresponding road image and obtaining the projected point cloud in the road image, the method Also includes:
将所述第二三维路面点云从站心坐标系转换到相机坐标系;Convert the second three-dimensional road point cloud from the station center coordinate system to the camera coordinate system;
过滤所述相机坐标系下所述第二三维路面点云中的无效三维路面点,其中,所述无效三维路面点包括高程在目标高程范围外的三维路面点、前向坐标小于或者等于0的三维路面点;Filter invalid three-dimensional road points in the second three-dimensional road point cloud under the camera coordinate system, wherein the invalid three-dimensional road points include three-dimensional road points with elevations outside the target elevation range, and forward coordinates less than or equal to 0. 3D pavement points;
所述将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云,包括:Projecting the second three-dimensional road point cloud to the corresponding road image and obtaining the projected point cloud in the road image includes:
将所述相机坐标系下过滤后的所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的所述投影点云。Project the filtered second three-dimensional road point cloud in the camera coordinate system to the corresponding road image to obtain the projected point cloud in the road image.
通过上述方案可知,本申请实施例通过滤掉高程在目标高程范围外的三维路面点,可以去除桥上桥下或者上下分层的路段,从而使得获得的投影点云更加准确,通过过滤掉前向坐标小于或者等于0的三维路面点,可以过滤掉位于相机拍摄视野以外的三维路面点,从而可以降低相机坐标系向图像坐标系转换的数据量,提高道路边缘的生成效率。It can be seen from the above solution that the embodiment of the present application can remove the road sections above and below the bridge or layered above and below the bridge by filtering out the three-dimensional road points whose elevation is outside the target elevation range, thereby making the obtained projection point cloud more accurate. By filtering out the previous Three-dimensional road points with coordinates less than or equal to 0 can be filtered out three-dimensional road points located outside the camera's shooting field of view, thereby reducing the amount of data converted from the camera coordinate system to the image coordinate system and improving the efficiency of road edge generation.
在第一方面的第二种可能的实现方式中,在所述将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示所述三维路面的道路边缘之前,所述方法还包括:In a second possible implementation manner of the first aspect, the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point is colored into a target color to highlight the three-dimensional road surface. Before the road edge, the method also includes:
过滤所述投影点云中的无效投影点,其中,所述无效投影点包括位于图像坐标系以外的投影点、位于所述采集车的车盖线下方的投影点、位于所述静态道路边缘线上方的投影点以及位于动态道路边缘线上方的投影点。Filter invalid projection points in the projection point cloud, where the invalid projection points include projection points located outside the image coordinate system, projection points located below the hood line of the collection vehicle, and projection points located on the static road edge line Projection points above and above the dynamic road edge lines.
通过上述方案可知,本申请实施例通过过滤掉可行驶区域以外的投影点(即无效投影点),可以提高投影点云的准确性,从而不仅可以提高生成道路边缘的准确性,还可以提高后续生成彩色路面或语义分割路面的准确性。It can be seen from the above solution that the embodiment of the present application can improve the accuracy of the projected point cloud by filtering out projection points outside the drivable area (that is, invalid projection points), thereby not only improving the accuracy of generating road edges, but also improving the subsequent Accuracy in generating colored pavement or semantically segmented pavement.
在第一方面的第三种可能的实现方式中,所述将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,包括:In a third possible implementation manner of the first aspect, coloring the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color includes:
将所述第一三维路面点云中满足预设条件的三维路面点确定为所述目标三维路面点,并将所述目标三维路面点着色成所述目标颜色;Determine three-dimensional road points in the first three-dimensional road point cloud that meet preset conditions as the target three-dimensional road points, and color the target three-dimensional road points into the target color;
其中,所述预设条件包括如下任意一项:Wherein, the preset conditions include any one of the following:
所述第一三维路面点云中与所述目标投影点具有直接映射关系的三维路面点;Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
在将所述具有直接映射关系的三维路面点的高程调高所述预设高度后,获得的三维路面点;The three-dimensional road point obtained after raising the elevation of the three-dimensional road point with a direct mapping relationship by the preset height;
在基于可行驶区域点云对所述具有直接映射关系的三维路面点进行过滤后的三维路面点,所述可行驶区域点云包括过滤后的所述投影点云中,位于由所述车盖线、所述静态道路边缘线和动态道路边缘线所围成的区域内的投影点对应的第一三维路面点云中的三维路面点;The three-dimensional road points with a direct mapping relationship are filtered based on the drivable area point cloud. The drivable area point cloud includes the filtered projection point cloud, which is located by the vehicle cover. Lines, three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the static road edge line and the dynamic road edge line;
在基于所述可行驶区域点云对所述具有直接映射关系的三维路面点进行过滤后,对剩余的三维路面点的高程调高所述预设高度后获得的三维路面点。After filtering the three-dimensional road points with a direct mapping relationship based on the drivable area point cloud, the remaining three-dimensional road points are obtained by raising the elevation of the preset height.
通过上述方案可知,本申请实施例将高程调高可以避免绘制的道路边缘遮挡原本的路面地标,通过可行驶区域点云过可以过滤掉道路内的三维路面点,从而提高道路边缘的准确率和展示效果。It can be seen from the above solution that by raising the elevation in the embodiment of the present application, the drawn road edge can avoid blocking the original road landmarks, and the three-dimensional road points in the road can be filtered out through the drivable area point cloud, thereby improving the accuracy and accuracy of the road edge. Display of results.
在第一方面的第四种可能的实现方式中,在所述过滤所述相机坐标系下所述第二三维路面点云中的无效三维路面点之后,所述方法还包括:In a fourth possible implementation manner of the first aspect, after filtering invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, the method further includes:
根据所述相机坐标系下过滤后的所述第二三维路面点云中每个待处理的三维路面点的目标距离,计算所述待处理的三维路面点对应的权重值,其中,所述目标距离为所述待处理的三维路面点的横向坐标与前向坐标之间的目标距离,所述目标距离与所述权重值呈负相关关系;According to the target distance of each three-dimensional road point to be processed in the filtered second three-dimensional road point cloud in the camera coordinate system, the weight value corresponding to the three-dimensional road point to be processed is calculated, where the target The distance is the target distance between the transverse coordinate and the forward coordinate of the three-dimensional road point to be processed, and the target distance has a negative correlation with the weight value;
在所述过滤所述投影点云中的无效投影点之后,所述方法还包括:After filtering invalid projection points in the projection point cloud, the method further includes:
在只有一个有效投影点对应所述第一三维路面点云中的一个三维路面点的情况下,将所述有效投影点对应的所述第一三维路面点云中的三维路面点着色成所述有效投影点的颜色值,其中,所述有效投影点为过滤后的所述投影点云中包含的投影点;In the case where there is only one valid projection point corresponding to one three-dimensional road point in the first three-dimensional road point cloud, the three-dimensional road point in the first three-dimensional road point cloud corresponding to the valid projection point is colored into the above-mentioned The color value of a valid projection point, wherein the valid projection point is a projection point included in the filtered projection point cloud;
在存在多个有效投影点对应所述第一三维路面点云中的同一个三维路面点的情况下,对所述多个有效投影点的所述颜色值和所述权重值进行加权计算,并将所述多个有效投影点对应的三维路面点着色成加权后的颜色值,其中,所述多个有效投影点中每个所述有效投影点分别位于不同所述道路图像中。When there are multiple valid projection points corresponding to the same three-dimensional road point in the first three-dimensional road point cloud, perform a weighted calculation on the color values and the weight values of the multiple valid projection points, and The three-dimensional road points corresponding to the plurality of valid projection points are colored into weighted color values, wherein each of the plurality of valid projection points is located in a different road image.
通过上述方案可知,本申请实施例可以通过对有效投影点对应的第一三维路面点云中的三维路面点进行着色,可以实现对三维路面的着色,如当道路图像是彩色图像时,可以得到彩色路面,当道路图像是语义分割图像时,可以得到语义分割路面。并且在对三维路面进行着色时,还可以根据距离信息确定的权重值进行加权计算,从而提高了对三维路面着色的准确性。It can be seen from the above solution that the embodiment of the present application can realize the coloring of the three-dimensional road surface by coloring the three-dimensional road points in the first three-dimensional road point cloud corresponding to the effective projection point. For example, when the road image is a color image, it can be obtained Colored pavement, when the road image is a semantic segmentation image, the semantic segmentation of the pavement can be obtained. And when coloring the three-dimensional road surface, weighted calculations can also be performed based on the weight value determined by the distance information, thereby improving the accuracy of the three-dimensional road surface coloring.
第二方面,本申请实施例提供了一种三维路面的着色装置,所述装置包括:In a second aspect, embodiments of the present application provide a three-dimensional road surface coloring device. The device includes:
还原单元,用于根据预设间距和三维路面的曲面参数,对所述三维路面进行还原操作,生成第一三维路面点云,其中,所述三维路面为基于原始雷达点云拟合而成的未着色的三维路面;A restoration unit, configured to restore the three-dimensional road surface according to the preset spacing and the surface parameters of the three-dimensional road surface, and generate a first three-dimensional road surface point cloud, wherein the three-dimensional road surface is fitted based on the original radar point cloud. Uncolored three-dimensional pavement;
确定单元,用于根据每帧道路图像在所述第一三维路面点云中的位姿,确定所述道路图像对应的第二三维路面点云,其中,所述道路图像为采集车的激光雷达采集所述原始雷达点云时,所述采集车的相机采集的道路图像,所述第二三维路面点云包括在所述第一三维路面点云中,与所述道路图像的所述位姿相距小于或者等于预设距离的三维路面点;Determining unit, configured to determine the second three-dimensional road point cloud corresponding to the road image according to the position and orientation of each frame of the road image in the first three-dimensional road point cloud, wherein the road image is the lidar of the collection vehicle When collecting the original radar point cloud, the road image collected by the camera of the collecting vehicle, the second three-dimensional road point cloud is included in the first three-dimensional road point cloud, and the pose of the road image Three-dimensional road points whose distance is less than or equal to the preset distance;
投影单元,用于将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云;A projection unit configured to project the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image;
着色单元,用于将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示所述三维路面的道路边缘,其中,所述目标投影点包括每 帧所述道路图像的所述投影点云中位于目标区域内的投影点,所述目标区域包括与所述道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域,所述目标三维路面点包括与所述目标投影点具有直接映射关系的三维路面点,或者在将与所述目标投影点具有直接映射关系的三维路面点的高程调高预设高度后获得的三维路面点。A coloring unit configured to color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface, wherein the target projection point includes Projection points located within a target area in the projection point cloud of the road image in each frame. The target area includes the same abscissa as the static road edge line perceived in the road image and the difference between the ordinates is within a preset difference. The area composed of pixel points within the range, the target three-dimensional road point includes a three-dimensional road point that has a direct mapping relationship with the target projection point, or the three-dimensional road point that will have a direct mapping relationship with the target projection point. The three-dimensional road points obtained by raising the elevation to a preset height.
在第二方面的第一种可能的实现方式中,所述装置还包括:In a first possible implementation manner of the second aspect, the device further includes:
坐标系转换单元,用于在所述将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云之前,将所述第二三维路面点云从站心坐标系转换到相机坐标系;A coordinate system conversion unit configured to project the second three-dimensional road point cloud to the corresponding road image and obtain the projected point cloud in the road image, converting the second three-dimensional road point cloud from Convert the station center coordinate system to the camera coordinate system;
第一过滤单元,用于过滤所述相机坐标系下所述第二三维路面点云中的无效三维路面点,其中,所述无效三维路面点包括高程在目标高程范围外的三维路面点、前向坐标小于或者等于0的三维路面点;The first filtering unit is used to filter invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, where the invalid three-dimensional road points include three-dimensional road points with elevations outside the target elevation range, previous Three-dimensional road points with coordinates less than or equal to 0;
所述投影单元,用于将所述相机坐标系下过滤后的所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的所述投影点云。The projection unit is configured to project the filtered second three-dimensional road point cloud in the camera coordinate system to the corresponding road image to obtain the projected point cloud in the road image.
在第二方面的第二种可能的实现方式中,所述装置还包括:In a second possible implementation manner of the second aspect, the device further includes:
第二过滤单元,用于在所述将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示所述三维路面的道路边缘之前,过滤所述投影点云中的无效投影点,其中,所述无效投影点包括位于图像坐标系以外的投影点、位于所述采集车的车盖线下方的投影点、位于所述静态道路边缘线上方的投影点以及位于动态道路边缘线上方的投影点。A second filtering unit configured to filter all target three-dimensional road points in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface. Invalid projection points in the projection point cloud, wherein the invalid projection points include projection points located outside the image coordinate system, projection points located below the hood line of the collection vehicle, and projection points located above the static road edge line Projection points and projection points above dynamic road edge lines.
在第二方面的第三种可能的实现方式中,所述着色单元,用于将所述第一三维路面点云中满足预设条件的三维路面点确定为所述目标三维路面点,并将所述目标三维路面点着色成所述目标颜色;In a third possible implementation manner of the second aspect, the coloring unit is configured to determine a three-dimensional road point in the first three-dimensional road point cloud that satisfies a preset condition as the target three-dimensional road point, and The target three-dimensional road surface points are colored into the target color;
其中,所述预设条件包括如下任意一项:Wherein, the preset conditions include any one of the following:
所述第一三维路面点云中与所述目标投影点具有直接映射关系的三维路面点;Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
在将所述具有直接映射关系的三维路面点的高程调高所述预设高度后,获得的三维路面点;The three-dimensional road point obtained after raising the elevation of the three-dimensional road point with a direct mapping relationship by the preset height;
在基于可行驶区域点云对所述具有直接映射关系的三维路面点进行过滤后的三维路面点,所述可行驶区域点云包括过滤后的所述投影点云中,位于由所述车盖线、所述静态道路边缘线和动态道路边缘线所围成的区域内的投影点对应的第一三维路面点云中的三维路面点;The three-dimensional road points with a direct mapping relationship are filtered based on the drivable area point cloud. The drivable area point cloud includes the filtered projection point cloud, which is located by the vehicle cover. Lines, three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the static road edge line and the dynamic road edge line;
在基于所述可行驶区域点云对所述具有直接映射关系的三维路面点进行过滤后,对 剩余的三维路面点的高程调高所述预设高度后获得的三维路面点。After filtering the three-dimensional road points with a direct mapping relationship based on the drivable area point cloud, the remaining three-dimensional road points are obtained by raising the elevation of the preset height.
在第二方面的第四种可能的实现方式中,所述装置还包括:In a fourth possible implementation manner of the second aspect, the device further includes:
计算单元,用于在所述过滤所述相机坐标系下所述第二三维路面点云中的无效三维路面点之后,根据所述相机坐标系下过滤后的所述第二三维路面点云中每个待处理的三维路面点的目标距离,计算所述待处理的三维路面点对应的权重值,其中,所述目标距离为所述待处理的三维路面点的横向坐标与前向坐标之间的目标距离,所述目标距离与所述权重值呈负相关关系;A computing unit configured to, after filtering the invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, calculate the filtered second three-dimensional road point cloud in the camera coordinate system. The target distance of each three-dimensional road point to be processed is calculated, and the weight value corresponding to the three-dimensional road point to be processed is calculated, where the target distance is between the lateral coordinate and the forward coordinate of the three-dimensional road point to be processed. The target distance has a negative correlation with the weight value;
所述着色单元,还用于在所述过滤所述投影点云中的无效投影点之后,在只有一个有效投影点对应所述第一三维路面点云中的一个三维路面点的情况下,将所述有效投影点对应的所述第一三维路面点云中的三维路面点着色成所述有效投影点的颜色值,其中,所述有效投影点为过滤后的所述投影点云中包含的投影点;在存在多个有效投影点对应所述第一三维路面点云中的同一个三维路面点的情况下,对所述多个有效投影点的所述颜色值和所述权重值进行加权计算,并将所述多个有效投影点对应的三维路面点着色成加权后的颜色值,其中,所述多个有效投影点中每个所述有效投影点分别位于不同所述道路图像中。The coloring unit is also configured to, after filtering the invalid projection points in the projection point cloud, when there is only one valid projection point corresponding to a three-dimensional road point in the first three-dimensional road point cloud, The three-dimensional road points in the first three-dimensional road point cloud corresponding to the effective projection points are colored into the color values of the effective projection points, wherein the effective projection points are included in the filtered projection point cloud. Projection points; when there are multiple valid projection points corresponding to the same three-dimensional road point in the first three-dimensional road point cloud, weight the color values and the weight values of the multiple valid projection points. Calculate and color the three-dimensional road points corresponding to the plurality of valid projection points into weighted color values, wherein each of the plurality of valid projection points is located in a different road image.
本申请实施例提供的三维路面的着色装置,在将未着色的三维路面还原成第一三维路面点云之后,可以将道路图像附近的第二三维路面点云投影到该道路图像中获得投影点云,并且直接将投影点云中位于目标区域内的目标投影点所对应的第一三维路面点云中的目标三维路面点着色成目标颜色,其中,目标区域包括与道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域,目标三维路面点包括与目标投影点具有直接映射关系的三维路面点或者将这些三维路面点的高程调高后获得的三维路点。由此可知,由于本申请实施例是三维路面中的第二三维路面点云直接向二维的道路图像进行投影,且利用道路图像中感知的道路边缘线及其附近的投影点与三维路面点的映射关系,直接确定道路边缘线的三维路面点,并对其进行着色,所以本申请实施例无需构建平面,不涉及平面与三维路面坡度不一致的问题,从而无需迭代寻找附近曲面,进而既可以提高道路边缘线的生成效率,又可以提高准确率。The three-dimensional road surface coloring device provided by the embodiment of the present application, after restoring the uncolored three-dimensional road surface to the first three-dimensional road surface point cloud, can project the second three-dimensional road surface point cloud near the road image into the road image to obtain projection points. cloud, and directly color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point located in the target area into the target color, where the target area includes the static road perceived in the road image The area composed of pixels with the same abscissa coordinate of the edge line and the difference between the ordinates within the preset difference range. The target 3D pavement points include 3D pavement points that have a direct mapping relationship with the target projection point or the elevation of these 3D pavement points is adjusted. 3D waypoints obtained after high. It can be seen from this that in the embodiment of the present application, the second three-dimensional road point cloud in the three-dimensional road surface is directly projected onto the two-dimensional road image, and the road edge line perceived in the road image and its nearby projection points and the three-dimensional road point points are used. The mapping relationship directly determines the three-dimensional road points of the road edge line and colors them. Therefore, the embodiment of the present application does not need to construct a plane, and does not involve the problem of inconsistency between the plane and the three-dimensional road slope. Therefore, there is no need to iteratively search for nearby curved surfaces, and thus both Improving the generation efficiency of road edge lines can also improve the accuracy.
第三方面,本申请实施例提供了一种存储介质,其上存储有计算机程序,该程序被处理器执行时实现如第一方面任一可能的实现方式所述的方法。In a third aspect, embodiments of the present application provide a storage medium on which a computer program is stored. When the program is executed by a processor, the method described in any possible implementation of the first aspect is implemented.
第四方面,本申请实施例提供了一种电子设备,电子设备包括:In a fourth aspect, embodiments of the present application provide an electronic device. The electronic device includes:
一个或多个处理器;one or more processors;
存储装置,用于存储一个或多个程序,a storage device for storing one or more programs,
当一个或多个程序被一个或多个处理器执行,使得电子设备实现如第一方面任一可 能的实现方式所述的方法。When one or more programs are executed by one or more processors, the electronic device implements the method described in any possible implementation manner of the first aspect.
第五方面,本申请实施例提供了一种车辆,车辆包含如第二方面任一可能的实现方式所述的装置,或者包含如第四方面所述的电子设备。In a fifth aspect, embodiments of the present application provide a vehicle, which includes the device as described in any possible implementation of the second aspect, or the electronic device as described in the fourth aspect.
附图说明Description of drawings
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单介绍。显而易见地,下面描述中的附图仅仅是本申请的一些实施例。对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to more clearly explain the embodiments of the present application or the technical solutions in the prior art, the following will briefly introduce the drawings that need to be used in the description of the embodiments or the prior art. Obviously, the drawings in the following description are only some embodiments of the present application. For those of ordinary skill in the art, other drawings can also be obtained based on these drawings without exerting creative efforts.
图1为本申请实施例提供的一种三维路面的着色方法的流程示意图;Figure 1 is a schematic flow chart of a three-dimensional road surface coloring method provided by an embodiment of the present application;
图2为本申请实施例提供的坐标系的示意图;Figure 2 is a schematic diagram of the coordinate system provided by the embodiment of the present application;
图3为本申请实施例提供的一种无效投影点和有效投影点的示例图;Figure 3 is an example diagram of an invalid projection point and a valid projection point provided by an embodiment of the present application;
图4为本申请实施例提供的一种三维路面的着色装置的组成框图;Figure 4 is a block diagram of a three-dimensional road surface coloring device provided by an embodiment of the present application;
图5为本申请实施例提供的一种车辆的结构示意图。Figure 5 is a schematic structural diagram of a vehicle provided by an embodiment of the present application.
具体实施方式Detailed ways
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整的描述。显然,所描述的实施例仅仅是本申请的一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有付出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。The technical solutions in the embodiments of the present application will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present application. Obviously, the described embodiments are only some of the embodiments of the present application, but not all of the embodiments. Based on the embodiments in this application, all other embodiments obtained by those of ordinary skill in the art without creative efforts fall within the scope of protection of this application.
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。本申请实施例及附图中的术语“包括”和“具有”以及它们的任何变形,意图在于覆盖不排他的包含。例如包含的一系列步骤或单元的过程、方法、系统、产品或设备没有限定于已列出的步骤或单元,而是可选地还包括没有列出的步骤或单元,或可选地还包括对于这些过程、方法、产品或设备固有的其他步骤或单元。It should be noted that, as long as there is no conflict, the embodiments and features in the embodiments of this application can be combined with each other. The terms "including" and "having" and any variations thereof in the embodiments and drawings of this application are intended to cover non-exclusive inclusion. For example, a process, method, system, product or device that includes a series of steps or units is not limited to the listed steps or units, but optionally also includes steps or units that are not listed, or optionally also includes Other steps or units inherent to such processes, methods, products or devices.
图1为一种三维路面的着色方法的流程示意图,该方法可以应用于电子设备或计算机设备,具体可以应用于车辆或者服务器,该方法可以包括如下步骤:Figure 1 is a schematic flow chart of a three-dimensional road surface coloring method. This method can be applied to electronic equipment or computer equipment, and specifically can be applied to vehicles or servers. The method can include the following steps:
S110:根据预设间距和三维路面的曲面参数,对三维路面进行还原操作,生成第一三维路面点云。S110: According to the preset spacing and the surface parameters of the three-dimensional road surface, perform a restoration operation on the three-dimensional road surface to generate a first three-dimensional road point cloud.
其中,三维路面为基于原始雷达点云拟合而成的未着色的三维路面。本申请实施例对基于原始雷达点云生成三维路面的方法不做限制,例如,可以先从原始雷达点云筛选出关于路面的雷达点云,再对筛选出的雷达点云进行水平面方向拟合,最后进行竖直方向拟合,生成三维道路曲面作为三维路面。Among them, the three-dimensional road surface is an uncolored three-dimensional road surface fitted based on the original radar point cloud. The embodiments of this application do not limit the method of generating a three-dimensional road surface based on the original radar point cloud. For example, you can first filter out the radar point cloud about the road surface from the original radar point cloud, and then perform horizontal plane direction fitting on the filtered radar point cloud. , and finally perform vertical fitting to generate a three-dimensional road surface as a three-dimensional road surface.
第一三维路面点云中相邻三维路面点的间距为预设间距,预设间距可以为与原始雷达点云的间距相同,也可以不同,例如可以为0.5m。三维路面和第一三维路面点云均可以在站心坐标系(东-北-天坐标系ENU)下,也可以由世界坐标系转换到站心坐标系下。The distance between adjacent three-dimensional road points in the first three-dimensional road point cloud is a preset distance. The preset distance can be the same as the distance of the original radar point cloud, or it can be different, for example, it can be 0.5m. Both the three-dimensional road surface and the first three-dimensional road surface point cloud can be in the station center coordinate system (east-north-celestial coordinate system ENU), or they can be converted from the world coordinate system to the station center coordinate system.
S120:根据每帧道路图像在第一三维路面点云中的位姿,确定道路图像对应的第二三维路面点云。S120: Determine the second three-dimensional road point cloud corresponding to the road image based on the position and orientation of each frame of road image in the first three-dimensional road point cloud.
其中,道路图像为采集车的激光雷达采集原始雷达点云时,采集车的相机采集的道路图像。道路图像可以是经过采集车多趟采集和/或经过抽稀过的,并保留合理数据量。本申请实施例对相机在采集车上的安装角度及安装位置不做限定。第二三维路面点云包括在第一三维路面点云中,与道路图像的位姿相距小于或者等于预设距离的三维路面点。位姿包括位置和姿势。预设距离可以根据最终生成的道路边缘精度确定。例如,当预设距离为25m时,道路图像对应的第二三维路面点云可以为以道路图像的中心点为中心,以25m为半径,所限定的圆形区域内的第二三维路面点云。Among them, the road image is the road image collected by the camera of the collection vehicle when the lidar of the collection vehicle collects the original radar point cloud. Road images can be collected through multiple trips by a collection vehicle and/or thinned out, and a reasonable amount of data can be retained. The embodiment of this application does not limit the installation angle and installation position of the camera on the collection vehicle. The second three-dimensional road point cloud includes three-dimensional road points in the first three-dimensional road point cloud that are less than or equal to a preset distance from the pose of the road image. Pose includes position and posture. The preset distance can be determined based on the final generated road edge accuracy. For example, when the preset distance is 25m, the second three-dimensional road point cloud corresponding to the road image can be the second three-dimensional road point cloud within the circular area defined with the center point of the road image as the center and 25m as the radius. .
需要补充的是,为了提高道路边缘的生成效率,本申请实施例还可以先将第一三维路面点云划分成多个区域块,再并行对多个区域块执行步骤“根据每帧道路图像在区域块中的位姿,确定道路图像对应的第二三维路面点云”,以及后续步骤。其中,分块原则可以为:遍历第一三维路面点云,当遍历到的点云数量达到上限时,停止遍历,并遍历到的点云确定为同一个区域块,之后再继续对未遍历的第一三维路面点云采用该方法进行遍历,直至遍历完毕第一三维路面点云中所有三维路面点。It should be added that in order to improve the efficiency of road edge generation, embodiments of the present application can also first divide the first three-dimensional road point cloud into multiple area blocks, and then perform the step of "according to each frame of road image on the multiple area blocks in parallel". The pose in the area block is used to determine the second three-dimensional road point cloud corresponding to the road image," and subsequent steps. Among them, the blocking principle can be: traverse the first three-dimensional road point cloud, when the number of traversed point clouds reaches the upper limit, stop traversing, and determine the traversed point clouds to be the same area block, and then continue to traverse the untraversed point clouds. The first three-dimensional road point cloud is traversed using this method until all three-dimensional road points in the first three-dimensional road point cloud are traversed.
S130:将第二三维路面点云投影到对应的道路图像,获得道路图像中的投影点云。S130: Project the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image.
本步骤可以先将第二三维路面点云从站心坐标系转换到相机坐标系,再从相机坐标系转换到图像坐标系,从而实现第二三维路面点云向道路图像的投影,获得道路图像中的投影点云。This step can first convert the second three-dimensional road point cloud from the station center coordinate system to the camera coordinate system, and then convert it from the camera coordinate system to the image coordinate system, thereby realizing the projection of the second three-dimensional road point cloud to the road image and obtaining the road image. Projection point cloud in .
S140:将目标投影点所对应的第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示三维路面的道路边缘。S140: Color the target three-dimensional road surface point in the first three-dimensional road surface point cloud corresponding to the target projection point into the target color to highlight the road edge of the three-dimensional road surface.
其中,目标投影点包括每帧道路图像的投影点云中位于目标区域内的投影点,目标区域包括与道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域。静态道路边缘线包括道路围栏等用于区分道路与非道路的固定分界线,而动态道路边缘线为采集车前方车辆尾部边缘,因此动态道路边缘线可能有,也可能没有。预设差异范围可以根据最终生成的道路边缘精度确定,例如可以为5个像素点。目标颜色包括除了路面颜色以外的其他颜色,尤其与路面颜色差异较大的颜色,例如,可以为红色、绿色等。感知静态道路边缘线、动态道路边缘线下述实施例中提及车盖线的方法可以为:预先对大量历史道路图像对这三种线中至少一种进行标注,再利 用包含标注信息的历史道路图像进行模型训练,获得目标检测模型,最后利用目标检测模型检测待感知的道路图像中的线条。其中,目标检测模型可以为CNN(Convolutional Neural Network,卷积神经网络)模型。Among them, the target projection points include projection points located in the target area in the projection point cloud of each frame of the road image. The target area includes the same abscissa as the static road edge line perceived in the road image and the difference in the ordinate is within the preset difference range. The area composed of pixels. Static road edge lines include road fences and other fixed dividing lines used to distinguish roads from non-roads, while dynamic road edge lines are the rear edges of vehicles in front of the collection vehicle, so there may or may not be dynamic road edge lines. The preset difference range can be determined based on the final generated road edge accuracy, for example, it can be 5 pixels. The target color includes colors other than the color of the road surface, especially colors that are significantly different from the color of the road surface, for example, it can be red, green, etc. The method for perceiving static road edge lines and dynamic road edge lines mentioned in the following embodiments may be: labeling at least one of these three types of lines on a large number of historical road images in advance, and then using the history data containing the labeling information. The road image is used for model training to obtain a target detection model, and finally the target detection model is used to detect lines in the road image to be sensed. Among them, the target detection model can be a CNN (Convolutional Neural Network, convolutional neural network) model.
目标三维路面点包括与目标投影点具有直接映射关系的三维路面点,或者在将与目标投影点具有直接映射关系的三维路面点的高程调高预设高度后获得的三维路面点。与目标投影点具有直接映射关系的三维路面点是指:目标投影点和三维路面点分别为在不同坐标系下的同一个点。预设高度可以根据最终生成的道路边缘精度确定。The target three-dimensional road surface points include three-dimensional road surface points that have a direct mapping relationship with the target projection point, or three-dimensional road surface points that are obtained after raising the elevation of the three-dimensional road surface point that has a direct mapping relationship with the target projection point by a preset height. The three-dimensional road surface point that has a direct mapping relationship with the target projection point means that the target projection point and the three-dimensional road surface point are the same point in different coordinate systems. The preset height can be determined based on the final generated road edge accuracy.
具体的,可以将第一三维路面点云中满足预设条件的三维路面点确定为目标三维路面点,并将目标三维路面点着色成目标颜色;Specifically, the three-dimensional road points in the first three-dimensional road point cloud that meet the preset conditions can be determined as the target three-dimensional road points, and the target three-dimensional road points can be colored into the target color;
其中,预设条件包括如下任意一项:Among them, the preset conditions include any of the following:
第一三维路面点云中与目标投影点具有直接映射关系的三维路面点;Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
在将具有直接映射关系的三维路面点的高程调高预设高度后,获得的三维路面点;The three-dimensional pavement point obtained after raising the elevation of the three-dimensional pavement point with a direct mapping relationship by a preset height;
在基于可行驶区域点云对具有直接映射关系的三维路面点进行过滤后的三维路面点,可行驶区域点云包括过滤后的投影点云中,位于由采集车车盖线、静态道路边缘线和动态道路边缘线所围成的区域内的投影点对应的第一三维路面点云中的三维路面点;The three-dimensional road points with direct mapping relationships are filtered based on the drivable area point cloud. The drivable area point cloud includes the filtered projection point cloud, which is located between the collected vehicle cover line and the static road edge line. Three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the dynamic road edge lines;
在基于可行驶区域点云对具有直接映射关系的三维路面点进行过滤后,对剩余的三维路面点的高程调高预设高度后获得的三维路面点。After filtering the three-dimensional road points with direct mapping relationships based on the drivable area point cloud, the three-dimensional road points obtained by raising the elevation of the remaining three-dimensional road points by a preset height.
本申请实施例将高程调高可以避免绘制的道路边缘遮挡原本的路面地标,通过可行驶区域点云过可以过滤掉道路内的三维路面点,从而提高道路边缘的准确率和展示效果。In the embodiment of this application, raising the elevation can prevent the drawn road edge from blocking the original road landmarks. The three-dimensional road points in the road can be filtered out through the drivable area point cloud, thereby improving the accuracy and display effect of the road edge.
此外,本申请实施例还可以将可行驶区域点云对应的三维路面点统一着色成某种颜色(与目标颜色不同)从而生成在三维路面中生成可行驶区域路面,从而可以实现基于可行驶区域路面对其他途径生成的三维地图进行修正等功能。In addition, the embodiment of the present application can also uniformly color the three-dimensional road points corresponding to the drivable area point cloud into a certain color (different from the target color) to generate a drivable area road surface in the three-dimensional road surface, so that it can be realized based on the drivable area. Pavement can correct the three-dimensional map generated by other methods and other functions.
本申请实施例提供的三维路面的着色方法,在将未着色的三维路面还原成第一三维路面点云之后,可以将道路图像附近的第二三维路面点云投影到该道路图像中获得投影点云,并且直接将投影点云中位于目标区域内的目标投影点所对应的第一三维路面点云中的目标三维路面点着色成目标颜色,其中,目标区域包括与道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域,目标三维路面点包括与目标投影点具有直接映射关系的三维路面点或者将这些三维路面点的高程调高后获得的三维路点。由此可知,由于本申请实施例是三维路面中的第二三维路面点云直接向二维的道路图像进行投影,且利用道路图像中感知的道路边缘线及其附近的投影点与三维路面点的映射关系,直接确定道路边缘线的三维路面点,并对其进行着色,所以本申请实施例无需构建平面,不涉及平面与三维路面坡度不一致的问题,从而无需 迭代寻找附近曲面,进而既可以提高道路边缘线的生成效率,又可以提高准确率。The three-dimensional road surface coloring method provided by the embodiment of the present application, after restoring the uncolored three-dimensional road surface to the first three-dimensional road surface point cloud, can project the second three-dimensional road surface point cloud near the road image into the road image to obtain projection points. cloud, and directly color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point located in the target area into the target color, where the target area includes the static road perceived in the road image The area composed of pixels with the same abscissa coordinate of the edge line and the difference between the ordinates within the preset difference range. The target 3D pavement points include 3D pavement points that have a direct mapping relationship with the target projection point or the elevation of these 3D pavement points is adjusted. 3D waypoints obtained after high. It can be seen from this that in the embodiment of the present application, the second three-dimensional road point cloud in the three-dimensional road surface is directly projected onto the two-dimensional road image, and the road edge line perceived in the road image and its nearby projection points and the three-dimensional road point points are used. The mapping relationship directly determines the three-dimensional road points of the road edge line and colors them. Therefore, the embodiment of the present application does not need to construct a plane, and does not involve the problem of inconsistency between the plane and the three-dimensional road slope. Therefore, there is no need to iteratively search for nearby curved surfaces, and thus both Improving the generation efficiency of road edge lines can also improve the accuracy.
在一种实施方式中,为了投影点云的准确性以及提高道路边缘的生成效率,本申请实施例在将第二三维路面点云投影到对应的道路图像,获得道路图像中的投影点云之前,可以先将第二三维路面点云从站心坐标系转换到相机坐标系,再过滤相机坐标系下第二三维路面点云中的无效三维路面点,最后再将相机坐标系下过滤后的第二三维路面点云投影到对应的道路图像,获得道路图像中的投影点云。In one implementation, in order to increase the accuracy of the projected point cloud and improve the efficiency of road edge generation, the embodiment of the present application projects the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image. , you can first convert the second 3D road point cloud from the station center coordinate system to the camera coordinate system, then filter the invalid 3D road points in the second 3D road point cloud in the camera coordinate system, and finally filter the filtered 3D road points in the camera coordinate system. The second three-dimensional road surface point cloud is projected to the corresponding road image to obtain the projected point cloud in the road image.
其中,无效三维路面点包括高程在目标高程范围外的三维路面点、前向坐标小于或者等于0的三维路面点。目标高程范围可以为[0,3m]。Among them, invalid three-dimensional road points include three-dimensional road points whose elevation is outside the target elevation range and three-dimensional road points whose forward coordinates are less than or equal to 0. The target elevation range can be [0,3m].
如图2所示,x轴、y轴和z轴构成了以相机光心为原点的相机坐标系,z轴为前向坐标轴,y轴为用于表示高程的坐标轴,x轴为水平坐标轴。u轴(横轴)和v轴(纵轴)构成了图像坐标系,z轴穿过图像坐标系的中心。As shown in Figure 2, the x-axis, y-axis and z-axis constitute the camera coordinate system with the camera optical center as the origin. The z-axis is the forward coordinate axis, the y-axis is the coordinate axis used to represent elevation, and the x-axis is horizontal. Axis. The u-axis (horizontal axis) and v-axis (vertical axis) constitute the image coordinate system, and the z-axis passes through the center of the image coordinate system.
本申请实施例提供的三维路面的着色方法,通过滤掉高程在目标高程范围外的三维路面点,可以去除桥上桥下或者上下分层的路段,从而使得获得的投影点云更加准确,通过过滤掉前向坐标小于或者等于0的三维路面点,可以过滤掉位于相机拍摄视野以外的三维路面点,从而可以降低相机坐标系向图像坐标系转换的数据量,提高道路边缘的生成效率。The three-dimensional road surface coloring method provided by the embodiment of the present application can remove the road sections above and below the bridge or layered above and below the bridge by filtering out the three-dimensional road points whose elevation is outside the target elevation range, thereby making the obtained projected point cloud more accurate. Filtering out three-dimensional road points with forward coordinates less than or equal to 0 can filter out three-dimensional road points located outside the camera's shooting field of view, thereby reducing the amount of data converted from the camera coordinate system to the image coordinate system and improving the efficiency of road edge generation.
在一种实施方式中,为了提高生成道路边缘的准确性,本申请实施例可以在将目标投影点所对应的第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示三维路面的道路边缘之前,过滤投影点云中的无效投影点,其中,无效投影点包括位于图像坐标系以外的投影点、位于采集车的车盖线下方的投影点、位于静态道路边缘线上方的投影点以及位于动态道路边缘线上方的投影点。如图3所示,阴影部分是有效投影点区域,该区域内部的有效投影点所构成的区域可以称为可行驶区域,非阴影部分是无效投影点区域。有效投影点为投影点云中除了无效投影点以外的其他投影点。In one implementation, in order to improve the accuracy of generating road edges, embodiments of the present application may color the target three-dimensional road points in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the three-dimensional Before the road edge of the road surface, invalid projection points in the projection point cloud are filtered. Invalid projection points include projection points located outside the image coordinate system, projection points located below the cover line of the collection vehicle, and projection points located above the static road edge line. Projection points and projection points above dynamic road edge lines. As shown in Figure 3, the shaded part is the valid projection point area, and the area formed by the valid projection points inside this area can be called the drivable area, and the non-shaded part is the invalid projection point area. Valid projection points are projection points other than invalid projection points in the projection point cloud.
需要补充的是,过滤投影点云中的无效投影点,不仅可以提高生成道路边缘的准确性,还可以提高后续生成彩色路面或语义分割路面的准确性。It should be added that filtering invalid projection points in the projection point cloud can not only improve the accuracy of generating road edges, but also improve the accuracy of subsequent generation of colored pavement or semantic segmentation of pavement.
在一种实施方式中,在过滤相机坐标系下第二三维路面点云中的无效三维路面点之后,本申请实施例还可以根据相机坐标系下过滤后的第二三维路面点云中每个待处理的三维路面点的目标距离,计算待处理的三维路面点对应的权重值,其中,目标距离为待处理的三维路面点的横向坐标与前向坐标之间的目标距离,目标距离与权重值呈负相关关系;在过滤投影点云中的无效投影点之后,在只有一个有效投影点对应第一三维路面点云中的一个三维路面点的情况下,将有效投影点对应的第一三维路面点云中的三维路面点着色成有效投影点的颜色值,其中,有效投影点为过滤后的投影点云中包含的投影 点;在存在多个有效投影点对应第一三维路面点云中的同一个三维路面点的情况下,对多个有效投影点的颜色值和权重值进行加权计算,并将多个有效投影点对应的三维路面点着色成加权后的颜色值,其中,多个有效投影点中每个有效投影点分别位于不同道路图像中。In one implementation, after filtering the invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, the embodiment of the present application can also filter each of the second three-dimensional road point cloud in the camera coordinate system. The target distance of the three-dimensional road point to be processed is calculated, and the weight value corresponding to the three-dimensional road point to be processed is calculated. The target distance is the target distance between the transverse coordinate and the forward coordinate of the three-dimensional road point to be processed. The target distance and the weight are There is a negative correlation between the values; after filtering the invalid projection points in the projection point cloud, when there is only one valid projection point corresponding to a three-dimensional road point in the first three-dimensional road point cloud, the first three-dimensional road point corresponding to the valid projection point will be The three-dimensional pavement points in the pavement point cloud are colored into the color values of the effective projection points, where the effective projection points are the projection points included in the filtered projection point cloud; when there are multiple valid projection points corresponding to the first three-dimensional road point cloud In the case of the same three-dimensional road point, weighted calculations are performed on the color values and weight values of multiple valid projection points, and the three-dimensional road points corresponding to the multiple valid projection points are colored into weighted color values, where multiple Each of the valid projection points is located in a different road image.
当本申请实施例所使用的道路图像是相机采集的原始彩色道路图像时,本申请实施例着色后生成的三维路面为彩色路面;当本申请实施例所使用的道路图像是对原始彩色道路图像语义分割后的图像时,本申请实施例着色后生成的三维路面为语义分割路面。彩色路面是与现实世界路面颜色相同的路面;语义分割路面是语义分割出路面地标部分和非地标部分的三维路面,路面地标是指路面上用线条、箭头、文字等向交通参与者传递引导、限制、警告等交通信息的标识。When the road image used in the embodiment of the present application is an original color road image collected by a camera, the three-dimensional road surface generated after coloring in the embodiment of the present application is a colored road surface; when the road image used in the embodiment of the present application is an original color road image When the image is a semantically segmented image, the three-dimensional road surface generated after coloring in this embodiment of the present application is a semantically segmented road surface. Colored pavement is a pavement that has the same color as the road surface in the real world; semantic segmentation pavement is a three-dimensional pavement that semantically separates the landmark part and non-landmark part of the road. Pavement landmarks refer to the use of lines, arrows, text, etc. on the road surface to convey guidance to traffic participants. Signs showing restrictions, warnings and other traffic information.
此外,本申请实施例还可以将三维路面中未被着色的三维路面点统一着色成某种颜色(如灰色),以突出显示出路面颜色。In addition, the embodiment of the present application can also uniformly color the uncolored three-dimensional road points in the three-dimensional road surface into a certain color (such as gray) to highlight the color of the road surface.
本申请实施例提供的三维路面的着色方法,可以通过对有效投影点对应的第一三维路面点云中的三维路面点进行着色,可以实现对三维路面的着色,如当道路图像是彩色图像时,可以得到彩色路面,当道路图像是语义分割图像时,可以得到语义分割路面。并且在对三维路面进行着色时,还可以根据距离信息确定的权重值进行加权计算,从而提高了对三维路面着色的准确性。The three-dimensional road surface coloring method provided by the embodiment of the present application can realize the coloring of the three-dimensional road surface by coloring the three-dimensional road surface points in the first three-dimensional road surface point cloud corresponding to the effective projection point. For example, when the road image is a color image , the colored road surface can be obtained, and when the road image is a semantic segmentation image, the semantic segmentation road surface can be obtained. And when coloring the three-dimensional road surface, weighted calculations can also be performed based on the weight value determined by the distance information, thereby improving the accuracy of the three-dimensional road surface coloring.
相应于上述方法实施例,本申请的另一个实施例提供了一种三维路面的着色装置,如图4所示,该装置包括:Corresponding to the above method embodiment, another embodiment of the present application provides a three-dimensional road surface coloring device. As shown in Figure 4, the device includes:
还原单元21,用于根据预设间距和三维路面的曲面参数,对三维路面进行还原操作,生成第一三维路面点云,其中,三维路面为基于原始雷达点云拟合而成的未着色的三维路面;The restoration unit 21 is used to restore the three-dimensional road surface according to the preset spacing and the surface parameters of the three-dimensional road surface, and generate a first three-dimensional road surface point cloud, where the three-dimensional road surface is an uncolored image fitted based on the original radar point cloud. three-dimensional road surface;
确定单元22,用于根据每帧道路图像在第一三维路面点云中的位姿,确定道路图像对应的第二三维路面点云,其中,道路图像为采集车的激光雷达采集原始雷达点云时,采集车的相机采集的道路图像,第二三维路面点云包括在第一三维路面点云中,与道路图像的位姿相距小于或者等于预设距离的三维路面点;The determination unit 22 is used to determine the second three-dimensional road point cloud corresponding to the road image according to the position and orientation of each frame of the road image in the first three-dimensional road point cloud, where the road image is the original radar point cloud collected by the lidar of the collection vehicle. When collecting the road image collected by the camera of the vehicle, the second three-dimensional road point cloud includes three-dimensional road points in the first three-dimensional road point cloud that are less than or equal to the preset distance from the position of the road image;
投影单元23,用于将第二三维路面点云投影到对应的道路图像,获得道路图像中的投影点云;The projection unit 23 is used to project the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image;
着色单元24,用于将目标投影点所对应的第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示三维路面的道路边缘,其中,目标投影点包括每帧道路图像的投影点云中位于目标区域内的投影点,目标区域包括与道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域,目标三维路面 点包括与目标投影点具有直接映射关系的三维路面点,或者在将与目标投影点具有直接映射关系的三维路面点的高程调高预设高度后获得的三维路面点。The coloring unit 24 is used to color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface, wherein the target projection point includes each frame of the road image. The projection point in the projection point cloud is located in the target area. The target area includes the area composed of pixels with the same abscissa as the static road edge line perceived in the road image and the difference between the ordinates is within the preset difference range. The target three-dimensional road surface The points include three-dimensional pavement points that have a direct mapping relationship with the target projection point, or three-dimensional pavement points that are obtained by raising the elevation of the three-dimensional pavement point that has a direct mapping relationship with the target projection point by a preset height.
在一种可能的实现方式中,该装置还包括:In a possible implementation, the device further includes:
坐标系转换单元,用于在将第二三维路面点云投影到对应的道路图像,获得道路图像中的投影点云之前,将第二三维路面点云从站心坐标系转换到相机坐标系;A coordinate system conversion unit, used to convert the second three-dimensional road point cloud from the station center coordinate system to the camera coordinate system before projecting the second three-dimensional road point cloud to the corresponding road image and obtaining the projected point cloud in the road image;
第一过滤单元,用于过滤相机坐标系下第二三维路面点云中的无效三维路面点,其中,无效三维路面点包括高程在目标高程范围外的三维路面点、前向坐标小于或者等于0的三维路面点;The first filtering unit is used to filter invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, where the invalid three-dimensional road points include three-dimensional road points whose elevation is outside the target elevation range and whose forward coordinate is less than or equal to 0. three-dimensional road points;
投影单元23,用于将相机坐标系下过滤后的第二三维路面点云投影到对应的道路图像,获得道路图像中的投影点云。The projection unit 23 is used to project the filtered second three-dimensional road point cloud in the camera coordinate system to the corresponding road image to obtain the projected point cloud in the road image.
在一种可能的实现方式中,该装置还包括:In a possible implementation, the device further includes:
第二过滤单元,用于在将目标投影点所对应的第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示三维路面的道路边缘之前,过滤投影点云中的无效投影点,其中,无效投影点包括位于图像坐标系以外的投影点、位于采集车的车盖线下方的投影点、位于静态道路边缘线上方的投影点以及位于动态道路边缘线上方的投影点。The second filtering unit is used to filter invalid projections in the projection point cloud before coloring the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into the target color to highlight the road edge of the three-dimensional road surface. Points, where invalid projection points include projection points located outside the image coordinate system, projection points located below the hood line of the collection vehicle, projection points located above the static road edge line, and projection points located above the dynamic road edge line.
在一种可能的实现方式中,着色单元24,用于将第一三维路面点云中满足预设条件的三维路面点确定为目标三维路面点,并将目标三维路面点着色成目标颜色;In a possible implementation, the coloring unit 24 is used to determine the three-dimensional road points that meet the preset conditions in the first three-dimensional road point cloud as the target three-dimensional road points, and color the target three-dimensional road points into the target color;
其中,预设条件包括如下任意一项:Among them, the preset conditions include any of the following:
第一三维路面点云中与目标投影点具有直接映射关系的三维路面点;Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
在将具有直接映射关系的三维路面点的高程调高预设高度后,获得的三维路面点;The three-dimensional pavement point obtained after raising the elevation of the three-dimensional pavement point with a direct mapping relationship by a preset height;
在基于可行驶区域点云对具有直接映射关系的三维路面点进行过滤后的三维路面点,可行驶区域点云包括过滤后的投影点云中,位于由采集车车盖线、静态道路边缘线和动态道路边缘线所围成的区域内的投影点对应的第一三维路面点云中的三维路面点;The three-dimensional road points with direct mapping relationships are filtered based on the drivable area point cloud. The drivable area point cloud includes the filtered projection point cloud, which is located between the collected vehicle cover line and the static road edge line. Three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the dynamic road edge lines;
在基于可行驶区域点云对具有直接映射关系的三维路面点进行过滤后,对剩余的三维路面点的高程调高预设高度后获得的三维路面点。After filtering the three-dimensional road points with direct mapping relationships based on the drivable area point cloud, the three-dimensional road points obtained by raising the elevation of the remaining three-dimensional road points by a preset height.
在一种可能的实现方式中,该装置还包括:In a possible implementation, the device further includes:
计算单元,用于在过滤相机坐标系下第二三维路面点云中的无效三维路面点之后,根据相机坐标系下过滤后的第二三维路面点云中每个待处理的三维路面点的目标距离,计算待处理的三维路面点对应的权重值,其中,目标距离为待处理的三维路面点的横向坐标与前向坐标之间的目标距离,目标距离与权重值呈负相关关系;A computing unit configured to, after filtering invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, target each to-be-processed three-dimensional road point in the filtered second three-dimensional road point cloud in the camera coordinate system. Distance, calculate the weight value corresponding to the three-dimensional road point to be processed, where the target distance is the target distance between the lateral coordinates and the forward coordinate of the three-dimensional road point to be processed, and the target distance has a negative correlation with the weight value;
着色单元24,还用于在过滤投影点云中的无效投影点之后,在只有一个有效投影点对应第一三维路面点云中的一个三维路面点的情况下,将有效投影点对应的第一三维路 面点云中的三维路面点着色成有效投影点的颜色值,其中,有效投影点为过滤后的投影点云中包含的投影点;在存在多个有效投影点对应第一三维路面点云中的同一个三维路面点的情况下,对多个有效投影点的颜色值和权重值进行加权计算,并将多个有效投影点对应的三维路面点着色成加权后的颜色值,其中,多个有效投影点中每个有效投影点分别位于不同道路图像中。The coloring unit 24 is also used to, after filtering the invalid projection points in the projection point cloud, when there is only one valid projection point corresponding to one three-dimensional road point in the first three-dimensional road point cloud, convert the valid projection point corresponding to the first The three-dimensional road points in the three-dimensional road point cloud are colored into the color values of the effective projection points, where the effective projection points are the projection points included in the filtered projection point cloud; when there are multiple effective projection points corresponding to the first three-dimensional road point cloud In the case of the same three-dimensional road point in , perform weighted calculations on the color values and weight values of multiple valid projection points, and color the three-dimensional road points corresponding to the multiple valid projection points into weighted color values, where Each of the valid projection points is located in a different road image.
本申请实施例提供的三维路面的着色装置,在将未着色的三维路面还原成第一三维路面点云之后,可以将道路图像附近的第二三维路面点云投影到该道路图像中获得投影点云,并且直接将投影点云中位于目标区域内的目标投影点所对应的第一三维路面点云中的目标三维路面点着色成目标颜色,其中,目标区域包括与道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域,目标三维路面点包括与目标投影点具有直接映射关系的三维路面点或者将这些三维路面点的高程调高后获得的三维路点。由此可知,由于本申请实施例是三维路面中的第二三维路面点云直接向二维的道路图像进行投影,且利用道路图像中感知的道路边缘线及其附近的投影点与三维路面点的映射关系,直接确定道路边缘线的三维路面点,并对其进行着色,所以本申请实施例无需构建平面,不涉及平面与三维路面坡度不一致的问题,从而无需迭代寻找附近曲面,进而既可以提高道路边缘线的生成效率,又可以提高准确率。The three-dimensional road surface coloring device provided by the embodiment of the present application, after restoring the uncolored three-dimensional road surface to the first three-dimensional road surface point cloud, can project the second three-dimensional road surface point cloud near the road image into the road image to obtain projection points. cloud, and directly color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point located in the target area into the target color, where the target area includes the static road perceived in the road image The area composed of pixels with the same abscissa coordinate of the edge line and the difference between the ordinates within the preset difference range. The target 3D pavement points include 3D pavement points that have a direct mapping relationship with the target projection point or the elevation of these 3D pavement points is adjusted. 3D waypoints obtained after high. It can be seen from this that in the embodiment of the present application, the second three-dimensional road point cloud in the three-dimensional road surface is directly projected onto the two-dimensional road image, and the road edge line perceived in the road image and its nearby projection points and the three-dimensional road point points are used. The mapping relationship directly determines the three-dimensional road points of the road edge line and colors them. Therefore, the embodiment of the present application does not need to construct a plane, and does not involve the problem of inconsistency between the plane and the three-dimensional road slope. Therefore, there is no need to iteratively search for nearby curved surfaces, and thus both Improving the generation efficiency of road edge lines can also improve the accuracy.
基于上述方法实施例,本申请的另一实施例提供了一种存储介质,其上存储有可执行指令,该指令被处理器执行时使处理器实现如上任一实施方式所述的方法。Based on the above method embodiments, another embodiment of the present application provides a storage medium on which executable instructions are stored. When executed by a processor, the instructions cause the processor to implement the method described in any of the above embodiments.
基于上述方法实施例,本申请的另一实施例提供了一种电子设备或计算机设备,包括:Based on the above method embodiment, another embodiment of the present application provides an electronic device or computer device, including:
一个或多个处理器;one or more processors;
存储装置,用于存储一个或多个程序,a storage device for storing one or more programs,
其中,当所述一个或多个程序被所述一个或多个处理器执行时,使得电子设备或计算机设备实现如上任一实施方式所述的方法。Wherein, when the one or more programs are executed by the one or more processors, the electronic device or computer device is caused to implement the method described in any of the above embodiments.
基于上述方法实施例,本申请的另一实施例提供了车辆,该车辆包含如上任一实施方式所述的装置,或者包含如上所述的电子设备。Based on the above method embodiments, another embodiment of the present application provides a vehicle, which includes the device as described in any of the above embodiments, or includes the electronic device as described above.
如图5所示,车辆包括CPU(Central Processing Unit,中央处理器)31、GPS(Global Positioning System,全球定位系统)定位设备32、T-Box(Telematics Box,远程信息处理器)33,V2X(Vehicle-to-Everything,车联网)模块34、激光雷达35和相机36。其中,GPS定位设备32用于获取车辆的当前地理位置;T-Box33可以作为网关与服务器进行通信;CPU31可以执行上述实施例提及的三维路面的着色方法;激光雷达35用于采集车辆前方的雷达点云;相机36用于采集车辆前方的道路图像。As shown in Figure 5, the vehicle includes a CPU (Central Processing Unit, central processing unit) 31, a GPS (Global Positioning System, global positioning system) positioning device 32, a T-Box (Telematics Box, a remote information processor) 33, a V2X ( Vehicle-to-Everything (Internet of Vehicles) module 34, lidar 35 and camera 36. Among them, the GPS positioning device 32 is used to obtain the current geographical location of the vehicle; the T-Box 33 can be used as a gateway to communicate with the server; the CPU 31 can execute the three-dimensional road surface coloring method mentioned in the above embodiment; the laser radar 35 is used to collect the information in front of the vehicle. Radar point cloud; camera 36 is used to collect images of the road in front of the vehicle.
上述装置实施例与方法实施例相对应,与该方法实施例具有同样的技术效果,具体说 明参见方法实施例。装置实施例是基于方法实施例得到的,具体的说明可以参见方法实施例部分,此处不再赘述。本领域普通技术人员可以理解:附图只是一个实施例的示意图,附图中的模块或流程并不一定是实施本申请所必须的。The above device embodiments correspond to the method embodiments and have the same technical effects as the method embodiments. For detailed description, please refer to the method embodiments. The device embodiment is obtained based on the method embodiment. For specific description, please refer to the method embodiment section and will not be described again here. Those of ordinary skill in the art can understand that the accompanying drawing is only a schematic diagram of an embodiment, and the modules or processes in the accompanying drawing are not necessarily necessary for implementing the present application.
本领域普通技术人员可以理解:实施例中的装置中的模块可以按照实施例描述分布于实施例的装置中,也可以进行相应变化位于不同于本实施例的一个或多个装置中。上述实施例的模块可以合并为一个模块,也可以进一步拆分成多个子模块。Those of ordinary skill in the art can understand that the modules in the device in the embodiment may be distributed in the device in the embodiment according to the description of the embodiment, or may be correspondingly changed and located in one or more devices different from this embodiment. The modules of the above embodiments can be combined into one module, or further divided into multiple sub-modules.
最后应说明的是:以上实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请实施例技术方案的精神和范围。Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present application, but not to limit it; although the present application has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that it can still be Modifications are made to the technical solutions described in the foregoing embodiments, or equivalent substitutions are made to some of the technical features; however, these modifications or substitutions do not cause the essence of the corresponding technical solutions to deviate from the spirit and scope of the technical solutions in the embodiments of the present application.

Claims (13)

  1. 一种三维路面的着色方法,其特征在于,所述方法包括:A three-dimensional road surface coloring method, characterized in that the method includes:
    根据预设间距和三维路面的曲面参数,对所述三维路面进行还原操作,生成第一三维路面点云,其中,所述三维路面为基于原始雷达点云拟合而成的未着色的三维路面;According to the preset spacing and the surface parameters of the three-dimensional road surface, a restoration operation is performed on the three-dimensional road surface to generate a first three-dimensional road point cloud, wherein the three-dimensional road surface is an uncolored three-dimensional road surface fitted based on the original radar point cloud. ;
    根据每帧道路图像在所述第一三维路面点云中的位姿,确定所述道路图像对应的第二三维路面点云,其中,所述道路图像为采集车的激光雷达采集所述原始雷达点云时,所述采集车的相机采集的道路图像,所述第二三维路面点云包括在所述第一三维路面点云中,与所述道路图像的所述位姿相距小于或者等于预设距离的三维路面点;According to the position and orientation of each frame of road image in the first three-dimensional road point cloud, the second three-dimensional road point cloud corresponding to the road image is determined, wherein the road image is the original radar collected by the laser radar of the collection vehicle. When the point cloud is generated, in the road image collected by the camera of the collecting vehicle, the second three-dimensional road point cloud is included in the first three-dimensional road point cloud, and the distance from the pose of the road image is less than or equal to a predetermined distance. Set the distance between the three-dimensional road points;
    将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云;Project the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image;
    将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示所述三维路面的道路边缘,其中,所述目标投影点包括每帧所述道路图像的所述投影点云中位于目标区域内的投影点,所述目标区域包括与所述道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域,所述目标三维路面点包括与所述目标投影点具有直接映射关系的三维路面点,或者在将与所述目标投影点具有直接映射关系的三维路面点的高程调高预设高度后获得的三维路面点。Coloring the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface, wherein the target projection point includes the road in each frame Projection points located within a target area in the projection point cloud of the image, the target area including pixels having the same abscissa as the static road edge line perceived in the road image and a difference in ordinates within a preset difference range In the constituted area, the target three-dimensional road point includes a three-dimensional road point that has a direct mapping relationship with the target projection point, or the elevation of the three-dimensional road point that has a direct mapping relationship with the target projection point is preset. 3D pavement points obtained after height.
  2. 根据权利要求1所述的方法,其特征在于,在所述将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云之前,所述方法还包括:The method according to claim 1, characterized in that, before projecting the second three-dimensional road point cloud to the corresponding road image and obtaining the projected point cloud in the road image, the method further include:
    将所述第二三维路面点云从站心坐标系转换到相机坐标系;Convert the second three-dimensional road point cloud from the station center coordinate system to the camera coordinate system;
    过滤所述相机坐标系下所述第二三维路面点云中的无效三维路面点,其中,所述无效三维路面点包括高程在目标高程范围外的三维路面点、前向坐标小于或者等于0的三维路面点;Filter invalid three-dimensional road points in the second three-dimensional road point cloud under the camera coordinate system, wherein the invalid three-dimensional road points include three-dimensional road points with elevations outside the target elevation range, and forward coordinates less than or equal to 0. 3D pavement points;
    所述将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云,包括:Projecting the second three-dimensional road point cloud to the corresponding road image and obtaining the projected point cloud in the road image includes:
    将所述相机坐标系下过滤后的所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的所述投影点云。Project the filtered second three-dimensional road point cloud in the camera coordinate system to the corresponding road image to obtain the projected point cloud in the road image.
  3. 根据权利要求2所述的方法,其特征在于,在所述将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示所述三维路面的道路边缘之前,所述方法还包括:The method of claim 2, wherein the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point is colored into a target color to highlight the three-dimensional road surface. Before road edge, the method also includes:
    过滤所述投影点云中的无效投影点,其中,所述无效投影点包括位于图像坐标系以外的投影点、位于所述采集车的车盖线下方的投影点、位于所述静态道路边缘线上方的投影点以及位于动态道路边缘线上方的投影点。Filter invalid projection points in the projection point cloud, where the invalid projection points include projection points located outside the image coordinate system, projection points located below the hood line of the collection vehicle, and projection points located on the static road edge line Projection points above and above the dynamic road edge lines.
  4. 根据权利要求3所述的方法,其特征在于,所述将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,包括:The method of claim 3, wherein coloring the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color includes:
    将所述第一三维路面点云中满足预设条件的三维路面点确定为所述目标三维路面点,并将所述目标三维路面点着色成所述目标颜色;Determine three-dimensional road points in the first three-dimensional road point cloud that meet preset conditions as the target three-dimensional road points, and color the target three-dimensional road points into the target color;
    其中,所述预设条件包括如下任意一项:Wherein, the preset conditions include any one of the following:
    所述第一三维路面点云中与所述目标投影点具有直接映射关系的三维路面点;Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
    在将所述具有直接映射关系的三维路面点的高程调高所述预设高度后,获得的三维路面点;The three-dimensional road point obtained after raising the elevation of the three-dimensional road point with a direct mapping relationship by the preset height;
    在基于可行驶区域点云对所述具有直接映射关系的三维路面点进行过滤后的三维路面点,所述可行驶区域点云包括过滤后的所述投影点云中,位于由所述车盖线、所述静态道路边缘线和动态道路边缘线所围成的区域内的投影点对应的第一三维路面点云中的三维路面点;The three-dimensional road points with a direct mapping relationship are filtered based on the drivable area point cloud. The drivable area point cloud includes the filtered projection point cloud, which is located by the vehicle cover. Lines, three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the static road edge line and the dynamic road edge line;
    在基于所述可行驶区域点云对所述具有直接映射关系的三维路面点进行过滤后,对剩余的三维路面点的高程调高所述预设高度后获得的三维路面点。After filtering the three-dimensional road points with a direct mapping relationship based on the drivable area point cloud, the remaining three-dimensional road points are obtained by raising the elevation of the preset height.
  5. 根据权利要求3或4所述的方法,其特征在于,在所述过滤所述相机坐标系下所述第二三维路面点云中的无效三维路面点之后,所述方法还包括:The method according to claim 3 or 4, characterized in that, after filtering the invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, the method further includes:
    根据所述相机坐标系下过滤后的所述第二三维路面点云中每个待处理的三维路面点的目标距离,计算所述待处理的三维路面点对应的权重值,其中,所述目标距离为所述待处理的三维路面点的横向坐标与前向坐标之间的目标距离,所述目标距离与所述权重值呈负相关关系;According to the target distance of each three-dimensional road point to be processed in the filtered second three-dimensional road point cloud in the camera coordinate system, the weight value corresponding to the three-dimensional road point to be processed is calculated, where the target The distance is the target distance between the transverse coordinate and the forward coordinate of the three-dimensional road point to be processed, and the target distance has a negative correlation with the weight value;
    在所述过滤所述投影点云中的无效投影点之后,所述方法还包括:After filtering invalid projection points in the projection point cloud, the method further includes:
    在只有一个有效投影点对应所述第一三维路面点云中的一个三维路面点的情况下,将所述有效投影点对应的所述第一三维路面点云中的三维路面点着色成所述有效投影点的颜色值,其中,所述有效投影点为过滤后的所述投影点云中包含的投影点;In the case where there is only one valid projection point corresponding to one three-dimensional road point in the first three-dimensional road point cloud, the three-dimensional road point in the first three-dimensional road point cloud corresponding to the valid projection point is colored into the above-mentioned The color value of a valid projection point, wherein the valid projection point is a projection point included in the filtered projection point cloud;
    在存在多个有效投影点对应所述第一三维路面点云中的同一个三维路面点的情况下,对所述多个有效投影点的所述颜色值和所述权重值进行加权计算,并将所述多个有效投影点对应的三维路面点着色成加权后的颜色值,其中,所述多个有效投影点中每个所述有效投影点分别位于不同所述道路图像中。When there are multiple valid projection points corresponding to the same three-dimensional road point in the first three-dimensional road point cloud, perform a weighted calculation on the color values and the weight values of the multiple valid projection points, and The three-dimensional road points corresponding to the plurality of valid projection points are colored into weighted color values, wherein each of the plurality of valid projection points is located in a different road image.
  6. 一种三维路面的着色装置,其特征在于,所述装置包括:A three-dimensional road surface coloring device, characterized in that the device includes:
    还原单元,用于根据预设间距和三维路面的曲面参数,对所述三维路面进行还原操作,生成第一三维路面点云,其中,所述三维路面为基于原始雷达点云拟合而成的未着色的三维路面;A restoration unit, configured to restore the three-dimensional road surface according to the preset spacing and the surface parameters of the three-dimensional road surface, and generate a first three-dimensional road surface point cloud, wherein the three-dimensional road surface is fitted based on the original radar point cloud. Uncolored three-dimensional pavement;
    确定单元,用于根据每帧道路图像在所述第一三维路面点云中的位姿,确定所述道路图像对应的第二三维路面点云,其中,所述道路图像为采集车的激光雷达采集所述原始雷达点云时,所述采集车的相机采集的道路图像,所述第二三维路面点云包括在所述第一三维路面点云中,与所述道路图像的所述位姿相距小于或者等于预设距离的三维路面点;Determining unit, configured to determine the second three-dimensional road point cloud corresponding to the road image according to the position and orientation of each frame of the road image in the first three-dimensional road point cloud, wherein the road image is the lidar of the collection vehicle When collecting the original radar point cloud, the road image collected by the camera of the collecting vehicle, the second three-dimensional road point cloud is included in the first three-dimensional road point cloud, and the pose of the road image Three-dimensional road points whose distance is less than or equal to the preset distance;
    投影单元,用于将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云;A projection unit configured to project the second three-dimensional road point cloud to the corresponding road image to obtain the projected point cloud in the road image;
    着色单元,用于将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示所述三维路面的道路边缘,其中,所述目标投影点包括每帧所述道路图像的所述投影点云中位于目标区域内的投影点,所述目标区域包括与所述道路图像中感知的静态道路边缘线横坐标相同且纵坐标之差在预设差异范围内的像素点所构成的区域,所述目标三维路面点包括与所述目标投影点具有直接映射关系的三维路面点,或者在将与所述目标投影点具有直接映射关系的三维路面点的高程调高预设高度后获得的三维路面点。A coloring unit configured to color the target three-dimensional road point in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface, wherein the target projection point includes The projected point in the projected point cloud of each frame of the road image is located in a target area. The target area includes the same abscissa as the static road edge line perceived in the road image and the difference between the ordinates is within a preset difference. The area composed of pixel points within the range, the target three-dimensional road point includes a three-dimensional road point that has a direct mapping relationship with the target projection point, or is located between the three-dimensional road point that will have a direct mapping relationship with the target projection point. The three-dimensional road points obtained by raising the elevation to a preset height.
  7. 根据权利要求6所述的装置,其特征在于,所述装置还包括:The device according to claim 6, characterized in that the device further includes:
    坐标系转换单元,用于在所述将所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的投影点云之前,将所述第二三维路面点云从站心坐标系转换到相机坐标系;A coordinate system conversion unit configured to project the second three-dimensional road point cloud to the corresponding road image and obtain the projected point cloud in the road image, converting the second three-dimensional road point cloud from Convert the station center coordinate system to the camera coordinate system;
    第一过滤单元,用于过滤所述相机坐标系下所述第二三维路面点云中的无效三维路面点,其中,所述无效三维路面点包括高程在目标高程范围外的三维路面点、前向坐标小于或者等于0的三维路面点;The first filtering unit is used to filter invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, where the invalid three-dimensional road points include three-dimensional road points with elevations outside the target elevation range, previous Three-dimensional road points with coordinates less than or equal to 0;
    所述投影单元,用于将所述相机坐标系下过滤后的所述第二三维路面点云投影到对应的所述道路图像,获得所述道路图像中的所述投影点云。The projection unit is configured to project the filtered second three-dimensional road point cloud in the camera coordinate system to the corresponding road image to obtain the projected point cloud in the road image.
  8. 根据权利要求7所述的装置,其特征在于,所述装置还包括:The device of claim 7, further comprising:
    第二过滤单元,用于在所述将目标投影点所对应的所述第一三维路面点云中的目标三维路面点着色成目标颜色,以突出显示所述三维路面的道路边缘之前,过滤所述投影点云中的无效投影点,其中,所述无效投影点包括位于图像坐标系以外的投影点、位于 所述采集车的车盖线下方的投影点、位于所述静态道路边缘线上方的投影点以及位于动态道路边缘线上方的投影点。A second filtering unit configured to filter all target three-dimensional road points in the first three-dimensional road point cloud corresponding to the target projection point into a target color to highlight the road edge of the three-dimensional road surface. Invalid projection points in the projection point cloud, wherein the invalid projection points include projection points located outside the image coordinate system, projection points located below the hood line of the collection vehicle, and projection points located above the static road edge line Projection points and projection points above dynamic road edge lines.
  9. 根据权利要求8所述的装置,其特征在于,所述着色单元,用于将所述第一三维路面点云中满足预设条件的三维路面点确定为所述目标三维路面点,并将所述目标三维路面点着色成所述目标颜色;The device according to claim 8, characterized in that the coloring unit is used to determine the three-dimensional road points that meet preset conditions in the first three-dimensional road point cloud as the target three-dimensional road points, and The target three-dimensional road surface points are colored into the target color;
    其中,所述预设条件包括如下任意一项:Wherein, the preset conditions include any one of the following:
    所述第一三维路面点云中与所述目标投影点具有直接映射关系的三维路面点;Three-dimensional road points in the first three-dimensional road point cloud that have a direct mapping relationship with the target projection point;
    在将所述具有直接映射关系的三维路面点的高程调高所述预设高度后,获得的三维路面点;The three-dimensional road point obtained after raising the elevation of the three-dimensional road point with a direct mapping relationship by the preset height;
    在基于可行驶区域点云对所述具有直接映射关系的三维路面点进行过滤后的三维路面点,所述可行驶区域点云包括过滤后的所述投影点云中,位于由所述车盖线、所述静态道路边缘线和动态道路边缘线所围成的区域内的投影点对应的第一三维路面点云中的三维路面点;The three-dimensional road points with a direct mapping relationship are filtered based on the drivable area point cloud. The drivable area point cloud includes the filtered projection point cloud, which is located by the vehicle cover. Lines, three-dimensional road points in the first three-dimensional road point cloud corresponding to projection points in the area enclosed by the static road edge line and the dynamic road edge line;
    在基于所述可行驶区域点云对所述具有直接映射关系的三维路面点进行过滤后,对剩余的三维路面点的高程调高所述预设高度后获得的三维路面点。After filtering the three-dimensional road points with a direct mapping relationship based on the drivable area point cloud, the remaining three-dimensional road points are obtained by raising the elevation of the preset height.
  10. 根据权利要求8或9所述的装置,其特征在于,所述装置还包括:The device according to claim 8 or 9, characterized in that the device further includes:
    计算单元,用于在所述过滤所述相机坐标系下所述第二三维路面点云中的无效三维路面点之后,根据所述相机坐标系下过滤后的所述第二三维路面点云中每个待处理的三维路面点的目标距离,计算所述待处理的三维路面点对应的权重值,其中,所述目标距离为所述待处理的三维路面点的横向坐标与前向坐标之间的目标距离,所述目标距离与所述权重值呈负相关关系;A computing unit configured to, after filtering the invalid three-dimensional road points in the second three-dimensional road point cloud in the camera coordinate system, calculate the filtered second three-dimensional road point cloud in the camera coordinate system. The target distance of each three-dimensional road point to be processed is calculated, and the weight value corresponding to the three-dimensional road point to be processed is calculated, where the target distance is between the lateral coordinate and the forward coordinate of the three-dimensional road point to be processed. The target distance has a negative correlation with the weight value;
    所述着色单元,还用于在所述过滤所述投影点云中的无效投影点之后,在只有一个有效投影点对应所述第一三维路面点云中的一个三维路面点的情况下,将所述有效投影点对应的所述第一三维路面点云中的三维路面点着色成所述有效投影点的颜色值,其中,所述有效投影点为过滤后的所述投影点云中包含的投影点;在存在多个有效投影点对应所述第一三维路面点云中的同一个三维路面点的情况下,对所述多个有效投影点的所述颜色值和所述权重值进行加权计算,并将所述多个有效投影点对应的三维路面点着色成加权后的颜色值,其中,所述多个有效投影点中每个所述有效投影点分别位于不同所述道路图像中。The coloring unit is also configured to, after filtering the invalid projection points in the projection point cloud, when there is only one valid projection point corresponding to a three-dimensional road point in the first three-dimensional road point cloud, The three-dimensional road points in the first three-dimensional road point cloud corresponding to the effective projection points are colored into the color values of the effective projection points, wherein the effective projection points are included in the filtered projection point cloud. Projection points; when there are multiple valid projection points corresponding to the same three-dimensional road point in the first three-dimensional road point cloud, weight the color values and the weight values of the multiple valid projection points. Calculate and color the three-dimensional road points corresponding to the plurality of valid projection points into weighted color values, wherein each of the plurality of valid projection points is located in a different road image.
  11. 一种存储介质,其上存储有计算机程序,其特征在于,所述程序被处理器执行时实现如权利要求1-5中任一项所述的方法。A storage medium with a computer program stored thereon, characterized in that when the program is executed by a processor, the method according to any one of claims 1-5 is implemented.
  12. 一种电子设备,其特征在于,所述电子设备包括:An electronic device, characterized in that the electronic device includes:
    一个或多个处理器;one or more processors;
    存储装置,用于存储一个或多个程序,a storage device for storing one or more programs,
    当所述一个或多个程序被所述一个或多个处理器执行,使得所述电子设备实现如权利要求1-5中任一项所述的方法。When the one or more programs are executed by the one or more processors, the electronic device is caused to implement the method according to any one of claims 1-5.
  13. 一种车辆,其特征在于,所述车辆包括权利要求6-10中任一项所述的装置,或者包括权利要求12所述的电子设备。A vehicle, characterized in that the vehicle includes the device according to any one of claims 6-10, or the electronic device according to claim 12.
PCT/CN2022/114717 2022-08-23 2022-08-25 Coloring method and apparatus for three-dimensional road surface, and storage medium, electronic device and vehicle WO2024040500A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202211013063.1A CN117689784A (en) 2022-08-23 2022-08-23 Method and device for coloring three-dimensional pavement, storage medium, electronic equipment and vehicle
CN202211013063.1 2022-08-23

Publications (1)

Publication Number Publication Date
WO2024040500A1 true WO2024040500A1 (en) 2024-02-29

Family

ID=90011969

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/114717 WO2024040500A1 (en) 2022-08-23 2022-08-25 Coloring method and apparatus for three-dimensional road surface, and storage medium, electronic device and vehicle

Country Status (2)

Country Link
CN (1) CN117689784A (en)
WO (1) WO2024040500A1 (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105701449A (en) * 2015-12-31 2016-06-22 百度在线网络技术(北京)有限公司 Method and device for detecting lane lines on road surface
CN108319920A (en) * 2018-02-05 2018-07-24 武汉武大卓越科技有限责任公司 A kind of pavement strip detection and calculation method of parameters scanning three-dimensional point cloud based on line
CN111882612A (en) * 2020-07-21 2020-11-03 武汉理工大学 Vehicle multi-scale positioning method based on three-dimensional laser detection lane line
CN112258519A (en) * 2020-10-12 2021-01-22 武汉中海庭数据技术有限公司 Automatic extraction method and device for way-giving line of road in high-precision map making
US11099275B1 (en) * 2020-04-29 2021-08-24 Tsinghua University LiDAR point cloud reflection intensity complementation method and system
CN113963061A (en) * 2021-10-29 2022-01-21 广州文远知行科技有限公司 Road edge distribution information acquisition method and device, electronic equipment and storage medium
CN114076956A (en) * 2021-11-12 2022-02-22 北京斯年智驾科技有限公司 Lane line calibration method based on laser radar point cloud assistance

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105701449A (en) * 2015-12-31 2016-06-22 百度在线网络技术(北京)有限公司 Method and device for detecting lane lines on road surface
CN108319920A (en) * 2018-02-05 2018-07-24 武汉武大卓越科技有限责任公司 A kind of pavement strip detection and calculation method of parameters scanning three-dimensional point cloud based on line
US11099275B1 (en) * 2020-04-29 2021-08-24 Tsinghua University LiDAR point cloud reflection intensity complementation method and system
CN111882612A (en) * 2020-07-21 2020-11-03 武汉理工大学 Vehicle multi-scale positioning method based on three-dimensional laser detection lane line
CN112258519A (en) * 2020-10-12 2021-01-22 武汉中海庭数据技术有限公司 Automatic extraction method and device for way-giving line of road in high-precision map making
CN113963061A (en) * 2021-10-29 2022-01-21 广州文远知行科技有限公司 Road edge distribution information acquisition method and device, electronic equipment and storage medium
CN114076956A (en) * 2021-11-12 2022-02-22 北京斯年智驾科技有限公司 Lane line calibration method based on laser radar point cloud assistance

Also Published As

Publication number Publication date
CN117689784A (en) 2024-03-12

Similar Documents

Publication Publication Date Title
CN108802785B (en) Vehicle self-positioning method based on high-precision vector map and monocular vision sensor
CN111551958B (en) Mining area unmanned high-precision map manufacturing method
EP3759562B1 (en) Camera based localization for autonomous vehicles
US20210172756A1 (en) Lane line creation for high definition maps for autonomous vehicles
US20200393265A1 (en) Lane line determination for high definition maps
WO2021003452A1 (en) Determination of lane connectivity at traffic intersections for high definition maps
US11232582B2 (en) Visual localization using a three-dimensional model and image segmentation
US20200401817A1 (en) Determining weights of points of a point cloud based on geometric features
WO2021051344A1 (en) Method and apparatus for determining lane lines in high-precision map
Marinelli et al. Mobile mapping systems and spatial data collection strategies assessment in the identification of horizontal alignment of highways
WO2021017211A1 (en) Vehicle positioning method and device employing visual sensing, and vehicle-mounted terminal
WO2023065342A1 (en) Vehicle, vehicle positioning method and apparatus, device, and computer-readable storage medium
CN112749584B (en) Vehicle positioning method based on image detection and vehicle-mounted terminal
CN113178091B (en) Safe driving area method, device and network equipment
WO2024104012A1 (en) Lane positioning method and apparatus, and computer device, computer-readable storage medium and computer program product
WO2024040500A1 (en) Coloring method and apparatus for three-dimensional road surface, and storage medium, electronic device and vehicle
WO2022116572A1 (en) Target positioning method and apparatus
EP4078087B1 (en) Method and mobile entity for detecting feature points in an image
WO2022133986A1 (en) Accuracy estimation method and system
CN112530270B (en) Mapping method and device based on region allocation
JP7051416B2 (en) Self-position estimation device
WO2020223868A1 (en) Terrain information processing method and apparatus, and unmanned vehicle
CN112528829A (en) Vision-based center-centered driving method for unstructured road
US20240127603A1 (en) Unified framework and tooling for lane boundary annotation
US12008786B2 (en) Method, apparatus, and computer program product for point-to-point translation between images

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: 22956048

Country of ref document: EP

Kind code of ref document: A1