Apparatus for setting interference region of robot
An apparatus for setting an interference region of a robot includes a 3D camera which photographs surroundings of a robot to acquire a camera image of a region around the robot including distance information and color information, a 3D map generation unit which generates a 3D map including a plurality of point sequences which are arranged at equal intervals in a 3D space around the robot on the basis of the camera image, a color setting unit which sets a color of the robot, a color search unit which searches for a point sequence including color information corresponding to the robot color from the 3D map, and an interference region setting unit which sets an interference region on the basis of position data of the searched point sequence.
1. An apparatus for setting an interference region of a robot, comprising:
a 3D camera which photographs surroundings of a robot to acquire a camera image of a region around the robot including distance information and color information, which is configured to synthesize a plurality of images, and in which a position and a posture are changeable;
a 3D map generation unit which generates a 3D map comprising a plurality of point sequences which are arranged at equal intervals in a 3D space around the robot on a basis of the camera image, each of the point sequences including the color information included in the camera image;
a color setting unit which sets a color of at least one of the robot and an obstacle around the robot, the color being a color which makes the robot and the obstacle distinguishable;
a color search unit which searches for a point sequence including color information corresponding to the color set by the color setting unit from the 3D map generated by the 3D map generation unit; and
an interference region setting unit which sets an interference region, which is a region where the obstacle exists, on a basis of position data of the point sequence searched by the color search unit, the position data being obtained by the distance information of the camera image; wherein
the camera image includes an image of a marker which is a reference of a robot coordinate system, and
the interference region setting unit sets the interference region in the robot coordinate system on a basis of the image of the marker.
2. The apparatus for setting an interference region of a robot according to claim 1 , wherein the color setting unit sets the color of the robot, the color search unit searches for a robot point sequence including color information corresponding to the color of the robot from the 3D map, and the interference region setting unit sets the interference region on a basis of position data of remaining point sequences of the 3D map excluding the robot point sequence.
3. The apparatus for setting an interference region of a robot according to claim 1 , wherein the color setting unit sets the color of the obstacle, the color search unit searches for an obstacle point sequence including color information corresponding to the color of the obstacle from the 3D map, and the interference region setting unit sets the interference region on a basis of position data of the obstacle point sequence.