Controller for limiting speed of robot component
A controller includes a stop command unit for stopping the motion of the robot when a person comes into contact with the robot, and a speed limiting unit for limiting the operation speed of the component driven on the drive axis. A variable calculated from the position of the component on the drive axis and the range of the variable in a state where the person is caught by the robot are determined in advance. The speed limiting unit acquires the variable from the output of a position detector and controls the operation speed of the component to a predetermined speed limit or lower if the variable is within the range.
1. A controller for controlling a robot including drive axis for driving a component of the robot and a position detector for detecting a position on the drive axis, the controller comprising:
a stop command unit for stopping a motion of the robot when a person comes into contact with the robot; and
a speed limiting unit for limiting an operation speed of the component driven on the drive axis, wherein
the controller is configured to switch between
a collaboration control in which the robot performs an operation in collaboration with the person and
a quick control in which the robot performs the operation alone without performing the operation in collaboration with the person,
a variable calculated from the position of the component on the drive axis and a range of the variable for a state where the person is caught by the robot or an operation tool attached to the robot are determined in advance,
in the collaboration control, the speed limiting unit acquires the position of the component on the drive axis from the output of the position detector, acquires the variable based on the position of the component on the drive axis, and controls the operation speed of the component to a predetermined speed limit or lower if the variable is within the range, and
in the quick control, the controller prohibits a control in which the speed limiting unit controls the operation speed of the component to the predetermined speed limit or lower if the variable is within the range.
2. The controller according to claim 1 , wherein
the drive axis is a rotary axis for rotating the component,
the variable is a joint angle between a predetermined reference direction and a direction of the component, and
the speed limiting unit controls the operation speed of the component driven on the rotary axis to a predetermined speed limit or lower if the joint angle at the rotary axis is within the range.
3. The controller according to claim 1 , wherein
the drive axis is a rotary axis for rotating the component,
the variable is an angle between the two components connected to the single rotary axis, and
the speed limiting unit calculates the angle between the two components connected to the rotary axis and controls the operation speed of the component driven on the rotary axis to a predetermined speed limit or lower if the angle is within the range.
4. The controller according to claim 3 , wherein
the components are two arms connected to the single rotary axis,
the variable is an angle between the two arms connected to the single rotary axis, and
the speed limiting unit acquires joint angles between a predetermined reference direction and an direction in which the arm extends based on a position of the component on the drive axis, and calculates an angle between the two arms connected to the rotary axis by adding or subtracting the joint angles of the two arms.
5. The controller according to claim 1 , wherein
the range is a range in which the person is caught by the robot and an object disposed around the robot.