Robot controller and robot system for moving robot in response to force

• US 9,566,707 B2
• Filed: 04/13/2015
• Issued: 02/14/2017
• Est. Priority Date: 04/14/2014
• Status: Active Grant

• Current Assignee: Fanuc Corporation
• Original Assignee: Fanuc Corporation
• Inventors: Iwatake, Takahiro
• Primary Examiner(s): Nguyen, Bao Long T
• Application Number:
  US14/684,930
• Publication Number:
  US 20150290796A1
• Time in Patent Office: 673 Days
• Field of Search: 700/258, 700/250, 700/253, 700/257, 901/2, 901/3, 901/4, 901/46, 318/568.13, 318/568.14, 318/568.16, 318/568.17, 318/568.18
• US Class Current: 1/1
• CPC Class Codes: B25J 13/085 Force or torque sensors B25J13/082, B25J13/084 take precedence
• CPC Class Codes: B25J 9/0081 with master teach-in means

Abstract

A robot controller for easily moving a desired axis of a robot by applying a force to a front end of the robot, and a robot system including the robot controller. The robot controller has: a force measuring part which measures a force applied to the front end; an operation force calculating part which calculates an operation force for moving each axis based on the measured force; an operation commanding part which outputs a command for moving the robot; and an operation axis specifying part which specifies an operation axis to be moved in response to the force, and determines a direction of movement of the operation axis as a function of a direction of the force. When two or more operation axes are specified, the operation axis specifying part determines as to whether or not each operation axis can be moved, depending on a status of the movement operation.

Claims

1. A robot controller for moving a robot having a plurality of axes, the robot controller comprising:

a force measuring part configured to measure a force applied to a front end of the robot;

an operation force calculating part configured to, based on the force measured by the force measuring part, calculate an operation force for performing movement operation regarding a position of each axis among the plurality of axes of the robot;

an operation commanding part configured to output a command for moving the robot; and

an operation axis specifying part configured to perform

specifying, among the plurality of axes, at least one operation axis to be moved in response to the force, and

determining a direction of movement of the at least one operation axis as a function of a direction of the force,

wherein, when one operation axis is specified by said specifying, the operation axis specifying part is configured to perform judging that the one operation axis is allowed to move in response to the force,

wherein, when two or more operation axes are specified by said specifying, the operation axis specifying part is configured to perform judging whether each operation axis among the two or more operation axes is allowed to move in response to the force or whether said each operation axis is not allowed to move even when the force is applied thereto,

said judging (1) being based on the direction of the force relative to said each operation axis, and (2) depending on a status of the movement operation, and

wherein the operation commanding part is configured to, based on (i) said specifying, said determining and said judging by the operation axis specifying part and (ii) the operation force calculated by the operation force calculating part, output an operation command for moving a position of

(a) the one operation axis, when the one operation axis is specified by said specifying, or

(b) each operation axis among the two or more operation axes that is judged as allowed to move, when the two or more operation axes are specified by said specifying.

2. A robot system comprising the robot and the robot controller as set forth in claim 1.

3. The robot system as set forth in claim 2, further comprising a teaching operation device configured to input settings to the robot controller,

wherein the operation axis specifying part is configured to specify the at least one operation axis based on input from the teaching operation device, and

wherein the teaching operation device is configured to select an option among a plurality of options and input the selected option, the plurality of options including combinations of one or more axes to be specified as the at least one operation axis.

4. The robot system as set forth in claim 3, wherein, based on current positions of the plurality of axes of the robot, when a minimum distance between the front end of the robot and a rotation centerline of a rotation axis among the plurality of axes is equal to or smaller than a predetermined threshold,

the teaching operation device is configured to display

that the front end of the robot exists near the rotation centerline of the rotation axis, or

that the rotation axis is not specifiable as an operation axis.

5. The robot system as set forth in claim 2, further comprising a teaching operation device configured to input settings to the robot controller,

wherein the operation axis specifying part is configured to perform said specifying based on input from the teaching operation device, and

wherein the teaching operation device is configured to, among the plurality of axes,

display an axis selectable as an operation axis, and

displays a further axis other than the selectable axis while representing one of:

that the further axis is simultaneously selectable as another operation axis, and

that the further axis is not simultaneously selectable as another operation axis.

6. A robot system comprising the robot and the robot controller as set forth in claim 1, wherein

the robot system further comprises a display device, and

the display device is configured to display a specified condition by which the operation axis specifying part is configured to perform said judging.

7. A robot controller for moving a robot having a plurality of axes, the robot controller comprising:

a force measuring part configured to measure a force applied to a front end of the robot;

an operation force calculating part configured to, based on the force measured by the force measuring part, calculate an operation force for performing movement operation regarding a position of each axis among the plurality of axes of the robot;

