Interference determination device
The interference determination device includes a distance measurement unit measuring a distance to an object contained in a workspace of a robot; a decimation unit decimating point cloud data obtained by the distance measurement unit, based on a range and a number of points of the point cloud data obtained by the distance measurement unit; an extraction unit extracting point cloud data, contained in a determination region encompassing a robot region that corresponds to a model of the robot positioned in the workspace, from point cloud data after being decimated by the decimation unit; and a determination unit determining that the robot interferes with the object when the point cloud data extracted by the extraction unit is located inside the robot region.
1 . An interference determination device, comprising:
a distance measurement unit measuring a distance to an object contained in a workspace of a robot;
a decimation unit decimating point cloud data obtained by the distance measurement unit, based on a range and a number of points of the point cloud data obtained by the distance measurement unit;
an extraction unit extracting point cloud data, contained in a determination region encompassing a robot region that corresponds to a model of the robot positioned in the workspace, from point cloud data after being decimated by the decimation unit; and
a determination unit determining that the robot interferes with the object when the point cloud data extracted by the extraction unit is located inside the robot region,
wherein, in decimating point cloud data based on a range and a number of points of the point cloud data obtained by the distance measurement unit, the decimation unit computes a size of a space for demarcating a group of points in point cloud data to be decimated, and decimates the point cloud data for each group demarcated by the space, and
wherein, when a total number of remaining points of point cloud data after decimation exceeds a target number of points, the decimation unit increases the size of the space and further decimates the point cloud data for each group demarcated by the enlarged space.
2 . An interference determination device, comprising:
a distance measurement unit measuring a distance to an object contained in a workspace of a robot;
a decimation unit decimating point cloud data obtained by the distance measurement unit, based on a range and a number of points of the point cloud data obtained by the distance measurement unit; and
a determination unit determining that the robot interferes with the object when point cloud data after being decimated by the decimation unit is located inside a robot region that corresponds to a model of the robot positioned in the workspace,
wherein, in decimating point cloud data based on a range and a number of points of the point cloud data obtained by the distance measurement unit, the decimation unit computes a size of a space for demarcating a group of points in point cloud data to be decimated, and decimates the point cloud data for each group demarcated by the space, and
wherein, when a total number of remaining points of point cloud data after decimation exceeds a target number of points, the decimation unit increases the size of the space and further decimates the point cloud data for each group demarcated by the enlarged space.
3 . The interference determination device according to claim 1 , wherein
the determination region is provided for each link of the robot, and
the determination unit determines whether or not the robot interferes with the object for each link of the robot.