IP Library › Granted Patent US 11,478,934
Granted Patent B2
US 11,478,934 · App. 16/576,446 · Granted Oct 25, 2022

Method and apparatus for controlling robot

Inventors: Masanori Sato (Chita-gun, JP); Yuto Kawachi (Chita-gun, JP)
Assignee: DENSO WAVE INCORPORATED
B25J9/1674B25J9/1653B25J13/085B25J9/1664
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 11,478,934
App. No.
16/576,446
Granted
Oct 25, 2022
Kind
B2
Abstract

There is provided a method and an apparatus for controlling a robot arm. In this control scheme, a position error indicating a deviation between a command position, which is a control target position, and a current position, which is a position where the arm of the robot is currently located, is acquired. When the acquired position error exceeds a threshold, a new corrected command position between the current position and the command position is set. After the arm of the robot is moved to the corrected command position, a new corrected command position reset between the corrected command position serving as a new current position and the command position. Reconfiguration of a corrected command position is iterated until a current position of the robot arm becomes equal to the command position so that movement of the robot arm is achieved from the current position to the command position.

Claims (47)

1. A method of controlling a robot having an arm, comprising:

acquiring, in an operating space of the robot, at respective update cycles, a position error indicating a deviation between a command position that is a control target position of the arm of the robot and a current position where the aim of the robot is currently located;

determining, at the respective update cycles, whether the acquired position error exceeds a threshold set in advance;

when the acquired position error exceeds the threshold, setting, at the respective update cycles, a new corrected command position to which the arm of the robot should be moved, between the current position and the command position in the operating space, the threshold being set based on a maximum possible speed provided to the aim of the robot;

controlling, at the respective update cycles, the position of the robot based on the new corrected command position;

after the arm of the robot is moved to the corrected command position, resetting, at the respective update cycles, a new corrected command position between the corrected command position and the command position in the operating space; and

iterating, at the respective update cycles, the acquiring, determining, setting, controlling and resetting steps until the current position becomes equal to the command position to achieve movement from the current position to the command position.

2. The method of controlling a robot according to claim 1 , comprising:

calculating, at the respective update cycles, a maximum value of a moving speed as the maximum speed, the maximum value being assumed to ensure safety from the aim of the robot, and setting at the update cycles, the threshold by multiplying the maximum speed by the update cycle of the command position; and

setting, at the respective update cycles, the corrected command position at a position apart from the current position by a distance corresponding to the threshold.

3. The method of controlling a robot according to claim 1 , wherein the arm of the robot is moved at a constant speed.

4. The method of controlling a robot according to claim 1 , wherein the arm of the robot is moved with a speed being varied.

5. The method of controlling a robot according to claim 1 , wherein the arm of the robot is moved by being provided with a position or a zone where a moving speed is reduced to zero.

6. The method of controlling a robot according to claim 2 , wherein the arm of the robot is moved at a constant speed.

7. The method of controlling a robot according to claim 2 , wherein the arm of the robot is moved with a speed being varied.

8. A method of controlling a robot having an arm, comprising:

acquiring, in an operating space of the robot, a position error indicating a deviation between a command position that is a control target position and a current position that is a position where the arm of the robot is currently located;

when the acquired position error exceeds a threshold set in advance, producing a new speed pattern providing a constant upper limit of a speed command for moving the arm of the robot from the current position to the command position. the threshold being set based on a maximum possible speed provided to the arm of the robot, the upper limit being set smaller than a maximum allowable speed provided to the arm of the robot; and

moving the arm of the robot from the current position to the command position based on the produced new speed pattern.

9. The method of controlling a robot according to claim 8 , wherein the new speed pattern is a new trapezoidal speed pattern with the constant upper limit which allows the arm of the robot to move at a constant speed.

10. A method of controlling a robot having an arm, comprising:

acquiring, in an operating space of the robot, a position error indicating a deviation between a command position that is a control target position and a current position that is a position where the arm of the robot is currently located;

when the acquired position error exceeds a threshold set in advance and the robot is being subject to direct teaching in which a constraint plane is set to constrain a movement direction of the arm of the robot, resetting a new command position that is a projection of the current position onto the constraint plane; and

moving the arm of the robot from the current position to the new command position.

11. The method of controlling a robot according to claim 10 , wherein the arm of the robot is moved at a constant speed.

12. The method of controlling a robot according to claim 10 , wherein the arm of the robot is moved with a speed being varied.

13. An apparatus for controlling a robot having an arm, comprising:

a sensor sensing an external force applied to the arm of the robot; and

a controller configured to:

acquire, in an operating space of the robot, at respective update cycles, a position error indicating a deviation between a command position that is a control target position of the arm of the robot and a current position that is a position where the arm of the robot is currently located, based on the external force;

determine, at the respective update cycles, whether the acquired position error exceeds a threshold set in advance;

when the acquired position error exceeds the threshold, set, at the respective update cycles, a new corrected command position to which the arm of the robot should be moved, between the current position and the command position in the operating space, the threshold being set based on a maximum possible speed provided to the aim of the robot;

control, at the respective update cycles, the position of the robot based on the new corrected command position;

after the arm of the robot is moved to the corrected command position, reset, at the respective update cycles, a new corrected command position, between the corrected command position and the command position in the operating space; and

iterate, at the respective control cycles, the acquiring, determining, setting, controlling and resetting processes until the current position becomes equal to the command position to achieve movement from the current position to the command position.

14. An apparatus for controlling a robot having an arm, comprising:

a sensor sensing an external force applied to the arm of the robot; and

a controller configured to:

acquire, in an operating space of the robot, a position error indicating a deviation between a command position that is a control target position and a current position that is a position where the arm of the robot is currently located, based on the external force;

when the acquired position error exceeds a threshold set in advance, produce a new speed pattern providing a constant upper limit of a speed command for moving the arm of the arm of the robot from the current position to the command position, the threshold being set based on a maximum possible speed provided to the arm of the robot, the upper limit being set smaller than a maximum allowable speed provided to the arm of the robot; and

move the arm of the robot from the current position to the command position based on the produced new speed pattern.

15. An apparatus for controlling a robot having an arm. comprising:

a sensor sensing an external force applied to the arm of the robot; and

a controller configured to:

acquire, in an operating space of the robot, a position error indicating a deviation between a command position that is a control target position and a current position that is a position where the arm of the robot is currently located, based on the external force;

when the acquired position error exceeds a threshold set in advance and the robot is being subject to direct teaching in which a constraint plane is set to constrain a movement direction of the arm of the robot, reset a new command position that is a projection of the current position onto the constraint plane; and

move the arm of the robot from the current position to the new command position.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Oct 8, 2019
From: SATO, MASANORI; KAWACHI, YUTO
To: DENSO WAVE INCORPORATED
Reel/Frame 050655/0001 →
Priority Claims (1)
JP JP2018-174916 · Sep 19, 2018 · national
Continuity (1)
Related Publication 20200086488A1 · Mar 19, 2020
Cited By (1)
US 12,661,784