an operation commanding part configured to output a command for moving the robot; and

an operation axis specifying part configured to perform

specifying, among the plurality of axes, at least one operation axis to be moved in response to the force, and

determining a direction of movement of the at least one operation axis as a function of a direction of the force,

wherein, when one operation axis is specified by said specifying, the operation axis specifying part is configured to perform judging that the one operation axis is allowed to move in response to the force,

wherein, when two or more operation axes are specified by said specifying, the operation axis specifying part is configured to perform judging whether each operation axis among the two or more operation axes is allowed to move in response to the force or whether said each operation axis is not allowed to move even when the force is applied thereto,

said judging (1) being based on a positional relationship between said each operation axis and the front end of the robot, and (2) depending on a status of the movement operation, and

wherein the operation commanding part is configured to, based on (i) said specifying, said determining and said judging by the operation axis specifying part and (ii) the operation force calculated by the operation force calculating part, output an operation command for moving a position of

(a) the one operation axis, when the one operation axis is specified by said specifying, or

(b) each operation axis among the two or more operation axes that is judged as allowed to move, when the two or more operation axes are specified by said specifying.

8. A robot controller for moving a robot having a plurality of axes, the robot controller comprising:

a force measuring part configured to measure a force applied to a front end of the robot;

an operation force calculating part configured to, based on the force measured by the force measuring part, calculate an operation force for performing movement operation regarding a position of each axis among the plurality of axes of the robot;

an operation commanding part configured to output a command for moving the robot; and

an operation axis specifying part configured to perform

specifying, among the plurality of axes, at least one operation axis to be moved in response to the force, and

determining a direction of movement of the at least one operation axis as a function of a direction of the force,

wherein, when one operation axis is specified by said specifying, the operation axis specifying part is configured to perform judging that the one operation axis is allowed to move in response to the force,

wherein, when two or more operation axes are specified by said specifying, the operation axis specifying part is configured to perform judging whether each operation axis among the two or more operation axes is allowed to move in response to the force or whether said each operation axis is not allowed to move even when the force is applied thereto,

said judging being based on at least one of (a) the direction of the force relative to said each operation axis, (b) a positional relationship between said each operation axis and the front end of the robot, and (c) a predetermined priority order, and

said judging depending on a status of the movement operation, and

wherein the operation commanding part is configured to, based on (i) said specifying, said determining and said judging by the operation axis specifying part and (ii) the operation force calculated by the operation force calculating part, output an operation command for moving a position of

(a) the one operation axis, when the one operation axis is specified by said specifying, or

(b) each operation axis among the two or more operation axes that is judged as allowed to move, when the two or more operation axes are specified by said specifying.

9. A robot controller for moving a robot having a plurality of axes including two or more rotation axes, the robot controller comprising:

a force measuring part configured to measure a force applied to a front end of the robot;

an operation force calculating part configured to, based on the force measured by the force measuring part, calculate an operation force for performing movement operation regarding a position of each axis among the plurality of axes of the robot;

an operation commanding part configured to output a command for moving the robot; and

an operation axis specifying part configured to perform

specifying, among the plurality of axes, two rotation axes, which have rotation centerlines intersecting at right angles regardless of positions of the plurality of axes, as operation axes to be moved in response to the force, and

determining a direction of movement of the operation axes as a function of a direction of the force,

wherein the operation commanding part is configured to output an operation command for moving a position of each of the operation axes, based on (i) said specifying and said determining by the operation axis specifying part and (ii) the operation force calculated by the operation force calculating part.

10. A robot controller for moving a robot having a plurality of axes including two or more rotation axes, the robot controller comprising:

a force measuring part configured to measure a force applied to a front end of the robot;

an operation force calculating part configured to, based on the force measured by the force measuring part, calculate an operation force for performing movement operation regarding a position of each axis among the plurality of axes of the robot;

an operation commanding part configured to output a command for moving the robot; and

an operation axis specifying part configured to perform

specifying, among the plurality of axes, two rotation axes, which have rotation centerlines intersecting at right angles regardless of positions of the plurality of axes, as operation axes to be moved in response to the force,

determining a direction of movement of the operation axes as a function of a direction of the force, and

judging whether each operation axis among the operation axes is allowed to move in response to the force or whether said each operation axis is not allowed to move even when the force is applied thereto,

said judging being based on at least one of (a) the direction of the force relative to said each operation axis, (b) a positional relationship between said each operation axis and the front end of the robot, and (c) a predetermined priority order, and

said judging depending on a status of the movement operation, and

wherein the operation commanding part is configured to output an operation command for moving a position of each of the operation axes, based on (i) said specifying, said determining and said judging by the operation axis specifying part and (ii) the operation force calculated by the operation force calculating part.