[go: up one dir, main page]

CN112543938A - Generation method and device of grid occupation map - Google Patents

Generation method and device of grid occupation map Download PDF

Info

Publication number
CN112543938A
CN112543938A CN202080004371.0A CN202080004371A CN112543938A CN 112543938 A CN112543938 A CN 112543938A CN 202080004371 A CN202080004371 A CN 202080004371A CN 112543938 A CN112543938 A CN 112543938A
Authority
CN
China
Prior art keywords
road surface
point cloud
curved
ground
occupied
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202080004371.0A
Other languages
Chinese (zh)
Other versions
CN112543938B (en
Inventor
孙翔雨
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen Yinwang Intelligent Technology Co ltd
Original Assignee
Huawei Technologies Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Huawei Technologies Co Ltd filed Critical Huawei Technologies Co Ltd
Publication of CN112543938A publication Critical patent/CN112543938A/en
Application granted granted Critical
Publication of CN112543938B publication Critical patent/CN112543938B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/588Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/89Lidar systems specially adapted for specific applications for mapping or imaging
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Traffic Control Systems (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本申请实施例提供一种占据栅格地图的生成方法和装置,该方法包括:获取点云传感器采集到的周围环境的点云;从周围环境的点云中获取障碍物点云和地面点云;根据地面点云和地面的特征,拟合曲面行驶路面,地面为移动平台所在的道路的地面,点云传感器搭载在移动平台上;从曲面行驶路面中确定待行驶路面区域,待行驶路面区域被划分为多个栅格;根据障碍物点云,确定各栅格被占据的概率;根据各栅格被占据的概率和待行驶路面区域,生成曲面占据栅格地图。本申请实施例生成的曲面占据栅格地图比较准确。

Figure 202080004371

The embodiments of the present application provide a method and device for generating an occupancy grid map, the method includes: acquiring a point cloud of a surrounding environment collected by a point cloud sensor; acquiring an obstacle point cloud and a ground point cloud from the point cloud of the surrounding environment ;According to the ground point cloud and the characteristics of the ground, fit the curved road surface, the ground is the ground of the road where the mobile platform is located, and the point cloud sensor is mounted on the mobile platform; Determine the road surface area to be driven from the curved road surface, and the road surface area to be driven on It is divided into multiple grids; according to the obstacle point cloud, the probability of each grid being occupied is determined; according to the occupied probability of each grid and the area of the road to be driven, a surface occupied grid map is generated. The surface occupation grid map generated by the embodiment of the present application is relatively accurate.

Figure 202080004371

Description

Generation method and device of grid occupation map
Technical Field
The present application relates to computer technologies, and in particular, to a method and an apparatus for generating a grid-occupied map.
Background
There are various classification modes for the robot map, including a scale map, a topological map, a semantic map, and the like, and an Occupancy Grid Map (OGM) in the scale map is most widely used. The detection area can be divided into a certain number of grids with certain sizes, the probability of each grid being occupied is determined according to the detection result of the detector, the probability of each grid being occupied is reflected to the corresponding grid in the detection area, and then a grid map of the occupied grid can be obtained, wherein the detector can be a point cloud sensor. Thus, the occupancy grid map may reflect obstacle information in the detection area.
However, in the current method for acquiring the occupancy grid map, the acquired occupancy grid map is not accurate enough, and the obstacle information in the detection area cannot be accurately reflected.
Disclosure of Invention
The application provides a method and a device for generating an occupation grid map, which can obtain an accurate occupation grid map.
In a first aspect, an embodiment of the present application provides a method for generating an occupancy grid map, including: acquiring a point cloud of a surrounding environment acquired by a point cloud sensor; acquiring an obstacle point cloud and a ground point cloud from the point cloud of the surrounding environment; according to the ground point cloud and the characteristics of the ground, fitting a curved surface driving road surface, wherein the ground is the ground of a road where a mobile platform is located, and the point cloud sensor is carried on the mobile platform; determining a road surface area to be driven from the curved driving road surface, wherein the road surface area to be driven is divided into a plurality of grids; determining a probability that each of the grids is occupied according to the obstacle point cloud; and generating a curved surface occupation grid map according to the probability of each grid being occupied and the road surface area to be driven.
According to the scheme, the curved surface driving road surface is fitted based on the characteristics of the ground, the road surface area to be driven is determined from the curved surface driving road surface, the road surface area to be driven is divided into a plurality of grids, a curved surface occupation grid map is generated according to the probability occupied by each grid and the road surface area to be driven, namely, the ground point cloud is not subjected to plane fitting, the curved surface driving road surface which accords with the actual characteristics of the ground is obtained through curved surface fitting, the accuracy of the occupation probability of each grid of the road surface area to be driven is improved, and the accuracy of the generated occupation grid map is improved.
In an alternative embodiment, the fitting a curved driving surface according to the ground point cloud and the characteristics of the ground comprises: acquiring a center line of a road where the ground is located; acquiring a first point in the ground point cloud, wherein the vertical distance between the first point and the center line is less than or equal to a preset distance; fitting each first point by adopting polynomial curve interpolation to obtain a road center fitting curve; and obtaining the curved surface running road surface according to a road center fitting curve, wherein the road center fitting curve is the center line of the curved surface running road surface.
The scheme provides a concrete implementation of the fitted curved surface running road surface.
In an alternative embodiment, the determining the probability that each of the occupancy grids is occupied from the obstacle point cloud comprises: extracting second points, of which the height difference between the obstacle point cloud and the curved surface driving road surface is smaller than or equal to the maximum height of the vehicle; determining, from each of the second points, a probability that each of the occupancy grids is occupied.
The method and the device can avoid misjudging the top of the suspension object or the bridge opening or the tunnel on the driving road surface as the barrier, improve the accuracy of determining the probability of occupying each grid in the road surface area to be driven, and further improve the accuracy of the generated grid-occupied map.
In an alternative embodiment, the determining the probability that each of the occupancy grids is occupied according to the second point includes: for any one of the second points, determining a first grid occupied by the second point and the influence probability of the second point on the first grid; adding the influence probabilities of second points occupying the same grid to the grid to obtain preselected occupation probabilities of the grids; for any one of the grids, an occupancy probability for the grid is obtained based on the first preselected occupancy probability for the grid and the occupancy probability for the grid at the previous time.
In an alternative embodiment, determining the road surface area to be traveled from the curved road surface includes: and determining a road surface area to be driven from the curved surface driving road surface according to the visual field range of the point cloud sensor and the curved surface driving road surface.
Optionally, determining a road surface area to be driven from the curved driving road surface according to the field of view of the point cloud sensor and the curved driving road surface, including: determining a first length according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is smaller than or equal to the length of the curved surface driving road surface; and determining the area of the road surface to be driven with the length of the first length and the width of the first width from the curved driving road surface, wherein the first width is the width of the curved driving road surface.
Optionally, determining a road surface area to be driven from the curved driving road surface according to the field of view of the point cloud sensor and the curved driving road surface, including: determining a first length and a second width according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is smaller than or equal to the length of the curved surface driving road surface, and the second width is smaller than or equal to the width of the curved surface driving road surface; and determining the area of the road surface to be driven, which has the first length and the second width, from the curved driving road surface.
According to the scheme, the length of the road surface area to be driven is determined based on the detection range of the sensor, so that the determined road surface area to be driven is more reasonable and accurate.
In an alternative embodiment, one side of the road surface area to be traveled coincides with a side of the curved road surface close to the mobile platform. The scheme determines the road surface area to be driven more reasonably and accurately.
In a second aspect, an embodiment of the present application provides an apparatus for generating an occupancy grid map, including: the acquisition module is used for acquiring the point cloud of the surrounding environment acquired by the point cloud sensor; a processing module to: acquiring an obstacle point cloud and a ground point cloud from the point cloud of the surrounding environment; according to the ground point cloud and the characteristics of the ground, fitting a curved surface driving road surface, wherein the ground is the ground of the road where the mobile platform is located, and the point cloud sensor is carried on the mobile platform; determining a road surface area to be driven from the curved driving road surface, wherein the road surface area to be driven is divided into a plurality of grids; determining the probability of each grid being occupied according to the obstacle point cloud; and generating a curved surface occupation grid map according to the probability of each grid being occupied and the road surface area to be driven.
In an optional implementation manner, the processing module is specifically configured to: acquiring a center line of a road where the ground is located; acquiring a first point in the ground point cloud, wherein the vertical distance between the first point and the center line is less than or equal to a preset distance; fitting each first point by adopting polynomial curve interpolation to obtain a road center fitting curve; and obtaining the curved surface running road surface according to a road center fitting curve, wherein the road center fitting curve is the center line of the curved surface running road surface.
In an optional implementation manner, the processing module is specifically configured to: extracting second points, of which the height difference between the obstacle point cloud and the curved surface driving road surface is smaller than or equal to the maximum height of the vehicle; determining, from each of the second points, a probability that each of the occupancy grids is occupied.
In an optional implementation manner, the processing module is specifically configured to: and determining a road surface area to be driven from the curved surface driving road surface according to the visual field range of the point cloud sensor and the curved surface driving road surface.
In an optional implementation manner, the processing module is specifically configured to: determining a first length according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is smaller than or equal to the length of the curved surface driving road surface; and determining the area of the road surface to be driven with the length of the first length and the width of the first width from the curved driving road surface, wherein the first width is the width of the curved driving road surface.
In an optional implementation manner, the processing module is specifically configured to: determining a first length and a second width according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is smaller than or equal to the length of the curved surface driving road surface, and the second width is smaller than or equal to the width of the curved surface driving road surface; and determining the area of the road surface to be driven, which has the first length and the second width, from the curved driving road surface.
In an alternative embodiment, one side of the road surface area to be traveled coincides with a side of the curved road surface close to the mobile platform.
In a third aspect, an embodiment of the present application provides a point cloud sensor, including: at least one processor; and a memory communicatively coupled to the at least one processor; wherein the memory stores instructions executable by the at least one processor to enable the at least one processor to perform the method of the first aspect or any of its possible implementations.
In a fourth aspect, an embodiment of the present application provides a mobile platform, where the point cloud sensor of the third aspect is mounted on the mobile platform.
In a fifth aspect, an embodiment of the present application provides a mobile platform, including a point cloud sensor and a processor; the point cloud sensor is used for acquiring a point cloud of a surrounding environment and sending the point cloud of the surrounding environment to the processor; the processor is used for receiving the point cloud of the surrounding environment, and acquiring an obstacle point cloud and a ground point cloud from the point cloud of the surrounding environment; according to the ground point cloud and the characteristics of the ground, fitting a curved surface driving road surface, wherein the ground is the ground of the road where the mobile platform is located, and the point cloud sensor is carried on the mobile platform; determining a road surface area to be driven from the curved driving road surface, wherein the road surface area to be driven is divided into a plurality of grids; determining the probability of each grid being occupied according to the obstacle point cloud; and generating a curved surface occupation grid map according to the probability of each grid being occupied and the road surface area to be driven.
In an alternative embodiment, the processor is further configured to perform the method of any one of the possible embodiments of the first aspect.
In a sixth aspect, an embodiment of the present application provides a storage medium, where the storage medium includes a computer program, and the computer program is configured to implement the method described in the first aspect or any possible implementation manner of the first aspect.
Drawings
FIG. 1 is a schematic diagram of a current land occupation grid map;
fig. 2 is a first scene schematic diagram for acquiring an occupancy grid map of a road surface according to an embodiment of the present application;
fig. 3 is a second scene schematic diagram for acquiring an occupancy grid map of a road surface according to the embodiment of the present application;
fig. 4 is a third scene schematic diagram for acquiring an occupancy grid map of a road surface according to the embodiment of the present application;
fig. 5 is a fourth scene schematic diagram for acquiring an occupancy grid map of a road surface according to the embodiment of the present application;
fig. 6 is a scene schematic diagram five of acquiring an occupancy grid map of a road surface according to an embodiment of the present application;
fig. 7 is a sixth schematic view of a scene for acquiring an occupancy grid map of a road surface according to an embodiment of the present application;
FIG. 8 is a flowchart of a method for generating an occupancy grid map provided by an embodiment of the present application;
FIG. 9 is a schematic view of a center line of a roadway provided in an embodiment of the present application;
FIG. 10 is a schematic view of a road surface area to be traveled according to an embodiment of the present application;
FIG. 11 is a schematic diagram of a second point in the obstacle point cloud provided by an embodiment of the present application;
FIG. 12 is a schematic diagram of a curved surface occupancy grid map provided by an embodiment of the present application;
FIG. 13 is a schematic block diagram of a generation apparatus for an occupancy grid map provided by an embodiment of the present application;
FIG. 14 is a schematic block diagram of a mobile platform provided by an embodiment of the present application;
fig. 15 is a schematic block diagram of an electronic device according to an embodiment of the present application.
Detailed Description
First, elements related to the present application will be described.
The planar occupancy grid map (FOGM) is based on the assumption that a detection area is a plane, the planar detection area is divided into a plurality of grids, the probability of each grid occupied by an obstacle is determined according to detection data of a detector (such as a radar and a camera) on the surrounding environment, and the probability of each grid occupied by the obstacle is reflected to the corresponding grid in the detection area, so that the planar occupancy grid map is obtained. A schematic diagram of a planar occupancy grid map may be as shown in fig. 1, the darker the color filling in the grid, the greater the probability that the grid is occupied.
The method includes the steps that a curved surface occupation grid map (COGM) means that a curved surface detection area is divided into a plurality of grids, the probability that each grid is occupied by an obstacle is determined according to detection data of a detector on the surrounding environment, the probability that each grid is occupied by the obstacle is reflected to the corresponding grid in the curved surface detection area, and the curved surface occupation grid map is obtained.
For a better understanding of the present application, the problems that exist at present are explained below.
Fig. 2 to 7 are schematic diagrams of several scenes for acquiring a grid map occupied by a road surface, referring to fig. 2 to 7, where a vehicle in fig. 2 to 7 is mounted with a detector, a road in fig. 2 is a planar road, a road in fig. 3 is a curved road with an uphill slope, a road in fig. 4 is a curved road with a downhill slope, a road in fig. 5 is an uneven curved road, a suspension is arranged above the road in fig. 6, and a road in fig. 7 is a road with a bridge opening and a tunnel.
At present, no matter in which scene, a road is assumed as a planar road, a planar road is fitted based on ground point cloud acquired by a detector, a travelable area is determined from the planar road according to the view field range of the detector, the travelable area is divided into a plurality of grids, the probability of each grid occupied by an obstacle is determined according to the obstacle point cloud acquired by the detector, and the probability of each grid occupied by the obstacle is reflected to the corresponding grid in the travelable area, so that a planar occupied grid map is obtained.
It can be understood that, in the current method for obtaining the plane occupancy grid map, in the scenarios shown in fig. 3 to 5, since the actual road surface is not a plane, the plane occupancy grid map obtained by fitting the road surface to the plane road is not accurate. Further, in the scenario shown in fig. 3, there may be a case where an uphill road is erroneously determined as an obstacle, in the scenario shown in fig. 4, a downhill road is erroneously determined as a plane area where traveling is freely possible, in the scenario shown in fig. 5, there may be a case where an uphill road is erroneously determined as an obstacle, and in the case where a downhill road is erroneously determined as a plane area where traveling is freely possible. In the scenario shown in fig. 6 and 7, a suspended object may be erroneously determined as an obstacle, and in the scenario shown in fig. 7, a bridge opening or a roof of a tunnel may be erroneously determined as an obstacle. That is, in the current method for obtaining the plane occupancy grid map, the obtained plane occupancy grid map is not accurate enough because the road surface is assumed to be a plane road surface, and/or all the obstacle point cloud data are used in determining the probability that each grid is occupied by the obstacle.
In order to solve the technical problem, the curved surface road surface is fitted based on the actual characteristics of the ground, so that the accuracy of the obtained grid-occupied map can be improved.
The method for generating the grid-occupied map of the present application will be described below with reference to specific examples.
Fig. 8 is a diagram illustrating a method for generating an occupancy grid map according to an embodiment of the present invention. The execution subject of the present embodiment may be a generation apparatus of a grid-occupied map, and referring to fig. 8, the method of the present embodiment includes:
step S801, acquiring a point cloud of a surrounding environment acquired by a point cloud sensor.
The point cloud sensor of this embodiment may be a time of flight (TOF) sensor, or a radar or a camera. The radar may be a lidar, which may be a rotary lidar or a solid state lidar. The point cloud sensor can be carried on the mobile platform to acquire the point cloud of the surrounding environment of the mobile platform. The mobile platform may be a vehicle, such as an autonomous vehicle or the like.
The generation device of the occupancy grid map in this embodiment may be all or part of the point cloud sensor, may also be all or part of a mobile platform on which the point cloud sensor is mounted, and may also be all or part of a server or a terminal device which has a communication connection relationship with the point cloud sensor or the mobile platform.
Step S802, obtaining an obstacle point cloud and a ground point cloud from the point cloud of the surrounding environment.
It can be understood that the point cloud of the surrounding environment includes an obstacle point cloud and a ground point cloud, the ground point cloud may be extracted from the point cloud of the surrounding environment, and the remaining point cloud is the obstacle point cloud.
Optionally, a ground point cloud fast segmentation algorithm may be adopted to extract the ground point cloud from the point cloud of the surrounding environment.
That is to say, the method of the present embodiment can accurately extract the ground point cloud from the point cloud of the surrounding environment, for example, in the scene shown in fig. 3, the method of the present embodiment does not misjudge the point cloud corresponding to the ascending slope as the obstacle point cloud.
And S803, fitting a curved surface driving road surface according to the ground point cloud and the characteristics of the ground, wherein the ground is the ground of the road where the mobile platform is located, and the point cloud sensor is carried on the mobile platform.
After the ground point cloud is obtained, the curved surface driving road surface can be fitted according to the ground point cloud.
In one specific implementation, the fitted curved driving road surface comprises the following a 1-a 4 according to the ground point cloud and the characteristics of the ground surface:
and a1, acquiring the center line of the road where the ground is located.
It can be understood that the road of the present embodiment is a road on which the mobile platform carrying the point cloud sensor is driven, wherein the center line of the road on which the ground is located may indicate the feature of the ground.
In a specific implementation, according to the boundary in the road width direction, the range of the center line may be calculated, and then an equation of the center line of the road on which the ground is located may be obtained, where the equation is used to indicate the center line of the road on which the ground is located. The center line of the road where the ground is located is parallel to the extending direction of the road.
Illustratively, referring to fig. 9, 901 shown in fig. 9 is the centerline of the road on which the ground is located.
a2, acquiring a first point in the ground point cloud, wherein the vertical distance between the first point and the center line is less than or equal to a preset distance.
For example, the equation of the center line of the road on which the mobile platform on which the point cloud sensor is located runs is a1xi+b1yjAnd if the distance is 0, calculating the vertical distance between each point in the ground point clouds and the central line according to the equation, wherein the point in the ground point clouds, the vertical distance between which and the central line is less than or equal to a preset distance, is the first point. It is understood that the number of the first points is plural.
Optionally, obtaining a first point in the ground point cloud, where a vertical distance from the center line is less than or equal to a preset distance, includes: and filtering the ground point cloud to obtain the filtered ground point cloud, and determining a point in the filtered ground point cloud, which has a vertical distance with the central line smaller than or equal to a preset distance, as a first point.
and a3, fitting each first point by adopting polynomial curve interpolation to obtain a road center fitting curve.
And after a plurality of first points are obtained, fitting each first point by adopting polynomial curve interpolation to obtain a road center fitting curve. The polynomial curve interpolation may be an L-term curve interpolation, where L is an integer greater than or equal to 2, for example, L is 2, 3, 4, 5, or 6.
and a4, fitting a curve according to the road center to obtain a curved surface running road surface, wherein the road center fitting curve is the center line of the curved surface running road surface.
According to the forming principle of a straight line surface, a line segment with the same width as the road width moves along a center fitting curve to form a straight line surface, namely a curved driving road surface.
Specifically, a first end of a road center fitting curve of the aisle, a first line segment with a width being the width of a road on which a mobile platform where the point cloud sensor is located runs and being perpendicular to the extending direction of the road can be obtained, the first line segment is moved from the first end of the road center fitting curve to a second end of the road center fitting curve along the road center fitting curve, and the obtained curved surface with the road center fitting curve as a center line is a curved surface running road surface. It will be appreciated that the first line segment is always perpendicular to the direction of extension of the road during the movement.
Or, the curved surface driving road surface is equivalent to a curved surface obtained by moving a first line segment from the first end of the road center fitting curve to the second end of the road center fitting curve along the road center fitting curve.
And step S804, determining a road surface area to be driven from the curved driving road surface, wherein the road surface area to be driven is divided into a plurality of grids.
One side of the area of the road surface to be driven, which is close to the moving platform, can be superposed with one side of the curved surface driving road surface, which is close to the moving platform, and the point cloud sensor is carried on the moving platform.
In a specific implementation, the area of the road surface to be traveled is determined from the curved travel road surface, and the area may specifically include b 1-b 2 as follows:
b1, obtaining the preset length.
Wherein the preset length may be stored in the generation means of the occupation grid map.
b2, determining a road surface area to be driven with a preset length and a first width from the curved driving road surface, wherein the first width is the width of the curved driving road surface.
That is, the area of the road surface to be traveled determined in this specific implementation is an area of a curved travel road surface, the length of which is a preset length, and the width of which is a first width. Alternatively, the road surface area to be traveled may be abstractly regarded as a plane formed by a straight line perpendicular to the advancing direction of the movable platform moving from a predetermined length along the central arc-shaped curve of the road.
After the road surface area to be traveled is obtained, the road surface area to be traveled is divided into a plurality of grids with the same size, for example, M × N grids with the same size, wherein M, N are positive integers.
In this specific implementation, since the length of the road surface area to be traveled is the preset length, the efficiency of determining the road surface area to be traveled is high.
In another specific implementation, the area of the road surface to be traveled can be determined from the curved driving road surface according to the detection range of the sensor and the curved driving road surface, and the area may specifically include c 1-c 2 as follows:
c1, determining a first length according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is less than or equal to the length of the curved surface driving road surface.
When the farthest distance which can be detected by the point cloud sensor is smaller than the length of the curved surface running road surface, the first length is the farthest distance which can be detected by the point cloud sensor, and when the farthest distance which can be detected by the point cloud sensor is larger than or equal to the length of the curved surface running road surface, the first length is equal to the length of the curved surface running road surface.
c2, determining the area of the road surface to be driven with the length as the first length and the width as the first width from the curved driving road surface, wherein the first width is the width of the curved driving road surface.
That is, the area of the road surface to be traveled is an area of the curved road surface having a first length and a first width.
After the road surface area to be traveled is obtained, the road surface area to be traveled is divided into a plurality of grids with the same size, which can be specifically shown in fig. 10. Referring to fig. 10, the road surface area to be traveled in fig. 10 may be the road surface area to be traveled obtained in the scene shown in fig. 3, and it is understood that the visually different size grids exist in the road surface area to be traveled because the road surface is fitted to a curved surface, and the size of each grid included in the road surface area to be traveled is actually the same.
In this specific implementation, since the length of the road surface area to be traveled is determined based on the detection range of the sensor, the determined road surface area to be traveled is more reasonable and accurate.
In another specific implementation, the area of the road surface to be traveled can be determined from the curved travel road surface according to the detection range of the sensor, and may specifically include d 1-d 2 as follows:
d1, determining a first length and a second width according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is less than or equal to the length of the curved surface driving road surface, and the second width is less than or equal to the width of the curved surface driving road surface.
The method for determining the first length is the same as above, and is not described herein again. And for the second width, when the maximum width which can be detected by the point cloud sensor is smaller than the first width of the curved running road surface, the second width is the maximum width which can be detected by the point cloud sensor, and when the maximum width which can be detected by the point cloud sensor is larger than or equal to the first width, the second width is equal to the first width.
d2, determining the area of the road surface to be driven with the length of the first length and the width of the second width from the curved driving road surface.
In this specific implementation, since the length of the road surface area to be traveled is determined based on the detection range of the sensor, the determined road surface area to be traveled is more reasonable and accurate.
Step S805, determining the probability of each grid occupied according to the obstacle point cloud.
The method for determining the probability of each grid occupied in the road surface area to be driven according to the point cloud of the obstacle may refer to a current general method, and details are not repeated here.
In an alternative manner, in order not to misjudge the suspended object on the driving road surface or the top of the bridge opening or the tunnel as the obstacle, "the probability that each grid in the road surface area to be driven is occupied according to the obstacle point cloud" in this step may include e1 to e2 as follows:
e1, extracting second points of which the height difference with the curved surface driving road surface in the obstacle point cloud is less than or equal to the maximum height of the vehicle.
That is, the vertical height difference between each second point and the curved running surface is less than or equal to the maximum height of the vehicle.
In one approach, the equation for a curved driving surface is: axm+byn+czk0; and for each point in the obstacle point cloud, acquiring the vertical distance between the point and the curved surface driving road surface, and if the vertical distance is less than or equal to the maximum height of the vehicle, determining the point as a second point. Wherein a, b, c are constants, m is an integer greater than or equal to 2, n is a positive integer, such as 1 or 2 or 3, and k is a positive integer, such as 1 or 2 or 3.
Illustratively, referring to fig. 11, 111 is a side view of a curved driving surface, and the points between the curve 112 and the curve 111 are all the second points.
e2, determining the probability of each grid in the road surface area to be driven being occupied according to each second point.
The specific implementation of determining the probability of each grid occupied in the road surface area to be traveled according to each second point may be as follows:
e21, for any one of the second points, determining the first grid occupied by the second point and the influence probability of the second point on the first grid.
The method for determining the influence probability of the second point on the first grid may refer to a conventional method, and is not described herein again.
e22, adding the influence probabilities of second points occupying the same grid to the grid to obtain the preselected occupation probability of each grid;
e23, for any first grid in the grids, obtaining the occupation probability of the first grid according to the first pre-selected occupation probability of the first grid and the occupation probability of the first grid at the last moment.
Where the initial probability of occupation of each grid is 0.
The method for obtaining the occupation probability of the first grid according to the first pre-selected occupation probability of the first grid and the occupation probability of the first grid at the previous time may refer to a current general method, and will not be described herein again.
e 1-e 2, the method for determining the probability of each grid occupied in the road surface area to be driven can avoid misjudging the suspended object on the driving road surface or the top of a bridge opening or a tunnel as an obstacle, improves the accuracy of determining the probability of each grid occupied in the road surface area to be driven, and further improves the accuracy of the generated grid occupied map.
And step 806, generating a curved surface occupation grid map according to the probability of occupation of each grid in the road surface area to be driven and the road surface area to be driven.
That is, the probability that each grid in the road surface area to be driven is occupied is reflected to the corresponding grid, and the grid map occupied by the curved surface can be generated. Specifically, as shown in fig. 12, the darker the color, the greater the probability that the grid is occupied.
Through the above steps S801 to S806, the method for obtaining the occupied grid map at the time t from the ambient point cloud acquired by the point cloud sensor at the time t is described. It will be appreciated that the occupancy grid map at any one time may be obtained according to the same method described above.
In this embodiment, a curved surface traveling road surface is fitted based on characteristics of the ground, a road surface area to be traveled is determined from the curved surface traveling road surface, the road surface area to be traveled is divided into a plurality of grids, and a curved surface occupancy grid map is generated according to the probability occupied by each grid and the road surface area to be traveled, that is, a ground point cloud is not subjected to plane fitting any more, but the curved surface traveling road surface conforming to actual characteristics of the ground is obtained by surface fitting, so that the accuracy of the occupancy probability of each grid of the obtained road surface area to be traveled is improved, and the accuracy of the generated occupancy grid map is improved.
The method according to the present application is explained above, and the apparatus according to the present application is explained below.
Fig. 13 is a schematic block diagram of a generation apparatus for an occupation grid map provided in an embodiment of the present application, and referring to fig. 13, the apparatus of the present embodiment includes: an obtaining module 1301 and a processing module 1302.
An obtaining module 1301, configured to obtain a point cloud of a surrounding environment collected by a point cloud sensor;
a processing module 1302, configured to:
acquiring an obstacle point cloud and a ground point cloud from the point cloud of the surrounding environment; and
according to the ground point cloud and the characteristics of the ground, fitting a curved surface driving road surface, wherein the ground is the ground of a road where a mobile platform is located, and the point cloud sensor is carried on the mobile platform; and
determining a road surface area to be driven from the curved driving road surface, wherein the road surface area to be driven is divided into a plurality of grids; and
determining a probability that each of the grids is occupied according to the obstacle point cloud; and
and generating a curved surface occupation grid map according to the probability of each grid being occupied and the road surface area to be driven.
Optionally, the processing module 1302 is specifically configured to:
acquiring a center line of a road where the ground is located;
acquiring a first point in the ground point cloud, wherein the vertical distance between the first point and the center line is less than or equal to a preset distance;
fitting each first point by adopting polynomial curve interpolation to obtain a road center fitting curve;
and obtaining the curved surface running road surface according to a road center fitting curve, wherein the road center fitting curve is the center line of the curved surface running road surface.
Optionally, the processing module 1302 is specifically configured to:
extracting second points, of which the height difference between the obstacle point cloud and the curved surface driving road surface is smaller than or equal to the maximum height of the vehicle;
determining, from each of the second points, a probability that each of the occupancy grids is occupied.
Optionally, the processing module 1302 is specifically configured to:
and determining a road surface area to be driven from the curved surface driving road surface according to the visual field range of the point cloud sensor and the curved surface driving road surface.
Optionally, the processing module 1302 is specifically configured to:
determining a first length according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is smaller than or equal to the length of the curved surface driving road surface;
and determining the area of the road surface to be driven with the length of the first length and the width of the first width from the curved driving road surface, wherein the first width is the width of the curved driving road surface.
Optionally, the processing module 1302 is specifically configured to:
determining a first length and a second width according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is smaller than or equal to the length of the curved surface driving road surface, and the second width is smaller than or equal to the width of the curved surface driving road surface;
and determining the area of the road surface to be driven, which has the first length and the second width, from the curved driving road surface.
Optionally, one side of the to-be-driven road surface area coincides with one side of the curved-surface driven road surface close to the moving platform.
The apparatus of this embodiment may be configured to execute the technical solution in the foregoing method embodiment, and the implementation principle and the technical effect are similar, which are not described herein again.
Fig. 14 is a schematic block diagram of a mobile platform provided in an embodiment of the present application, and referring to fig. 14, an apparatus in this embodiment includes: a point cloud sensor 1401 and a processor 1402;
the point cloud sensor is used for acquiring a point cloud of a surrounding environment and sending the point cloud of the surrounding environment to the processor;
the processor is used for receiving the point cloud of the surrounding environment, and acquiring an obstacle point cloud and a ground point cloud from the point cloud of the surrounding environment; according to the ground point cloud and the characteristics of the ground, fitting a curved surface driving road surface, wherein the ground is the ground of the road where the mobile platform is located, and the point cloud sensor is carried on the mobile platform; determining a road surface area to be driven from the curved driving road surface, wherein the road surface area to be driven is divided into a plurality of grids; determining the probability of each grid being occupied according to the obstacle point cloud; and generating a curved surface occupation grid map according to the probability of each grid being occupied and the road surface area to be driven.
Optionally, the processor 1402 is specifically configured to:
acquiring a center line of a road where the ground is located;
acquiring a first point in the ground point cloud, wherein the vertical distance between the first point and the center line is less than or equal to a preset distance;
fitting each first point by adopting polynomial curve interpolation to obtain a road center fitting curve;
and obtaining the curved surface running road surface according to a road center fitting curve, wherein the road center fitting curve is the center line of the curved surface running road surface.
Optionally, the processor 1402 is specifically configured to:
extracting second points, of which the height difference between the obstacle point cloud and the curved surface driving road surface is smaller than or equal to the maximum height of the vehicle;
determining, from each of the second points, a probability that each of the occupancy grids is occupied.
Optionally, the processor 1402 is specifically configured to: and determining a road surface area to be driven from the curved surface driving road surface according to the visual field range of the point cloud sensor and the curved surface driving road surface.
Optionally, the processor 1402:
determining a first length according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is smaller than or equal to the length of the curved surface driving road surface;
and determining the area of the road surface to be driven with the length of the first length and the width of the first width from the curved driving road surface, wherein the first width is the width of the curved driving road surface.
Optionally, the processor 1402 is specifically configured to:
determining a first length and a second width according to the visual field range of the point cloud sensor and the curved surface driving road surface, wherein the first length is smaller than or equal to the length of the curved surface driving road surface, and the second width is smaller than or equal to the width of the curved surface driving road surface;
and determining the area of the road surface to be driven, which has the first length and the second width, from the curved driving road surface.
Optionally, one side of the to-be-driven road surface area coincides with one side of the curved-surface driven road surface close to the moving platform.
The mobile platform of this embodiment may be configured to execute the technical solution in the foregoing method embodiment, and the implementation principle and the technical effect are similar, which are not described herein again.
The embodiment of the application also provides a mobile platform, wherein the mobile platform is provided with a point cloud sensor, and the point cloud sensor can execute the method in the embodiment of the method.
Fig. 15 is a schematic block diagram of an electronic device according to an embodiment of the present application. The electronic device of this embodiment may be a mobile platform, or may be a chip, a chip system, or a processor that supports the mobile platform to implement the method described above; the electronic device may be a point cloud sensor, or may be a chip, a chip system, or a processor supporting the point cloud sensor to implement the above method. The electronic device of this embodiment may be used to implement the method described in the above method embodiment, and specific reference may be made to the description in the above method embodiment.
The electronic device may comprise one or more processors 1501, which processors 1501 may also be referred to as processing units, which may implement certain control functions. The processor 1501 may be a general-purpose processor, a special-purpose processor, or the like.
In an alternative design, the processor 1501 may also store instructions and/or data 1503, and the instructions and/or data 1503 may be executed by the processor to enable the electronic device to perform the methods described in the above method embodiments.
In an alternative design, processor 1501 may include a transceiver unit to perform receive and transmit functions. The transceiving unit may be, for example, a transceiving circuit, or an interface circuit. The transmit and receive circuitry, interfaces or interface circuitry used to implement the receive and transmit functions may be separate or integrated. The transceiver circuit, the interface circuit or the interface circuit may be used for reading and writing code/data, or the transceiver circuit, the interface circuit or the interface circuit may be used for transmitting or transferring signals.
Optionally, the electronic device may include one or more memories 1502, on which instructions 1504 may be stored, which are executable on the processor to cause the electronic device to perform the methods described in the above method embodiments. Optionally, the memory may further store data therein. Optionally, instructions and/or data may also be stored in the processor. The processor and the memory may be provided separately or may be integrated together. For example, the correspondence described in the above method embodiments may be stored in a memory or in a processor.
Optionally, the electronic device may also include a transceiver 1505 and/or an antenna 1506. The processor 1501, which may be referred to as a processing unit, controls the electronic device. The transceiver 1505 may be referred to as a transceiver unit, a transceiver, a transceiving circuit or a transceiver, etc. for implementing transceiving functions.
The storage medium includes a computer program, and the computer program is used for implementing the method in the above method embodiments.
The processors and transceivers described in embodiments of the present application may be fabricated using various IC process technologies, such as Complementary Metal Oxide Semiconductor (CMOS), N-type metal oxide semiconductor (NMOS), P-type metal oxide semiconductor (PMOS), Bipolar Junction Transistor (BJT), Bipolar CMOS (bicmos), silicon germanium (SiGe), gallium arsenide (GaAs), and the like.
It should be understood that the processor in the embodiments of the present application may be an integrated circuit chip having signal processing capability. In implementation, the steps of the above method embodiments may be performed by integrated logic circuits of hardware in a processor or instructions in the form of software. The processor may be a general purpose processor, a Digital Signal Processor (DSP), an Application Specific Integrated Circuit (ASIC), a Field Programmable Gate Array (FPGA) or other programmable logic device, discrete gate or transistor logic device, or discrete hardware components.
It will be appreciated that the memory in the embodiments of the subject application can be either volatile memory or nonvolatile memory, or can include both volatile and nonvolatile memory. The non-volatile memory may be a read-only memory (ROM), a Programmable ROM (PROM), an Erasable PROM (EPROM), an electrically Erasable EPROM (EEPROM), or a flash memory. Volatile memory can be Random Access Memory (RAM), which acts as external cache memory. By way of example, but not limitation, many forms of RAM are available, such as Static Random Access Memory (SRAM), Dynamic Random Access Memory (DRAM), Synchronous Dynamic Random Access Memory (SDRAM), double data rate SDRAM, enhanced SDRAM, SLDRAM, Synchronous Link DRAM (SLDRAM), and direct rambus RAM (DR RAM). It should be noted that the memory of the systems and methods described herein is intended to comprise, without being limited to, these and any other suitable types of memory.
Where the above embodiments are implemented using software, they may be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer instructions. When loaded and executed on a computer, cause the processes or functions described in accordance with the embodiments of the application to occur, in whole or in part. The computer may be a general purpose computer, a special purpose computer, a network of computers, or other programmable device. The computer instructions may be stored on a computer readable storage medium or transmitted from one computer readable storage medium to another, for example, from one website, computer, server, or data center to another website, computer, server, or data center via wire (e.g., coaxial cable, fiber optic, Digital Subscriber Line (DSL)) or wireless (e.g., infrared, wireless, microwave, etc.). The computer-readable storage medium can be any available medium that can be accessed by a computer or a data storage device, such as a server, a data center, etc., that incorporates one or more of the available media. The usable medium may be a magnetic medium (e.g., a floppy disk, a hard disk, a magnetic tape), an optical medium (e.g., a Digital Video Disk (DVD)), or a semiconductor medium (e.g., a Solid State Disk (SSD)), among others.
In the several embodiments provided in the present application, it should be understood that the disclosed system, apparatus and method may be implemented in other ways. For example, the above-described apparatus embodiments are merely illustrative, and for example, the division of the units is only one logical division, and other divisions may be realized in practice, for example, a plurality of units or components may be combined or integrated into another system, or some features may be omitted, or not executed. In addition, the shown or discussed mutual coupling or direct coupling or communication connection may be an indirect coupling or communication connection through some interfaces, devices or units, and may be in an electrical, mechanical or other form.
The units described as separate parts may or may not be physically separate, and parts displayed as units may or may not be physical units, may be located in one place, or may be distributed on a plurality of network units. Some or all of the units can be selected according to actual needs to achieve the purpose of the solution of the embodiment.
In addition, functional units in the embodiments of the present application may be integrated into one processing unit, or each unit may exist alone physically, or two or more units are integrated into one unit.
The functions, if implemented in the form of software functional units and sold or used as a stand-alone product, may be stored in a computer readable storage medium. Based on such understanding, the technical solution of the present application or portions thereof that substantially contribute to the prior art may be embodied in the form of a software product stored in a storage medium and including instructions for causing a computer device (which may be a personal computer, a server, or a network device) to execute all or part of the steps of the method according to the embodiments of the present application.
The above description is only for the specific embodiments of the present application, but the scope of the present application is not limited thereto, and any person skilled in the art can easily conceive of the changes or substitutions within the technical scope of the present application, and shall be covered by the scope of the present application. Therefore, the protection scope of the present application shall be subject to the protection scope of the claims.
It should be appreciated that reference throughout this specification to "an embodiment" means that a particular feature, structure, or characteristic described in connection with the embodiment is included in at least one embodiment of the present application. Thus, the various embodiments are not necessarily referring to the same embodiment throughout the specification. Furthermore, the particular features, structures, or characteristics may be combined in any suitable manner in one or more embodiments. It should be understood that, in the various embodiments of the present application, the sequence numbers of the above-mentioned processes do not mean the execution sequence, and the execution sequence of each process should be determined by its function and inherent logic, and should not constitute any limitation to the implementation process of the embodiments of the present application.
It should also be understood that, in the present application, "when …", "if" and "if" all refer to the electronic device in the present application performing corresponding processing under certain objective conditions, and are not time-limited, and do not require certain judgment actions to be performed by the electronic device, nor do they imply that other limitations exist.
Reference in the present application to an element using the singular is intended to mean "one or more" rather than "one and only one" unless specifically stated otherwise. In the present application, unless otherwise specified, "at least one" is intended to mean "one or more" and "a plurality" is intended to mean "two or more".
In addition, the term "and/or" herein is only one kind of association relationship describing an associated object, and means that there may be three kinds of relationships, for example, a and/or B, which may mean: a exists alone, A and B exist simultaneously, and B exists alone, wherein A can be singular or plural, and B can be singular or plural.
The character "/" generally indicates that the former and latter associated objects are in an "or" relationship.
Herein, the term "at least one of … …" or "at least one of … …" means all or any combination of the listed items, e.g., "at least one of A, B and C", may mean: the compound comprises six cases of separately existing A, separately existing B, separately existing C, simultaneously existing A and B, simultaneously existing B and C, and simultaneously existing A, B and C, wherein A can be singular or plural, B can be singular or plural, and C can be singular or plural.
It should be understood that in the embodiments of the present application, "B corresponding to a" means that B is associated with a, from which B can be determined. It should also be understood that determining B from a does not mean determining B from a alone, but may be determined from a and/or other information.
The above description is only for the specific embodiments of the present invention, but the scope of the present invention is not limited thereto, and any person skilled in the art can easily conceive of the changes or substitutions within the technical scope of the present invention, and all the changes or substitutions should be covered within the scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the protection scope of the appended claims.

Claims (20)

1.一种占据栅格地图的生成方法,其特征在于,包括:1. a generation method of occupying a grid map, is characterized in that, comprising: 获取点云传感器采集到的周围环境的点云;Obtain the point cloud of the surrounding environment collected by the point cloud sensor; 从所述周围环境的点云中获取障碍物点云和地面点云;Obtain the obstacle point cloud and the ground point cloud from the point cloud of the surrounding environment; 根据所述地面点云和地面的特征,拟合曲面行驶路面,所述地面为移动平台所在的道路的地面,所述点云传感器搭载在所述移动平台上;Fitting a curved road surface according to the ground point cloud and the characteristics of the ground, the ground is the ground of the road where the mobile platform is located, and the point cloud sensor is mounted on the mobile platform; 从所述曲面行驶路面中确定待行驶路面区域,所述待行驶路面区域被划分为多个栅格;determining a road surface area to be driven from the curved road surface, the road surface area to be driven is divided into a plurality of grids; 根据所述障碍物点云,确定各所述栅格被占据的概率;According to the obstacle point cloud, determine the probability that each of the grids is occupied; 根据各所述栅格被占据的概率和所述待行驶路面区域,生成曲面占据栅格地图。According to the occupied probability of each grid and the area of the road surface to be driven, a grid map occupied by a curved surface is generated. 2.根据权利要求1所述的方法,其特征在于,所述根据所述地面点云和地面的特征,拟合曲面行驶路面,包括:2 . The method according to claim 1 , wherein the fitting of the curved surface driving road surface according to the ground point cloud and the characteristics of the ground comprises: 2 . 获取所述地面所在的道路的中心线;Obtain the centerline of the road where the ground is located; 获取所述地面点云中与所述中心线的垂直距离小于或等于预设距离的第一点;Obtain the first point whose vertical distance from the centerline is less than or equal to a preset distance in the ground point cloud; 采用多项式曲线插值拟合各所述第一点,得到道路中心拟合曲线;Use polynomial curve interpolation to fit each of the first points to obtain a road center fitting curve; 根据道路中心拟合曲线,得到所述曲面行驶路面,所述道路中心拟合曲线为所述曲面行驶路面的中心线。According to the road center fitting curve, the curved driving surface is obtained, and the road center fitting curve is the center line of the curved driving road surface. 3.根据权利要求1或2所述的方法,其特征在于,所述根据所述障碍物点云,确定各所述占据栅格被占据的概率,包括:3. The method according to claim 1 or 2, wherein the determining the probability that each of the occupied grids is occupied according to the obstacle point cloud comprises: 提取所述障碍物点云中与所述曲面行驶路面之间的高度差小于或等于车辆的最大高度的各第二点;extracting each second point whose height difference between the obstacle point cloud and the curved road surface is less than or equal to the maximum height of the vehicle; 根据各所述第二点,确定各所述占据栅格被占据的概率。According to each of the second points, the probability that each of the occupied grids is occupied is determined. 4.根据权利要求3所述的方法,其特征在于,所述根据所述第二点,确定各所述占据栅格被占据的概率,包括:4 . The method according to claim 3 , wherein the determining the probability that each of the occupied grids is occupied according to the second point comprises: 5 . 对于各第二点中的任意一个第二点,确定该第二点所占据的第一栅格,以及该第二点在该第一栅格所产生的影响概率;For any one of the second points, determine the first grid occupied by the second point and the influence probability of the second point on the first grid; 将占据同一栅格的第二点对该栅格的影响概率相加,得到各所述栅格的预选占据概率;Adding the influence probabilities of the second point occupying the same grid to the grid to obtain the preselected occupancy probability of each of the grids; 对于各所述栅格中任意一个栅格,根据该栅格的第一预选占据概率和上一时刻该的占据概率,得到该栅格的占据概率。For any one of the grids, the occupancy probability of the grid is obtained according to the first preselected occupancy probability of the grid and the occupancy probability at the previous moment. 5.根据权利要求1~4任一项所述的方法,其特征在于,从所述曲面行驶路面中确定待行驶路面区域,包括:5. The method according to any one of claims 1 to 4, wherein determining the road surface area to be driven from the curved road surface comprises: 根据所述点云传感器的视野范围和所述曲面行驶路面,从所述曲面行驶路面中确定待行驶路面区域。According to the field of view of the point cloud sensor and the curved road surface, a road surface area to be driven is determined from the curved road surface. 6.根据权利要求5所述的方法,其特征在于,所述根据所述点云传感器的视野范围,从所述曲面行驶路面中确定待行驶路面区域,包括:6 . The method according to claim 5 , wherein the determining, according to the field of view of the point cloud sensor, the road surface area to be driven from the curved road surface, comprising: 6 . 根据所述点云传感器的视野范围和所述曲面行驶路面,确定第一长度,所述第一长度小于或等于所述曲面行驶路面的长度;Determine a first length according to the field of view of the point cloud sensor and the curved road surface, where the first length is less than or equal to the length of the curved road surface; 从所述曲面行驶路面中确定长度为所述第一长度,宽度为第一宽度的所述待行驶路面区域,所述第一宽度为所述曲面行驶路面的宽度。It is determined from the curved driving road surface that the length is the first length and the width is the first width of the road surface area to be driven, and the first width is the width of the curved driving road surface. 7.根据权利要求5所述的方法,其特征在于,所述根据所述点云传感器的视野范围和所述曲面行驶路面,从所述曲面行驶路面中确定待行驶路面区域,包括:7 . The method according to claim 5 , wherein determining the area to be driven on the road surface from the curved road surface according to the field of view of the point cloud sensor and the curved road surface, comprising: 8 . 根据所述点云传感器的视野范围和所述曲面行驶路面,确定第一长度和第二宽度,所述第一长度小于或等于所述曲面行驶路面的长度,所述第二宽度小于或等于所述曲面行驶路面的宽度;According to the field of view of the point cloud sensor and the curved road surface, a first length and a second width are determined, the first length is less than or equal to the length of the curved road surface, and the second width is less than or equal to the the width of the curved road surface; 从所述曲面行驶路面中确定长度为所述第一长度,宽度为所述第二宽度的所述待行驶路面区域。A length of the first length and a width of the to-be-run surface area of the second width are determined from the curved running surface. 8.根据权利要求1~7任一项所述的方法,其特征在于,所述待行驶路面区域的一侧与所述曲面行驶路面靠近移动平台的一侧重合。8. The method according to any one of claims 1 to 7, wherein one side of the road surface area to be driven is coincident with the side of the curved road surface that is close to the moving platform. 9.一种占据栅格地图的生成装置,其特征在于,包括:9. A device for generating an occupied grid map, comprising: 获取模块,用于获取点云传感器采集到的周围环境的点云;The acquisition module is used to acquire the point cloud of the surrounding environment collected by the point cloud sensor; 处理模块,用于:Processing module for: 从所述周围环境的点云中获取障碍物点云和地面点云;以及obtaining an obstacle point cloud and a ground point cloud from the point cloud of the surrounding environment; and 根据所述地面点云和地面的特征,拟合曲面行驶路面,所述地面为移动平台所在的道路的地面,所述点云传感器搭载在所述移动平台上;以及According to the ground point cloud and the characteristics of the ground, fit a curved driving surface, the ground is the ground of the road where the mobile platform is located, and the point cloud sensor is mounted on the mobile platform; and 从所述曲面行驶路面中确定待行驶路面区域,所述待行驶路面区域被划分为多个栅格;以及determining a road surface area to travel from the curved road surface area, the road surface area to travel is divided into a plurality of grids; and 根据所述障碍物点云,确定各所述栅格被占据的概率;以及determining a probability that each of the grids is occupied according to the obstacle point cloud; and 根据各所述栅格被占据的概率和所述待行驶路面区域,生成曲面占据栅格地图。According to the occupied probability of each grid and the area of the road surface to be driven, a grid map occupied by a curved surface is generated. 10.根据权利要求9所述的装置,其特征在于,所述点云传感器搭载在移动平台上,所述处理模块具体用于:10. The device according to claim 9, wherein the point cloud sensor is mounted on a mobile platform, and the processing module is specifically used for: 获取地面所在的道路的中心线;Get the centerline of the road where the ground is located; 获取所述地面点云中与所述中心线的垂直距离小于或等于预设距离的第一点;Obtain the first point whose vertical distance from the centerline is less than or equal to a preset distance in the ground point cloud; 采用多项式曲线插值拟合各所述第一点,得到道路中心拟合曲线;Use polynomial curve interpolation to fit each of the first points to obtain a road center fitting curve; 根据道路中心拟合曲线,得到所述曲面行驶路面,所述道路中心拟合曲线为所述曲面行驶路面的中心线。According to the road center fitting curve, the curved driving surface is obtained, and the road center fitting curve is the center line of the curved driving road surface. 11.根据权利要求9或10所述的装置,其特征在于,所述处理模块具体用于:11. The device according to claim 9 or 10, wherein the processing module is specifically configured to: 提取所述障碍物点云中与所述曲面行驶路面之间的高度差小于或等于车辆的最大高度的各第二点;extracting each second point whose height difference between the obstacle point cloud and the curved road surface is less than or equal to the maximum height of the vehicle; 根据各所述第二点,确定各所述占据栅格被占据的概率。According to each of the second points, the probability that each of the occupied grids is occupied is determined. 12.根据权利要求9~11任一项所述的装置,其特征在于,所述处理模块具体用于:12. The apparatus according to any one of claims 9 to 11, wherein the processing module is specifically configured to: 根据所述点云传感器的视野范围和所述曲面行驶路面,从所述曲面行驶路面中确定待行驶路面区域。According to the field of view of the point cloud sensor and the curved road surface, a road surface area to be driven is determined from the curved road surface. 13.根据权利要求12所述的装置,其特征在于,所述处理模块具体用于:13. The apparatus according to claim 12, wherein the processing module is specifically configured to: 根据所述点云传感器的视野范围和所述曲面行驶路面,确定第一长度,所述第一长度小于或等于所述曲面行驶路面的长度;determining a first length according to the field of view of the point cloud sensor and the curved road surface, where the first length is less than or equal to the length of the curved road surface; 从所述曲面行驶路面中确定长度为所述第一长度,宽度为第一宽度的所述待行驶路面区域,所述第一宽度为所述曲面行驶路面的宽度。It is determined from the curved driving road surface that the length is the first length and the width is the first width of the road surface area to be driven, and the first width is the width of the curved driving road surface. 14.根据权利要求12所述的装置,其特征在于,所述处理模块具体用于:14. The apparatus according to claim 12, wherein the processing module is specifically configured to: 根据所述点云传感器的视野范围和所述曲面行驶路面,确定第一长度和第二宽度,所述第一长度小于或等于所述曲面行驶路面的长度,所述第二宽度小于或等于所述曲面行驶路面的宽度;According to the field of view of the point cloud sensor and the curved road surface, a first length and a second width are determined, the first length is less than or equal to the length of the curved road surface, and the second width is less than or equal to the the width of the curved road surface; 从所述曲面行驶路面中确定长度为所述第一长度,宽度为所述第二宽度的所述待行驶路面区域。A length of the first length and a width of the to-be-run surface area of the second width are determined from the curved running surface. 15.根据权利要求9~14任一项所述的装置,其特征在于,所述待行驶路面区域的一侧与所述曲面行驶路面靠近所述移动平台的一侧重合。15. The device according to any one of claims 9 to 14, wherein one side of the road surface area to be driven is coincident with the side of the curved road surface area close to the moving platform. 16.一种点云传感器,其特征在于,包括:16. A point cloud sensor, comprising: 至少一个处理器;以及at least one processor; and 与所述至少一个处理器通信连接的存储器;其中,a memory communicatively coupled to the at least one processor; wherein, 所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行权利要求1~8中任一项所述的方法。The memory stores instructions executable by the at least one processor, the instructions being executed by the at least one processor to enable the at least one processor to perform the execution of any one of claims 1 to 8 Methods. 17.一种移动平台,其特征在于,所述移动平台上搭载有所述权利要求16所述的点云传感器。17. A mobile platform, wherein the mobile platform is equipped with the point cloud sensor according to claim 16. 18.一种移动平台,其特征在于,包括点云传感器和处理器;18. A mobile platform, comprising a point cloud sensor and a processor; 所述点云传感器用于采集周围环境的点云,以及将所述周围环境的点云发送至所述处理器;The point cloud sensor is used for collecting the point cloud of the surrounding environment, and sending the point cloud of the surrounding environment to the processor; 所述处理器用于接收所述周围环境的点云,从所述周围环境的点云中获取障碍物点云和地面点云;以及,The processor is configured to receive a point cloud of the surrounding environment, and obtain an obstacle point cloud and a ground point cloud from the point cloud of the surrounding environment; and, 根据所述地面点云和地面的特征,拟合曲面行驶路面,所述地面为移动平台所在的道路的地面,所述点云传感器搭载在所述移动平台上;以及,According to the ground point cloud and the characteristics of the ground, fit a curved road surface, the ground is the ground of the road where the mobile platform is located, and the point cloud sensor is mounted on the mobile platform; and, 从所述曲面行驶路面中确定待行驶路面区域,所述待行驶路面区域被划分为多个栅格;以及,Determining a road surface area to travel on from the curved road surface, the road surface area to travel on is divided into a plurality of grids; and, 根据所述障碍物点云,确定各所述栅格被占据的概率;以及,determining a probability that each of the grids is occupied according to the obstacle point cloud; and, 根据各所述栅格被占据的概率和所述待行驶路面区域,生成曲面占据栅格地图。According to the occupied probability of each grid and the area of the road surface to be driven, a grid map occupied by a curved surface is generated. 19.根据权利要求18所述的移动平台,其特征在于,所述处理器还用于执行权利要求2~8中任一项所述的方法。19. The mobile platform according to claim 18, wherein the processor is further configured to execute the method of any one of claims 2-8. 20.一种存储介质,其特征在于,所述存储介质包括计算机程序,所述计算机程序用于实现如权利要求1~8任一项所述的方法。20. A storage medium, wherein the storage medium comprises a computer program, and the computer program is used to implement the method according to any one of claims 1 to 8.
CN202080004371.0A 2020-09-29 2020-09-29 Generation method and device of grid occupation map Active CN112543938B (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/118950 WO2022067534A1 (en) 2020-09-29 2020-09-29 Occupancy grid map generation method and device

Publications (2)

Publication Number Publication Date
CN112543938A true CN112543938A (en) 2021-03-23
CN112543938B CN112543938B (en) 2022-02-08

Family

ID=75017358

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202080004371.0A Active CN112543938B (en) 2020-09-29 2020-09-29 Generation method and device of grid occupation map

Country Status (2)

Country Link
CN (1) CN112543938B (en)
WO (1) WO2022067534A1 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114355939A (en) * 2021-12-31 2022-04-15 深圳市联洲国际技术有限公司 Path planning method and device of movable equipment and navigation system
CN115016507A (en) * 2022-07-27 2022-09-06 深圳市普渡科技有限公司 Mapping method, positioning method, device, robot and storage medium
CN115330969A (en) * 2022-10-12 2022-11-11 之江实验室 A vectorized description method of local static environment for ground unmanned vehicles
CN115859908A (en) * 2023-02-22 2023-03-28 江苏曼荼罗软件股份有限公司 Grid processing-based electronic case display method and system
CN116086430A (en) * 2022-12-27 2023-05-09 深圳市普渡科技有限公司 Raster map construction method, robot and computer readable storage medium

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114879685B (en) * 2022-05-25 2023-04-28 合肥工业大学 River shoreline detection and autonomous cruising method for unmanned ship
CN115376109B (en) * 2022-10-25 2023-03-24 杭州华橙软件技术有限公司 Obstacle detection method, obstacle detection device, and storage medium
CN115856936B (en) * 2022-11-21 2025-06-27 吉林大学 Ground obstacle identification method based on laser radar
CN116091369B (en) * 2023-04-10 2023-07-07 武汉天际航信息科技股份有限公司 Digital road map distinguishing method, device, computing equipment and storage medium
CN116533998B (en) * 2023-07-04 2023-09-29 深圳海星智驾科技有限公司 Automatic driving method, device, equipment, storage medium and vehicle of vehicle

Citations (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100066587A1 (en) * 2006-07-14 2010-03-18 Brian Masao Yamauchi Method and System for Controlling a Remote Vehicle
CN104374376A (en) * 2014-11-05 2015-02-25 北京大学 Vehicle-mounted three-dimensional measurement system device and application thereof
CN106792465A (en) * 2016-12-26 2017-05-31 华中科技大学 A kind of indoor fingerprint map constructing method based on mass-rent fingerprint
CN107388967A (en) * 2017-08-14 2017-11-24 上海汽车集团股份有限公司 A kind of outer parameter compensation method of vehicle-mounted three-dimensional laser sensor and device
CN108319655A (en) * 2017-12-29 2018-07-24 百度在线网络技术(北京)有限公司 Method and apparatus for generating grating map
CN108460416A (en) * 2018-02-28 2018-08-28 武汉理工大学 A kind of structured road feasible zone extracting method based on three-dimensional laser radar
CN109017780A (en) * 2018-04-12 2018-12-18 深圳市布谷鸟科技有限公司 A kind of Vehicular intelligent driving control method
CN109270927A (en) * 2017-07-17 2019-01-25 高德软件有限公司 The generation method and device of road data
CN110068836A (en) * 2019-03-20 2019-07-30 同济大学 A kind of laser radar curb sensory perceptual system of intelligent driving electric cleaning car
CN110120097A (en) * 2019-05-14 2019-08-13 南京林业大学 Airborne cloud Semantic Modeling Method of large scene
CN110320504A (en) * 2019-07-29 2019-10-11 浙江大学 A kind of unstructured road detection method based on laser radar point cloud statistics geometrical model
CN110490888A (en) * 2019-07-29 2019-11-22 武汉大学 Freeway geometry Characteristic Vectors based on airborne laser point cloud quantify extracting method
CN110824514A (en) * 2018-08-14 2020-02-21 中国电信股份有限公司 Fingerprint positioning method and device and computer readable storage medium
CN110866927A (en) * 2019-11-21 2020-03-06 哈尔滨工业大学 A robot positioning and composition method based on EKF-SLAM algorithm combined with vertical foot point and line features
US20200142410A1 (en) * 2014-09-05 2020-05-07 SZ DJI Technology Co., Ltd. Multi-sensor environmental mapping
CN111142117A (en) * 2019-12-31 2020-05-12 芜湖哈特机器人产业技术研究院有限公司 Hybrid navigation map construction method and system fusing corner plates and occupying grids
CN111307166A (en) * 2018-12-11 2020-06-19 北京图森智途科技有限公司 Method, device and processing equipment for constructing occupied grid map
WO2020154968A1 (en) * 2019-01-30 2020-08-06 Baidu.Com Times Technology (Beijing) Co., Ltd. A point clouds ghosting effects detection system for autonomous driving vehicles
CN111598916A (en) * 2020-05-19 2020-08-28 金华航大北斗应用技术有限公司 Preparation method of indoor occupancy grid map based on RGB-D information

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5206752B2 (en) * 2010-08-30 2013-06-12 株式会社デンソー Driving environment recognition device
JP6559535B2 (en) * 2015-10-22 2019-08-14 株式会社東芝 Obstacle map generation device, method thereof, and program thereof
CN105652876A (en) * 2016-03-29 2016-06-08 北京工业大学 Mobile robot indoor route planning method based on array map
CN106097431A (en) * 2016-05-09 2016-11-09 王红军 A kind of object global recognition method based on 3 d grid map
CN110264572B (en) * 2019-06-21 2021-07-30 哈尔滨工业大学 A terrain modeling method and system integrating geometric and mechanical properties
CN110550029B (en) * 2019-08-12 2021-02-09 华为技术有限公司 Obstacle avoidance method and device

Patent Citations (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100066587A1 (en) * 2006-07-14 2010-03-18 Brian Masao Yamauchi Method and System for Controlling a Remote Vehicle
US20200142410A1 (en) * 2014-09-05 2020-05-07 SZ DJI Technology Co., Ltd. Multi-sensor environmental mapping
CN104374376A (en) * 2014-11-05 2015-02-25 北京大学 Vehicle-mounted three-dimensional measurement system device and application thereof
CN106792465A (en) * 2016-12-26 2017-05-31 华中科技大学 A kind of indoor fingerprint map constructing method based on mass-rent fingerprint
CN109270927A (en) * 2017-07-17 2019-01-25 高德软件有限公司 The generation method and device of road data
CN107388967A (en) * 2017-08-14 2017-11-24 上海汽车集团股份有限公司 A kind of outer parameter compensation method of vehicle-mounted three-dimensional laser sensor and device
CN108319655A (en) * 2017-12-29 2018-07-24 百度在线网络技术(北京)有限公司 Method and apparatus for generating grating map
CN108460416A (en) * 2018-02-28 2018-08-28 武汉理工大学 A kind of structured road feasible zone extracting method based on three-dimensional laser radar
CN109017780A (en) * 2018-04-12 2018-12-18 深圳市布谷鸟科技有限公司 A kind of Vehicular intelligent driving control method
CN110824514A (en) * 2018-08-14 2020-02-21 中国电信股份有限公司 Fingerprint positioning method and device and computer readable storage medium
CN111307166A (en) * 2018-12-11 2020-06-19 北京图森智途科技有限公司 Method, device and processing equipment for constructing occupied grid map
WO2020154968A1 (en) * 2019-01-30 2020-08-06 Baidu.Com Times Technology (Beijing) Co., Ltd. A point clouds ghosting effects detection system for autonomous driving vehicles
CN110068836A (en) * 2019-03-20 2019-07-30 同济大学 A kind of laser radar curb sensory perceptual system of intelligent driving electric cleaning car
CN110120097A (en) * 2019-05-14 2019-08-13 南京林业大学 Airborne cloud Semantic Modeling Method of large scene
CN110320504A (en) * 2019-07-29 2019-10-11 浙江大学 A kind of unstructured road detection method based on laser radar point cloud statistics geometrical model
CN110490888A (en) * 2019-07-29 2019-11-22 武汉大学 Freeway geometry Characteristic Vectors based on airborne laser point cloud quantify extracting method
CN110866927A (en) * 2019-11-21 2020-03-06 哈尔滨工业大学 A robot positioning and composition method based on EKF-SLAM algorithm combined with vertical foot point and line features
CN111142117A (en) * 2019-12-31 2020-05-12 芜湖哈特机器人产业技术研究院有限公司 Hybrid navigation map construction method and system fusing corner plates and occupying grids
CN111598916A (en) * 2020-05-19 2020-08-28 金华航大北斗应用技术有限公司 Preparation method of indoor occupancy grid map based on RGB-D information

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
VICTORIA PLAZA-LEIVA等: ""Occupancy grids generation based on Geometric-Featured Voxel maps"", 《2015 23RD MEDITERRANEAN CONFERENCE ON CONTROL AND AUTOMATION (MED)》 *
曾键等: ""一种融合激光与视觉传感器的栅格地图构建方法"", 《工业控制计算机》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114355939A (en) * 2021-12-31 2022-04-15 深圳市联洲国际技术有限公司 Path planning method and device of movable equipment and navigation system
CN115016507A (en) * 2022-07-27 2022-09-06 深圳市普渡科技有限公司 Mapping method, positioning method, device, robot and storage medium
CN115330969A (en) * 2022-10-12 2022-11-11 之江实验室 A vectorized description method of local static environment for ground unmanned vehicles
CN116086430A (en) * 2022-12-27 2023-05-09 深圳市普渡科技有限公司 Raster map construction method, robot and computer readable storage medium
CN115859908A (en) * 2023-02-22 2023-03-28 江苏曼荼罗软件股份有限公司 Grid processing-based electronic case display method and system

Also Published As

Publication number Publication date
WO2022067534A1 (en) 2022-04-07
CN112543938B (en) 2022-02-08

Similar Documents

Publication Publication Date Title
CN112543938B (en) Generation method and device of grid occupation map
CN112154356B (en) Point cloud data processing method and device, laser radar and movable platform
WO2017115732A1 (en) Image processing device, object recognition device, machinery control system, image processing method, and image processing program
WO2022166323A1 (en) Method for determining road line, and related apparatus and device
KR102255924B1 (en) Vehicle and method for detecting lane
WO2022068274A1 (en) Positioning method, apparatus and system
US20240346859A1 (en) Systems and methods of collapse of driving data to determine spatial averages of vehicle paths within an intersection
CN114631124B (en) Three-dimensional point cloud segmentation method and device, and movable platform
CN119599957A (en) Method, system, equipment and medium suitable for detecting low-speed railway obstacle
EP3618027B1 (en) Object identification device, road-side device and object identification method
JPWO2017130285A1 (en) Vehicle determination device, vehicle determination method, and vehicle determination program
JP7278915B2 (en) OBJECT DETECTION DEVICE, OBJECT DETECTION SYSTEM, MOBILE OBJECT AND OBJECT DETECTION METHOD
JP7206172B2 (en) OBJECT DETECTION DEVICE, OBJECT DETECTION SYSTEM, MOBILE OBJECT AND OBJECT DETECTION METHOD
CN116824152A (en) Target detection method and device based on point cloud, readable storage medium and terminal
US20240125931A1 (en) Light receiving device, distance measuring device, and signal processing method in light receiving device
CN113196098B (en) Echo data-based speed estimation method and device
US11804135B2 (en) Object recognition apparatus, object recognition method, and computer readable medium
CN116524446A (en) Lane line detection method, path planning method and related equipment
JP7308112B2 (en) OBJECT DETECTION DEVICE, OBJECT DETECTION SYSTEM, MOBILE OBJECT AND OBJECT DETECTION METHOD
KR102683843B1 (en) Lane detection system and method using the same
US20240142258A1 (en) Object detection device, object detection method, and storage medium storing program
Ban et al. A Real-Time Detection Algorithm for Semi-structured Boundaries in the Park Based on 3D LiDAR
WO2022001337A1 (en) Positioning map generation method and device, and positioning method and device
CN119027476A (en) Method and device for determining free space
CN117762141A (en) Obstacle determination method, device, equipment and medium

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20241113

Address after: 518129 Huawei Headquarters Office Building 101, Wankecheng Community, Bantian Street, Longgang District, Shenzhen, Guangdong

Patentee after: Shenzhen Yinwang Intelligent Technology Co.,Ltd.

Country or region after: China

Address before: 518129 Bantian HUAWEI headquarters office building, Longgang District, Guangdong, Shenzhen

Patentee before: HUAWEI TECHNOLOGIES Co.,Ltd.

Country or region before: China