Device and method for controlling manipulator

• US 20090295324A1
• Filed: 03/11/2009
• Published: 12/03/2009
• Est. Priority Date: 05/30/2008
• Status: Abandoned Application

• Current Assignee: Samsung Electronics Co. Ltd.
• Original Assignee: Samsung Electronics Co. Ltd.
• Inventors: Oh, Yeon Taek, Yoon, Sukjune, Shim, Young Bo
• Application Number:
  US12/382,245
• Publication Number:
  US 20090295324A1
• Time in Patent Office: Days
• US Class Current: 318/632
• CPC Class Codes: B25J 9/1676 Avoiding collision or forbidden zones
• CPC Class Codes: G05B 2219/39237 Torque disturbance control
• CPC Class Codes: G05B 2219/40201 Detect contact, collision with human

Abstract

Disclosed herein are a device and method of controlling a manipulator. The device includes a device to control a manipulator, including a sensing unit to sense a joint position and joint torque of the manipulator a disturbance estimator to estimate disturbance torque using a state space equation with respect to the manipulator having the sensed joint position and joint torque as input; and a controller to control the manipulator based on the estimated disturbance torque.

Claims

1. A device to control a manipulator, comprising:

a sensing unit to sense a joint position and joint torque of the manipulator;

a disturbance estimator to estimate disturbance torque using a state space equation with respect to the manipulator having the sensed joint position and joint torque as input; and

a controller to control the manipulator based on the estimated disturbance torque.

2. The device of claim 1, wherein the disturbance estimator estimates the disturbance torque based on a joint torque value, a gravity compensation value, a Corioli'"'"'s force compensation value, and an inertia compensation value of the manipulator.

3. The device of claim 1, wherein the state space equation includes the following equations.

{circumflex over (d)}=+p

=−

L+L(τ

−

C{dot over (q)}−

g−

p)

{dot over (p)}=−

LM{dot over (q)}+L∫

(C+C^T){dot over (q)}dt

wherein d is an estimated value of the disturbance torque, Z is a state variable, p is a state variable, L is a positive definite matrix, ζ

is a driving torque, C is a Corioli'"'"'s and centrifugal matrix, q is a joint velocity, g is a gravity vector and M is an inertia.

4. The device of claim 1, wherein the sensing unit includes a position sensor to sense the joint position of the manipulator and a torque sensor to sense the joint torque of the manipulator.

5. The device of claim 1, further comprising a motor and a joint, wherein the sensing unit includes a position sensor to sense the joint position of the manipulator and a current sensor to sense current of the motor that drives the joint of the manipulator, the joint torque being estimated from the sensed current of the motor.

6. The device of claim 1, wherein the manipulator has variable stiffness, and, when the disturbance torque estimated by the disturbance estimator exceeds a predetermined value, the controller changes a stiffness of the manipulator.

7. A method of controlling a manipulator, comprising:

sensing a joint position and a joint torque of the manipulator; and

estimating disturbance torque using a state space equation with respect to the manipulator based on the sensed joint position and joint torque.

8. The method of claim 7, wherein the estimating the disturbance torque includes estimating the disturbance torque using the following state space equations.

{circumflex over (d)}=+p

=−

L+L(τ

−

C{dot over (q)}−

g−

p)

{dot over (p)}=−

LM{dot over (q)}+L∫

(C+C^T){dot over (q)}dt

wherein d is an estimated value of the disturbance torque, Z is a state variable, p is ______, L is a positive definite matrix, ζ

is a driving torque, C is a Corioli'"'"'s and centrifugal matrix, q is a joint velocity, g is a gravity vector and M is an inertia,

9. The method of claim 7, further comprising:

changing a stiffness of the manipulator based on the estimated disturbance torque.

10. The method of claim 9, wherein the changing the stiffness includes comparing the estimated disturbance torque with a predetermined value, determining that the manipulator has collided with an object when the estimated disturbance torque exceeds the predetermined value, and changing the stiffness of the manipulator based on the result of the determination.