Apparatus and method for picking up article randomly piled using robot

Patent metadata

Field	Value
Publication number	US-9415511-B2
Application number	US-201414532716-A
Country	US
Kind code	B2
Filing date	Nov 4, 2014
Priority date	Nov 5, 2013
Publication date	Aug 16, 2016
Grant date	Aug 16, 2016

Abstract

An article pickup apparatus configured so as to set a grip unit model including a substantial region of the grip unit in an opened state and a grip region inside the substantial region, set position posture candidates of the grip unit, calculate a grip success possibility of any of the articles by the grip unit in each of the grip position posture candidates based on the position information acquired by a three-dimensional measurement instrument and the grip unit model, select position posture candidates from the position posture candidates based on the grip success possibility and setting the selected position posture candidates as grip unit position postures, and control the robot so as to move the grip unit to the grip unit position postures to pick up any of the articles.

First claim

The invention claimed is:

1. An article pickup apparatus, comprising:
a robot including a grip unit provided in an openable and closable manner;
a three-dimensional measurement instrument measuring surface positions of a plurality of articles randomly piled on a three-dimensional space to acquire position information of a plurality of three-dimensional points;
a grip unit model setting unit setting a grip unit model including a substantial region and a grip region inside the substantial region, the substantial region being a region of a substantial portion of the grip unit in an opened state;
a position posture candidate setting unit setting one or more position posture candidates as a candidate of a position and a posture of the grip unit;
a gripability calculation unit calculating a grip success possibility of any of the articles by the grip unit in each of the grip position posture candidates, assuming that the grip unit is placed at the grip position posture candidates set by the position posture candidate setting unit, based on the position information acquired by the three-dimensional measurement instrument and the grip unit model set by the grip unit model setting unit and based on the position information of the three-dimensional points present in the grip region among the position information acquired by the three-dimensional measurement instrument;
a position posture setting unit selecting one or more position posture candidates from the position posture candidates set by the position posture candidate setting unit, based on the grip success possibility calculated by the gripability calculation unit, and setting the selected one or more position posture candidates as one or more grip unit position postures; and
a robot control unit controlling the robot so as to move the grip unit to the one or more grip unit position postures set by the position posture setting unit to pick up any of the articles.

2. The article pickup apparatus according to claim 1 , wherein
the gripability calculation unit calculates the grip success possibility based on a gravity center position of the three-dimensional points present in the grip region.

3. The article pickup apparatus according to claim 1 , wherein
the position posture candidate setting unit sets the position posture candidates using one or more degrees of freedom, among six degrees of freedom, as a parameter, and
the six degrees of freedom include three translational degrees of freedom and three rotational degrees of freedom to define the position and the posture of the grip unit.

4. The article pickup apparatus according to claim 3 , wherein
the position posture candidate setting unit sets the position posture candidates using an opening amount of the grip unit as a parameter.

5. The article pickup apparatus according to claim 1 , further comprising:
a connected set calculation unit obtaining a connected set made by connecting the three-dimensional points present in the vicinity of each other among the plurality of three-dimensional points measured by the three-dimensional measurement instrument,
wherein the position posture candidate setting unit sets the position posture candidates based on the connected set obtained by the connected set calculation unit.

6. The article pickup apparatus according to claim 1 , wherein
the position posture candidate setting unit sets the position posture candidates based on projected points obtained by projecting the plurality of three-dimensional points measured by the three-dimensional measurement instrument on a plane, and
the gripability calculation unit calculates the grip success possibility based on a projection model obtained by projecting the grip unit model set by the grip unit model setting unit on the plane and the projected points.

7. The article pickup apparatus according to claim 1 , wherein the gripability calculation unit
judges whether any of the articles is present in the substantial region of the grip unit model, for each of the position posture candidates set by the position posture candidate setting unit, based on the position information acquired by the three-dimensional measurement instrument and the grip unit model set by the grip unit model setting unit, and
decreases the grip success possibility or sets the grip success possibility to be zero, in a position posture candidate judged that the article is present.

8. The article pickup apparatus according to claim 1 , further comprising a storage unit model setting unit setting a storage unit model, the storage unit model being a model of a storage unit storing the plurality of articles,
wherein the gripability calculation unit
judges whether the storage unit model is present in the substantial region of the grip unit model, for each of the position posture candidates set by the position posture candidate setting unit, based on the storage unit model acquired by the storage unit model setting unit and the grip unit model set by the grip unit model setting unit, and
decreases the grip success possibility or sets the grip success possibility to be zero, in a position posture candidate judged that the storage unit model is present.

9. The article pickup apparatus according to claim 1 , wherein
the position posture setting unit selects a grip position posture candidate where the grip success possibility calculated by the gripability calculation unit is maximized, from the position posture candidates set by the position posture candidate setting unit, and sets the selected grip position posture candidate as the grip unit position posture.

10. The article pickup apparatus according to claim 1 , wherein
the position posture setting unit selects a grip position posture candidate where the grip success possibility calculated by the gripability calculation unit is locally maximized, from the position posture candidates set by the position posture candidate setting unit, and sets the selected grip position posture candidate as the grip unit position posture.

11. An article pickup method for picking up any of articles randomly piled on a three-dimensional space using a robot including a grip unit provided in an openable and closable manner, the method comprising:
measuring surface positions of a plurality of the articles using a three-dimensional measurement instrument to acquire position information of a plurality of three-dimensional points;
setting a grip unit model including a substantial region and a grip region inside the substantial region, the substantial region being a region of a substantial portion of the grip unit in an opened state;
setting one or more position posture candidates as a candidate of a position and a posture of the grip unit;
calculating a grip success possibility of any of the articles by the grip unit in each of the grip position posture candidates, assuming that the grip unit is placed at the grip position posture candidates, based on the position information acquired by the three-dimensional measurement instrument and the grip unit model and based on the position information of the three-dimensional points present in the grip region among the position information acquired by the three-dimensional measurement instrument;
selecting one or more position posture candidates from the position posture candidates based on the grip success possibility, and setting the selected one or more position posture candidates as one or more grip unit position postures; and
controlling the robot so as to move the grip unit to the one or more grip unit position postures to pick up any of the articles.

Assignees

• Fanuc Corp

Inventors

• Gotou Takefumi

Classifications

• G05B2219/40053

  Pick 3-D object from pile of objects · CPC title

• B25J9/1612 Primary

  characterised by the hand, wrist, grip control · CPC title

• B25J9/1697

  Vision controlled systems · CPC title

• B25J9/1671

  characterised by simulation, either to verify existing program or to create and verify new program, CAD/CAM oriented, graphic oriented programming systems · CPC title