Robot and control method thereof
Provided is a robot and a control method thereof in which the motion of an arm 12 as a specified limb among a plurality of limbs 12 and 14 extended from a body 10 is controlled according to a specified trajectory. If a first interaction state, in which a hand 126 , which is an end effector, interacts with a horizontal wood member L (j) of a ladder L in a first mode is implemented, then a control command is given to an actuator 41 that drives the hand 126 to cause the hand 126 to perform a grasping motion, thereby implementing a second interaction state, in which the hand 126 interacts with the horizontal wood member L (j) in a second manner. If the second interaction state is implemented, a control command is given to a brake 42 to maintain a motion halt state of the hand 126.
1. A robot comprising:
a body;
a plurality of limbs extended from the body;
an end effector attached to a distal end portion of a specified limb, which is at least one limb among the plurality of limbs;
an actuator that drives the end effector;
a brake connected to an output shaft of the actuator; and
a controller that controls a motion of each of the plurality of limbs, the actuator, and the brake,
wherein the controller includes:
a main control element which controls the motion of the specified limb according to a specified trajectory;
a first sub control element which issues a control command to the actuator so as to cause the end effector to carry out a specified motion for implementing a second interaction state, in which the end effector interacts with an outside world thereof in a second mode, which is different from a first mode, in a case where a first interaction state, in which the end effector interacts with the outside world thereof in the first mode, is implemented while the motion of the specified limb is being controlled according to the specified trajectory by the main control element; and
a second sub control element which issues a control command to the brake so as to maintain a motion halt state of the end effector in a case where the second interaction state is implemented after the control command is given to the actuator by the first sub control element, and
wherein the motion of the specified limb is controlled according to an inverse specified trajectory obtained by inverting the specified trajectory in a time series manner in a case where the first interaction state is not implemented while the main control element is controlling the motion of the specified limb according to the specified trajectory.
2. A robot comprising:
a body;
a plurality of limbs extended from the body;
an end effector attached to a distal end portion of a specified limb, which is at least one limb among the plurality of limbs;
an actuator that drives the end effector;
a brake connected to an output shaft of the actuator; and
a controller that controls a motion of each of the plurality of limbs, the actuator, and the brake,
wherein the controller includes:
a main control element which controls the motion of the specified limb according to a specified trajectory;
a first sub control element which issues a control command to the actuator so as to cause the end effector to carry out a specified motion for implementing a second interaction state, in which the end effector interacts with an outside world thereof in a second mode, which is different from a first mode, in a case where a first interaction state, in which the end effector interacts with the outside world thereof in the first mode, is implemented while the motion of the specified limb is being controlled according to the specified trajectory by the main control element; and
a second sub control element which issues a control command to the brake so as to maintain a motion halt state of the end effector in a case where the second interaction state is implemented after the control command is given to the actuator by the first sub control element,
wherein the first sub control element disables an output function of the actuator in a case where the motion halt state of the end effector is maintained after the control command is given to the brake by the second sub control element, and
wherein the first sub control element stops the motion of at least the specified limb in a case where the motion halt state of the end effector has not been continuously maintained for a first specified period of time or more after the control command is given to the brake by the second sub control element.
3. A robot comprising:
a body;
a plurality of limbs extended from the body;
an end effector attached to a distal end portion of a specified limb, which is at least one limb among the plurality of limbs;
an actuator that drives the end effector;
a brake connected to an output shaft of the actuator; and
a controller that controls a motion of each of the plurality of limbs, the actuator, and the brake,
wherein the controller includes:
a main control element which controls the motion of the specified limb according to a specified trajectory;
a first sub control element which issues a control command to the actuator so as to cause the end effector to carry out a specified motion for implementing a second interaction state, in which the end effector interacts with an outside world thereof in a second mode, which is different from a first mode, in a case where a first interaction state, in which the end effector interacts with the outside world thereof in the first mode, is implemented while the motion of the specified limb is being controlled according to the specified trajectory by the main control element; and
a second sub control element which issues a control command to the brake so as to maintain a motion halt state of the end effector in a case where the second interaction state is implemented after the control command is given to the actuator by the first sub control element, and
wherein the second sub control element stops the motion of at least the specified limb in a case where the second interaction state continuously fails to be implemented for a second specified period of time or more.
4. A control method of a robot that includes a body, a plurality of limbs extended from the body, an end effector attached to a distal end portion of a specified limb, which is at least one limb among the plurality of limbs, an actuator that drives the end effector between an opened state and a closed state, a brake connected to an output shaft of the actuator, and a controller that controls a motion of each of the plurality of limbs, the actuator, and the brake, the control method comprising:
a main control step of controlling the motion of the specified limb according to a specified trajectory;
a first sub control step of issuing a control command to the actuator so as to cause the end effector to carry out a specified motion for implementing a second interaction state, in which the end effector interacts with an outside world thereof in a second mode in which an object gripped by the end effector in the closed state applies external force on the end effector, which is different from a first mode, in a case where a first interaction state, in which the end effector interacts with the outside world thereof in the first mode in which external force is applied to the end effector from the object while the end effector is in the opened state, is implemented during the main control step; and
a second sub control step of giving a control command to the brake so as to maintain a motion halt state of the end effector in a case where the second interaction state is implemented after the control command is given to the actuator in the first sub control step,
wherein, in the main control step, in a case where the first interaction state is not implemented while controlling the motion of the specified limb according to the specified trajectory, the motion of the specified limb is controlled according to an inverse specified trajectory obtained by inverting the specified trajectory in a time series manner.