Computed-torque based controller, parameter determination method thereof and performance analysis method thereof
AssigneeKorea Institute of Science and Technology
InventorsJung Hoon Kim, Jaeyoung Park
Life of this patent
Estimating the term…
Abstract
Provided is a controller of a robot manipulator, a performance analysis method thereof and a parameter determination method thereof. The controller computes an error value of an output value of a control target for a target value through a computational equation and provides a control input value of the control target, and includes an outer loop controller which constitutes closed loop control of the control target, and an inner loop controller which performs feedback linearization to remove nonlinearity of the control target, wherein the computational equation is a linear differential equation designed considering exogenous disturbance acting in the controller and a computational error.
Claims5
A controller that computes an error value of an output value of a control target for a target value through a computational equation and provides a control input value of the control target, the controller comprising:
- an outer loop controller which constitutes closed loop control of the control target, and an inner loop controller which performs feedback linearization to remove nonlinearity of the control target,
- wherein a dynamics equation of the control target is represented by the following Equation 1 including an exogenous disturbance torque vector, and
- the inner loop controller and the control target form an inner loop system, and a dynamics equation for a trajectory tracking error of the inner loop system is represented by the following Equation 4:
- M(q){umlaut over (q)}+C(q,{dot over (q)}){dot over (q)}+G(q)+τd=τ [Equation 1]
- where q(t)ϵn is the output value and corresponds to a joint angle vector, M(q)ϵn×n corresponds to a positive definite matrix corresponding to Inertia, C(q,{dot over (q)}){dot over (q)}ϵn corresponds to a Coriolis and centrifugal torque vector, G(q)ϵn corresponds to a gravitational torque vector, τd(t)ϵn corresponds to the exogenous disturbance torque vector, τ(t)ϵn corresponds to a control input torque vector,
- ë=w+u[Equation 4]
- where w:=−M−1(q){tilde over (M)}(q)({umlaut over (q)}d−u)−M−1(q)({tilde over (C)}(q,{dot over (q)}){dot over (q)}+{tilde over (G)}(q)−τd) is a total exogenous disturbance acting in the inner loop system, and is defined as including both the exogenous disturbance torque vector and a computational error, and u is a control output value that is provided to the inner loop system by the outer loop controller, and
- wherein the controller controls a robot manipulator based on operations of the outer loop controller and the inner loop system,
- wherein the inner loop system is represented by a generalized linear model of a continuous-time linear time-invariant system as shown in the following Equation 7,
- the outer loop controller performs proportional derivative (PD) control as shown in the following Equation 8, and
- a closed loop system implemented by the controller is represented by the following Equation 9:
- P
-
- :
-
- {
-
- x
- .
- =
- Ax
- +
- Bw
- +
- Bu
-
- z
- =
- Cx
-
- y
- =
- x
- [
- Equation
-
-
- 7
- ]
- where
- A
- ≈
- [
- 0
- I
- 0
- 0
- ]
- ,
-
- B
- ≈
- [
- 0
- I
- ]
- ,
-
- C
- ≈
- [
- C
- p
-
-
- C
- d
- ]
- ,
-
- x
- ≈
- [
- e
- T
-
-
- e
- .
- T
- ]
- T
- ,
- y denotes a measured output, and z denotes a regulated output,
- u
- =
- Ky
- =
- Kx
- =
- K
-
- [
- e
- e
- .
- ]
- =
- :
- -
- [
- K
- p
-
-
- K
- d
- ]
-
- [
- e
- e
- .
- ]
- [
- Equation
-
-
- 8
- ]
- P
- K
-
- :
-
- {
-
- x
- .
- =
- A
- K
-
- x
- +
- Bw
-
- z
- =
- Cx
- [
- Equation
-
-
- 9
- ]
- where AK:=A+BK, K is a control parameter, and
- wherein the L∞/L2 induced norm of the closed loop system is computed by the following Equation 16:
-
- T
-
- ∞
- /
- 2
- =
- max
- 1
- ≤
- i
- ≤
- n
-
- (
- C
- i
-
- PC
- i
- T
- )
- =
- d
- max
- 1
- /
- 2
-
- (
- CPC
- T
- )
- [
- Equation
-
-
- 16
- ]
- where P is a solution of AKP+PAKT+BBT=0.
A parameter determination method of a controller that computes an error value of an output value of a control target for a target value through a computational equation and provides a control input value of the control target,
- wherein the controller forms a closed loop system PK as shown in the following Equation 9:
- P
- K
-
- :
-
- {
-
- x
- .
- =
- A
- K
-
- x
- +
- Bw
-
- z
- =
- Cx
- [
- Equation
-
-
- 9
- ]
- where
- A
- K
- ≈
- A
- +
- BK
- ,
-
- A
- ≈
- [
- 0
- I
- 0
- 0
- ]
- ,
-
- B
- ≈
- [
- 0
- I
- ]
- ,
-
- C
- ≈
- [
- C
- p
-
-
- C
- d
- ]
- ,
-
- x
- ≈
- [
- e
- T
-
-
- e
- .
- T
- ]
- T
- ,
- K denotes the control parameter, w:=−M−1(q){tilde over (M)}(q)({umlaut over (q)}d−u)−M−1(q)({tilde over (C)}(q,{dot over (q)}){dot over (q)}+{tilde over (G)}(q)−τd) is a total exogenous disturbance acting in an inner loop system and is defined as including both an exogenous disturbance torque vector and a computation error, and z denotes a regulated output,
- the parameter determination method comprising:
- computing an L∞/L2 induced norm of a control system formed by the controller and the control target through an initially set control parameter;
- comparing the computed L∞/L2 induced norm with a reference value;
- when the computed L∞/L2 induced norm is larger than the reference value, adjusting the control parameter to reduce the computed L∞/L2 induced norm;
- and
- controlling a robot manipulator based on the computing and the comparing;
- wherein the L∞/L2 induced norm of the closed loop system is computed through a performance analysis mathematical expression dmax1/2(CPCT) where P is a solution of AKP+PAKT+BBT=0.
A performance analysis method of a controller that computes an error value of an output value of a control target for a target value through a computational equation and provides a control input value of the control target, the performance analysis method comprising:
- the controller forming a closed loop system PK as shown in the following Equation 9;
- and
- computing an L∞/L2 induced norm of the closed loop system through a performance analysis mathematical expression dmax1/2(CPCT):
- P
- K
-
- :
-
- {
-
- x
- .
- =
- A
- K
-
- x
- +
- Bw
-
- z
- =
- Cx
- [
- Equation
-
-
- 9
- ]
- where
- A
- K
- ≈
- A
- +
- BK
- ,
-
- A
- ≈
- [
- 0
- I
- 0
- 0
- ]
- ,
-
- B
- ≈
- [
- 0
- I
- ]
- ,
-
- C
- ≈
- [
- C
- p
-
-
- C
- d
- ]
- ,
-
- x
- ≈
- [
- e
- T
-
-
- e
- .
- T
- ]
- T
- ,
- K is a control parameter, w:=−M−1(q){tilde over (M)}(q)({umlaut over (q)}d−u)−M−1(q)*{tilde over (C)}(q,{dot over (q)}){dot over (q)}+{tilde over (G)}(q)−τd) is a total exogenous disturbance acting in an inner loop system and is defined as including both an exogenous disturbance torque vector and a computational error, z denotes a regulated output, and P is a solution of AKP+PAKT+BBT=0;
- controlling a robot manipulator based on the computing.
Dependencies are inferred from the claim text.