MANIPULATOR AND METHOD OF CONTROLLING THE SAME

• US 20100318224A1
• Filed: 03/05/2009
• Published: 12/16/2010
• Est. Priority Date: 03/06/2008
• Status: Active Grant

• Current Assignee: Panasonic Corporation (Panasonic Holdings Corporation)
• Original Assignee: Panasonic Corporation (Panasonic Holdings Corporation)
• Inventors: Matsukawa, Yoshihiko, Mizuno, Osamu, Nakamura, Tohru, Okuda, Akinobu, Takahashi, Rie, Tojo, Tsuyoshi, Fujioka, Soichiro
• Granted Patent: US 8,504,203 B2
• Time in Patent Office: Days
• US Class Current: 700/255
• CPC Class Codes: B25J 9/1676 Avoiding collision or forbidden zones
• CPC Class Codes: G05B 2219/39082 Collision, real time collision avoidance
• CPC Class Codes: Y10T 74/20329 Joint between elements

Abstract

A manipulator is provided with an arm, an arm, a holding section, a first joint section pivotally interconnecting the arm and the arm, a second joint section pivotally interconnecting the arm and the holding section, a first joint driving section capable of driving the first joint section, a second joint driving section capable of driving the second joint section, a member specifying section for specifying one of the arms which has a possibility of collision with an obstacle or which has collided with the obstacle, and a control device for controlling the first joint driving section and the second joint driving section to pivotally move the one of the arms specified by the member specifying section in a direction away from the obstacle, and pivotally move the other of the arms in a direction toward the obstacle.

Claims

1-12. -12. (canceled)

13. A manipulator comprising:

a first movable member;

a second movable member;

a holding section;

a first joint section pivotally interconnecting the first movable member and the second movable member;

a second joint section pivotally interconnecting the second movable member and the holding section;

a first joint driving section capable of driving the first joint section;

a second joint driving section capable of driving the second joint section;

a member specifying section for specifying one of the first movable member and the second movable member which has a possibility of collision with an obstacle, or which has collided with the obstacle; and

a control device for controlling the first joint driving section and the second joint driving section in such a manner as to pivotally move the one movable member specified by the member specifying section in a direction away from the obstacle, and pivotally move the other movable member in a direction toward the obstacle.

14. The manipulator according to claim 13, wherein

the control device includes an acceleration determining section for determining whether or not the pivotal movement of the other movable member is to be accelerated, based on positional relation information representing a positional relation between the one movable member specified by the member specifying section, and the obstacle, angle information representing an angle defined by the first movable member and the second movable member, and pivotal direction information representing a pivotal direction of the other movable member.

15. The manipulator according to claim 14, wherein

the acceleration determining section determines, based on the positional relation information, the angle information, and the pivotal direction information, that the pivotal movement of the other movable member is to be accelerated, in the case where the obstacle is in a direction opposite to a direction of a reaction force generated on the one movable member by acceleration of the pivotal movement of the other movable member, and that the pivotal movement of the other movable member is not to be accelerated, in the case where the obstacle is in the direction of the reaction force.

16. The manipulator according to claim 15, wherein

assuming a direction of pivotally moving the other movable member about an axis of pivotal movement of the first joint section is a positive direction, and the angle defined by the first movable member and the second movable member is θ

, and in the case where the other movable member is pivotally moved in the pivotal direction, the acceleration determining section;

determines that the pivotal movement of the other movable member is to be accelerated, in the case where a condition;

0°

<

θ

<

90°

or 270°

<

θ

<

360°

is satisfied, and the obstacle is in a direction of decreasing the angle θ

;

determines that the pivotal movement of the other movable member is not to be accelerated, in the case where a condition;

0°

<

θ

<

90°

or 270°

<

θ

<

360°

is satisfied, and the obstacle is in a direction of increasing the angle θ

;

determines that the pivotal movement of the other movable member is to be accelerated, in the case where a condition;

90°

<

θ

<

180°

or 180°

<

θ

<

270°

is satisfied, and the obstacle is in a direction of increasing the angle θ

; and

