Method and apparatus for detecting operating terrain, and engineering equipment for detecting operating terrain
View Patent ↗A method for detecting an operating terrain is provided. The method includes obtaining point cloud data of an operating region that are collected by a laser radar at a current time, including three-dimensional coordinates of a plurality of sampling points. The operating region is divided into a plurality of grids, each having a corresponding height value. The method includes for any grid determining an input point of the grid from the plurality of sampling points, based on the three-dimensional coordinates. The method includes determining a type of the input point, based on a height coordinate of the input point and the height value of the grid. The type includes a noise point and a ground point. The method includes in response to determining that the input point is the ground point, updating the height value of the grid based on the height coordinate of the input point.
1 . A computer-implemented method for detecting an operating terrain, comprising:
obtaining point cloud data of an operating region that are collected by a laser radar at a current time, wherein the operating region is divided into a plurality of grids, and each grid of the plurality of grids has a corresponding height value, and wherein the point cloud data comprise three-dimensional coordinates of a plurality of sampling points;
for any grid among the plurality of grids:
determining a sampling point set corresponding to the grid, based on the three-dimensional coordinates of the plurality of sampling points, wherein the sampling point set comprises the sampling points in the grid;
using a sampling point with a largest height coordinate in the sampling point set as the input point, wherein the input point is selected from the sampling point set to determine an update of the height value of the grid;
determining a type of the input point, based on a height coordinate of the input point and the height value of the grid, wherein the type comprises a noise point and a ground point, wherein the input point is determined as the ground point is based on a condition that the difference between the height coordinate of the input point and the height value of the grid is greater than a first threshold, and a quantity of the input points of the grid determined as the noise points within a preset duration is greater than or equal to a second threshold; and
in response to determining that the input point is the ground point, updating the height value of the grid based on the height coordinate of the input point.
2 . The method according to claim 1 , wherein the point cloud data are obtained by scanning the operating region via the laser radar according to a non-repetitive scanning path.
3 . The method according to claim 1 , further comprising:
in response to determining that the input point is the noise point, adding the input point into a noise point container corresponding to the grid; and
in response to determining that a quantity of the noise points in the noise point container is greater than or equal to a third threshold, deleting a noise point with the earliest collection time in the noise point container.
4 . The method according to claim 1 , further comprising:
in response to determining that the input point is the ground point, adding the input point into a ground point container corresponding to the grid; and
in response to determining that a quantity of the ground points in the ground point container is greater than or equal to a fourth threshold, deleting a ground point with the earliest collection time in the ground point container.
5 . The method according to claim 4 , wherein in response to determining the input point is the ground point, updating the height value of the grid based on the height coordinate of the input point, comprises:
updating the height value of the grid to be an average value of the height coordinates of the ground points in the ground point container.
6 . The method according to claim 1 , wherein an initial value of the height value of the grid is the height coordinate of a first input point of the grid.
7 . An electronic device, comprising:
at least one processor; and
a memory in communication connection with the at least one processor,
wherein the memory stores instructions executable by the at least one processor, and the instructions, when executed by the at least one processor, enable the at least one processor to perform processing comprising:
obtaining point cloud data of an operating region that are collected by a laser radar at a current time, wherein the operating region is divided into a plurality of grids, and each grid of the plurality of grids has a corresponding height value, and wherein the point cloud data comprise three-dimensional coordinates of a plurality of sampling points;
for any grid among the plurality of grids:
determining a sampling point set corresponding to the grid, based on the three-dimensional coordinates of the plurality of sampling points, wherein the sampling point set comprises the sampling points in the grid;
using a sampling point with a largest height coordinate in the sampling point set as the input point, wherein the input point is selected from the sampling point set to determine an update of the height value of the grid;
determining a type of the input point, based on a height coordinate of the input point and the height value of the grid, wherein the type comprises a noise point and a ground point, wherein the input point is determined as the ground point is based on a condition that the difference between the height coordinate of the input point and the height value of the grid is greater than a first threshold, and a quantity of the input points of the grid determined as the noise points within a preset duration is greater than or equal to a second threshold; and
in response to determining that the input point is the ground point, updating the height value of the grid based on the height coordinate of the input point.
8 . The electronic device according to claim 7 , wherein the point cloud data are obtained by scanning the operating region via the laser radar according to a non-repetitive scanning path.
9 . The electronic device according to claim 7 , wherein the processing further comprises:
in response to determining that the input point is the noise point, adding the input point into a noise point container corresponding to the grid; and
in response to determining that a quantity of the noise points in the noise point container is greater than or equal to a third threshold, deleting a noise point with the earliest collection time in the noise point container.
10 . The electronic device according to claim 7 , wherein the processing further comprises:
in response to determining that the input point is the ground point, adding the input point into a ground point container corresponding to the grid; and
in response to determining that a quantity of the ground points in the ground point container is greater than or equal to a fourth threshold, deleting a ground point with the earliest collection time in the ground point container.
11 . The electronic device according to claim 10 , wherein in response to determining the input point is the ground point, updating the height value of the grid based on the height coordinate of the input point, comprises:
updating the height value of the grid to be an average value of the height coordinates of the ground points in the ground point container.
12 . The electronic device according to claim 7 , wherein an initial value of the height value of the grid is the height coordinate of a first input point of the grid.
13 . A non-transitory computer-readable storage medium storing computer instructions, wherein the computer instructions are configured to enable a computer to perform processing comprising:
obtaining point cloud data of an operating region that are collected by a laser radar at a current time, wherein the operating region is divided into a plurality of grids, and each grid of the plurality of grids has a corresponding height value, and wherein the point cloud data comprise three-dimensional coordinates of a plurality of sampling points;
for any grid among the plurality of grids:
determining a sampling point set corresponding to the grid, based on the three-dimensional coordinates of the plurality of sampling points, wherein the sampling point set comprises the sampling points in the grid;
using a sampling point with a largest height coordinate in the sampling point set as the input point, wherein the input point is selected from the sampling point set to determine an update of the height value of the grid;
determining a type of the input point, based on a height coordinate of the input point and the height value of the grid, wherein the type comprises a noise point and a ground point, wherein the input point is determined as the ground point is based on a condition that the difference between the height coordinate of the input point and the height value of the grid is greater than a first threshold, and a quantity of the input points of the grid determined as the noise points within a preset duration is greater than or equal to a second threshold; and
in response to determining that the input point is the ground point, updating the height value of the grid based on the height coordinate of the input point.