Articulated robot system, and driving method and control apparatus for articulate arm thereof
In a robot system provided with an articulated arm, information showing whether or not an operator holds one or more of a plurality of arms of the articulated arm. An operator's holding state of the arms are determined based on the detected information. Based on results of the determination, the rotation of motors provided at axes (joints) is controlled for selectively controlling a constrained state which constrains the rotation of the axes and release of the constrained state.
1. An articulated robot system comprising:
a base;
a plurality of arms mutually connected to provide a manipulator on the base;
a plurality of axes each rotatably connecting mutually adjacent two arms of the arms to each other;
a plurality of electric motors mounted in the arms and that drive the respective axes for enabling rotatable connection between the mutually adjacent two arms of the arms;
a plurality of detection units, each of the arms being provided with a corresponding one of the detection units, and each of the detection units being configured to detect a signal showing a user's manual hold of the arm on which the corresponding detection unit is provided; and
a control unit configured to control drive of the motors based on information detected by the detection units for control of motions of the arms, the motions including constraint of at least part of the arms by braking at least one of the motors, wherein,
when the signal shows that the detection units have not detected any user's manual hold, the control unit is configured to control the drive of the motors to constrain the axes, and
when the signal shows that the user's manual hold has been detected by one or more of the detection units, the control unit is configured to control a corresponding one or more of the motors to release constraints of one or more of the axes corresponding to the one or more of the detection units that have detected the user's manual hold, until the detection units stop detecting the signal showing that the user's manual hold has been detected; and
wherein when the one or more of the detection units that detect the user's manual hold are a single detection unit, the control unit is configured to control the motors to release constraints of designated axes of the axes, the designated axes being all of the axes that are positioned between the base and the arm whose detection unit has detected the user's manual hold.
2. The articulated robot system according to claim 1 , wherein, in a state in which constraints of the axes have been released, the control unit is configured to perform gravity compensation by controlling the motors such that the arms do not move due to own weight of the arms.
3. The articulated robot system according to claim 1 , wherein, the control unit is configured to determine movement of the arms in a state in which constraints of the axes have been released, and store motions or positions of the arms when it is determined that the arms are moved in the state.
4. An articulated robot system comprising:
a base;
a plurality of arms mutually connected to provide a manipulator on the base;
a plurality of axes each rotatably connecting mutually adjacent two arms of the arms to each other;
a plurality of electric motors mounted in the arms and that drive the respective axes for enabling rotatable connection between the mutually adjacent two arms of the arms;
a plurality of detection units, each of the arms being provided with a corresponding one of the detection units, and each of the detection units being configured to detect a signal showing a user's manual hold of the arm on which the corresponding detection unit is provided; and
a control unit configured to control drive of the motors based on information detected by the detection units for control of motions of the arms, the motions including constraint of at least part of the arms by braking at least one of the motors, wherein,
when the signal shows that the detection units have not detected any user's manual hold, the control unit is configured to control the drive of the motors to constrain the axes, and
when the signal shows that the user's manual hold has been detected by one or more of the detection units, the control unit is configured to control a corresponding one or more of the motors to release constraints of one or more of the axes corresponding to the one or more of the detection units that have detected the user's manual hold, until the detection units stop detecting the signal showing that the user's manual hold has been detected; and
wherein when the one or more of the detection units that detect the user's manual hold are two detection units with another detection unit provided therebetween, the control unit is configured to control the drive of the motors to release constraints of designated axes of the axes, the designated axes being all of the axes that are positioned between the two arms whose detection units have detected the user's manual hold.
5. The articulated robot system according to claim 4 , wherein, in a state in which constraints of the axes have been released, the control unit is configured to perform gravity compensation by controlling the motors such that the arms do not move due to own weight of the arms.
6. An articulated robot system, comprising
a base;
a plurality of arms formed on the base, the arms being articulated arms provided with a plurality of axes located between mutually adjacent two of the arms, the arms being linked relatively rotatably via the axes;
a plurality of electric motors each arranged to a corresponding one of the plurality of axes and configured to drive rotation of each of the plurality of arms;
a plurality of detection units, each of the plurality of arms being provided with a corresponding one of the detection units, and each of the detection units being configured to detect a signal showing whether or not an operator manually holds the arm on which the corresponding detection unit is provided; and
a control unit configured to:
determine an operator's holding state of the arms based on the signal detected by the detection units;
control rotation of the motors for selecting a constrained state which constrains one or more of the axes by braking a corresponding one or more of the motors and a released state in which the one or more of the axes are released from being constrained, based on determined results of the hold determining unit, during the released state the operator is allowed to move the arms with the released axes for direct teaching;
determine that the operator's holding state of the arms is stopped; and
control the released axes to be constrained again.
7. The articulated robot system according to claim 6 , wherein the control unit is configured to control, as initial control, drive of all the plurality of motors for constraining the rotation of all the plurality of axes, before controlling the constrained state and the released state.
8. The articulated robot system according to claim 7 , wherein the control unit is configured to:
determine whether or not the operator manually holds the one or more of the arms, based on the signal detected by the detection units, and
control the drive of the motors for retaining the constrained state of the rotation of the plurality of axes, when the control unit performs the initial control and determines that the arms are not held.
9. The articulated robot system according to claim 7 , wherein the control unit is configured to:
determine whether or not the operator manually holds a single one of the plurality of arms, based on the signal detected by the detection units, and
control, among the plurality of motors, drive of all of the motors positioned between the base and the single one of the plurality of arms, such that, of the plurality of axes, all of the axes which are positioned between the base and the single one of the plurality of arms are released from being constrained in the rotation thereof, after the control unit performs the initial control and determines that the single one of the plurality of arms is manually held.
10. The articulated robot system according to claim 9 , wherein the control unit is configured to determine whether or not the operator manually holds, as the single one of the plurality of arms, an arm positioned at a tip end of the plurality of arms on an end effector side thereof.
11. The articulated robot system according to claim 9 , wherein the control unit is configured to:
determine whether or not the operator's manual hold of the single one of the plurality of arms determined by the control unit has ended after the control performed by the control unit, and
control all the plurality of motors such that all the axes are constrained again in the rotation thereof, when the control unit determines the end of the operator's manual hold.
12. The articulated robot system according to claim 7 , wherein the control unit is configured to:
determine whether or not the operator manually holds two of the plurality of arms with at least one other arm located therebetween not being manually held, based on the signal detected by the detection units, and
control, among the plurality of motors, drive of all of the motors positioned at corresponding other axes of the axes positioned between the two manually held arms, such that the corresponding other axes are released from being constrained in the rotation thereof, after the control unit performs the initial control and determines that the two of the plurality of arms are held.
13. The articulated robot system according to claim 12 , wherein
the control unit is configured to determine whether or not the operator manually holds the two arms between which there is one arm adjacently to the two arms manually held by the operator, among the plurality of arms.
14. The articulated robot system according to claim 12 , wherein the control unit is configured to determine whether or not the operator manually holds the two arms between which there are two or more arms adjacently to the two arms manually held by the operator, among the plurality of arms.