determines that the pivotal movement of the other movable member is not to be accelerated, in the case where a condition;

90°

<

θ

<

180°

or 180°

<

θ

<

270°

is satisfied, and the obstacle is in a direction of decreasing the angle θ

.

17. The manipulator according to claim 13, wherein

the holding section includes a moving section configured to hold the second movable member and be movable by a moving/driving section, and

the control device controls the moving/driving section to move the moving section in a direction away from the obstacle, in the case where the one movable member is the first movable member, and move the moving section in a direction toward the obstacle, in the case where the one movable member is the second movable member.

18. The manipulator according to claim 13, wherein

the member specifying section derives a position of the obstacle based on photographed images obtained by at least two photographing sections, and specifies one of the first movable member and the second movable member which has a possibility of collision with the obstacle, or which has collided with the obstacle.

19. A manipulator comprising:

a first movable member;

a second movable member;

a first joint section pivotally interconnecting the first movable member and the second movable member;

a moving section including a moving/driving section;

a third joint section pivotally interconnecting the second movable member and the moving section;

a first joint driving section capable of driving the first joint section;

a third joint driving section capable of driving the third joint section;

a member specifying section for specifying one of the first movable member and the second movable member which has a possibility of collision with an obstacle, or which has collided with the obstacle; and

a control device for controlling the first joint driving section, the third joint driving section, and the moving/driving section in such a manner as to pivotally move the one movable member specified by the member specifying section in a direction away from the obstacle, move the moving section in the direction away from the obstacle, in the case where the one movable member is the first movable member, and move the moving section in a direction toward the obstacle, in the case where the one movable member is the second movable member.

20. The manipulator according to claim 19, wherein

the control device includes an acceleration determining section for determining whether or not the moving section is to be accelerated, based on positional relation information representing a positional relation between the one movable member specified by the member specifying section, and the obstacle, and angle information representing an angle defined by the first movable member and the second movable member.

21. The manipulator according to claim 20, wherein

the acceleration determining section determines, based on the positional relation information and the angle information, that the moving section is to be accelerated, in the case where the obstacle is in a direction opposite to a direction of a reaction force generated on a centroid of the one movable member by acceleration of the moving section, and that the moving section is not to be accelerated, in the case where the obstacle is in the direction of the reaction force.

22. A method of controlling a manipulator provided with a first movable member, a second movable member, a holding section, a first joint section pivotally interconnecting the first movable member and the second movable member, a second joint section pivotally interconnecting the second movable member and the holding section, a first joint driving section capable of driving the first joint section, and a second joint driving section capable of driving the second joint section, the method comprising:

a member specifying step of specifying one of the first movable member and the second movable member which has a possibility of collision with an obstacle, or which has collided with the obstacle; and

a controlling step of controlling the first joint driving section and the second joint driving section in such a manner as to pivotally move the one movable member specified in the member specifying step in a direction away from the obstacle, and pivotally move the other movable member in a direction toward the obstacle.

23. The method of controlling the manipulator according to claim 22, wherein

in the controlling step, the other movable member is determined to be accelerated, in the case where the obstacle is in a direction opposite to a direction of a reaction force generated on the one movable member by acceleration of the pivotal movement of the other movable member, and the other movable member is determined not to be accelerated, in the case where the obstacle is in the direction of the reaction force.

24. A method of controlling a manipulator provided with a first movable member, a second movable member, a moving section including a moving/driving section, a first joint section pivotally interconnecting the first movable member and the second movable member, a third joint section pivotally interconnecting the second movable member and the moving section, a first joint driving section capable of driving the first joint section, and a third joint driving section capable of driving the third joint section, the method comprising:

a member specifying step of specifying one of the first movable member and the second movable member which has a possibility of collision with an obstacle, or which has collided with the obstacle; and

a controlling step of controlling the first joint driving section, the third joint driving section, and the moving/driving section in such a manner as to pivotally move the one movable member specified in the member specifying step in a direction away from the obstacle, move the moving section in the direction away from the obstacle, in the case where the one movable member is the first movable member, and move the moving section in a direction toward the obstacle, in the case where the one movable member is the second movable member.