Robot system, control device, and control method

A control device that controls a SCARA (selective compliance assembly robot arm) robot including a robot arm to which an end effector is attached and a motor configured to drive the robot arm,

• the control device comprising:
• a memory configured to store a program;
• and
• a processor configured to execute the program so as to:
• control the motor based on a control signal in a first case in which at least one condition of conditions A to E described below is satisfied;
• and
• control the motor based on a corrected control signal in a second case in which all of the conditions A to E are not satisfied, wherein in the second case, the processor is further configured to:
• determine a frequency component to be removed from the control signal using a band stop filter;
• and
• remove the frequency component from the control signal using the band stop filter to generate the corrected control signal,
• the condition A:
• the control device has a first driving mode and a second driving mode in which an upper limit value of acceleration of the robot arm is smaller than that in the first driving mode and drives the robot arm in the second driving mode;
• the condition B:
• a separation distance between a center of gravity of the end effector and a distal end of the robot arm is equal to or larger than a predetermined value;
• the condition C:
• an end point of an operation of the robot arm is unknown;
• the condition D:
• when the robot arm includes an arm and a shaft that rises and falls in a vertical direction with respect to the arm, a projection amount of the shaft in the vertical direction from the arm is equal to or smaller than a predetermined value;
• and
• the condition E:
• a total of weight of the end effector and weight of a workpiece held by the end effector is equal to or smaller than a predetermined value.

A control method for controlling, based on a control signal, a SCARA (selective compliance assembly robot arm) robot including a robot arm to which an end effector is attached and a motor configured to drive the robot arm,

• the control method for causing a processor to execute a program stored in a memory, the control method comprising executing on the processor the steps of:
• a frequency-component determining step for determining a frequency component to be removed from the control signal using a band stop filter;
• a corrected-control-signal generating step for removing the frequency component from the control signal using the band stop filter to generate a corrected control signal;
• and
• a control step for, in a first case in which at least one condition of conditions A to E described below is satisfied, controlling the motor according to the control signal, and, in a second case in which all of the conditions A to E are not satisfied, controlling the motor according to the generated corrected control signal:
• the condition A:
• the control method has a first driving mode and a second driving mode in which an upper limit value of acceleration of the robot arm is smaller than that in the first driving mode and drives the robot arm in the second driving mode;
• the condition B:
• a separation distance between a center of gravity of the end effector and a distal end of the robot arm is equal to or larger than a predetermined value;
• the condition C:
• an end point of an operation of the robot arm is unknown;
• the condition D:
• when the robot arm includes an arm and a shaft that rises and falls in a vertical direction with respect to the arm, a projection amount of the shaft in the vertical direction from the arm is equal to or smaller than a predetermined value;
• and
• the condition E:
• a total of weight of the end effector and weight of a workpiece held by the end effector is equal to or smaller than a predetermined value.

A control method for controlling a SCARA (selective compliance assembly robot arm) robot including a robot arm to which an end effector is attached and a motor configured to drive the robot arm,

• the control method for causing a processor to execute a program stored in a memory, the control method comprising executing on the processor the steps of:
• controlling the motor based on a control signal in a first case in which at least one condition of conditions A to E described below is satisfied;
• and
• controlling the motor based on a corrected control signal in a second case in which all of the conditions A to E are not satisfied, wherein in the second case, the processor is further configured to:
• determine a frequency component to be removed from the control signal using a band stop filter;
• and
• remove the frequency component from the control signal using the band stop filter to generate the corrected control signal,
• the condition A:
• the control method has a first driving mode and a second driving mode in which an upper limit value of acceleration of the robot arm is smaller than that in the first driving mode and drives the robot arm in the second driving mode;
• the condition B:
• a separation distance between a center of gravity of the end effector and a distal end of the robot arm is equal to or larger than a predetermined value;
• the condition C:
• an end point of an operation of the robot arm is unknown;
• the condition D:
• when the robot arm includes an arm and a shaft that rises and falls in a vertical direction with respect to the arm, a projection amount of the shaft in the vertical direction from the arm is equal to or smaller than a predetermined value;
• and
• the condition E:
• a total of weight of the end effector and weight of a workpiece held by the end effector is equal to or smaller than a predetermined value.