Robot and control method thereof
First Claim
1. A robot provided with a plurality of legs each having a plurality of joint parts and an upper body connected to the plurality of legs while having a plurality degrees of freedom, the robot comprising:
- a sensor unit to measure state information of the robot;
a kinematics calculation unit to acquire a current pose of the robot using the measured state information of the robot;
a target setting unit to set a target pose with respect to at least one of the plurality of degrees of freedom of the robot based on a finite state machine (FSM) of the robot set in advance;
a compensation force calculation unit to calculate a pose error by comparing the acquired current pose with the set target pose, and calculate a compensation force with respect to the at least one degree of freedom based on the pose error;
a virtual gravity setting unit to set sizes of virtual gravities required by the plurality of joint parts of the robot, according to the calculated compensation force, and to set sizes of virtual gravities required by the plurality of joint parts of the robot according to a current state of the FSM of the robot;
a gravity compensation torque calculation unit to calculate gravity compensation torques required to compensate for the virtual gravities set by the virtual gravity setting unit; and
a servo control unit to output the calculated gravity compensation torques to the plurality of joint parts.
1 Assignment
0 Petitions
Accused Products
Abstract
A bipedal robot having a pair of legs with 6 degrees of freedom and a control method thereof which calculate a capture point by combining the position and velocity of the center of gravity (COG) and control the capture point during walking to stably control walking of the robot. A Finite State Machine (FSM) is configured to execute a motion similar to walking of a human, and thus the robot naturally walks without constraint that the knees be bent all the time, thereby being capable of walking with a large stride and effectively using energy required while walking.
45 Citations
38 Claims
-
1. A robot provided with a plurality of legs each having a plurality of joint parts and an upper body connected to the plurality of legs while having a plurality degrees of freedom, the robot comprising:
-
a sensor unit to measure state information of the robot; a kinematics calculation unit to acquire a current pose of the robot using the measured state information of the robot; a target setting unit to set a target pose with respect to at least one of the plurality of degrees of freedom of the robot based on a finite state machine (FSM) of the robot set in advance; a compensation force calculation unit to calculate a pose error by comparing the acquired current pose with the set target pose, and calculate a compensation force with respect to the at least one degree of freedom based on the pose error; a virtual gravity setting unit to set sizes of virtual gravities required by the plurality of joint parts of the robot, according to the calculated compensation force, and to set sizes of virtual gravities required by the plurality of joint parts of the robot according to a current state of the FSM of the robot; a gravity compensation torque calculation unit to calculate gravity compensation torques required to compensate for the virtual gravities set by the virtual gravity setting unit; and a servo control unit to output the calculated gravity compensation torques to the plurality of joint parts. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26)
-
-
27. A method of controlling a robot provided with a plurality of legs each having a plurality of joint parts and an upper body connected to the legs while having a plurality of translation degrees of freedom and a rotation degree of freedom, the control method comprising:
-
detecting a pose angle of the upper body and angles of the plurality of joint parts; acquiring a current pose of the robot with respect to at least one of the plurality of translation degrees of freedom based on the detected angles of the plurality of joint parts; calculating a pose error by comparing the acquired current pose with a target pose set in advance; calculating a compensation force with respect to the at least one translation degree of freedom based on the pose error; setting virtual gravities based on the calculated compensation force and a current state of a Finite State Machine (FSM) that is set with respect to the robot in advance; calculating gravity compensation torques required by the plurality of joint parts of the robot to compensate for the set virtual gravities; and controlling torque servos of the respective joint parts so that torque values of the respective joints of the robot reach target torques that include the calculated gravity compensation torques. - View Dependent Claims (28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38)
-
Specification