Control Strategies
Control Strategies
Control strategies:
Æ feed-back
Æ feed-forward
Æ feed-forward + feed-back
fc z
Hypothesis:
f = fd+ fr stable, underdamped single-dof vibrating
system
m
k Objective:
c feeding in this mechanical system with the
control force fc, so as to make the mass m
follow the reference signal zREF in the best
mz + cz + kz = f + f c possible way
1
Feed-back
zr e fcFB + f z
+
controller (PD) mech. system
- +
f c FB (t ) = k p ( zr (t ) − z (t ) ) + kd ( zr (t ) − z (t ) )
mz + ( c + kd ) z + ( k + k p ) z = f (t ) + k p zr (t ) + kd zr (t )
Feed-back control:
Æ modifies the system’s parameters (stiffness and damping, for PD)
Æ influences the stability of the controlled system 3
Feed-forward
zr fcFF + f z
inverse dynamics mech. system
+
ˆ + cz
mz ˆ = f (t ) + f (t )
ˆ + kz d cFF
Once that the mathematical model and the desired response zr(t) are known, the
feed-forward control force is evaluated by solving an inverse dynamic problem:
f c FF (t ) = mz
ˆ r (t ) + cz ˆ (t ) − f (t )
ˆ r (t ) + kz r d
2
Feed-forward
⇒ mz + cz + kz = f d + f r + mz
ˆ r + cz ˆ − f
ˆ r + kz r d
Feed-forward + feed-back
fcFF + f
zr inverse dynamics
+ + z
mech. system
+ fcFB +
controller (PD)
-
f c FB (t ) = k p ( zr (t ) − z (t ) ) + kd ( zr (t ) − z (t ) )
⇒ mz + cz + kz = f r + mz
ˆ r + cz ˆ + k ( z − z ) + k ( z − z )
ˆ r + kz r p r d r
6
3
Feed-forward + feed-back
mz + cz + kz = f r + mz
ˆ r + cz ˆ + k ( z − z ) + k ( z − z )
ˆ r + kz r p r d r
z = zr + z
The feed-forward + feed-back control strategy generally allows to obtain the best
system’s performance
7
4
Example of application: motion control
θr
1
0.5
0
0 0.5 1 1.5 2 2.5 3
k c 3
θr 2
0
0 0.5 1 1.5 2 2.5 3
10
θr 0
-10
0 0.5 1 1.5 2 2.5 3
tempo [s]
Nc FEED-FORWARD
θ
J, R
Jθ + 2cR 2θ + 2kR 2θ = f + N cFF
k c
( Js 2
+ 2cR 2 s + 2kR 2 ) Θ ( s ) = N cFF ( s )
N cFF ( s ) = Js (
ˆ 2 + 2cR ˆ 2 Θ (s)
ˆ 2 s + 2kR r )
NcFF f
Θr + 1 Θ
ˆ 2 + 2cR
Js ˆ 2
ˆ 2 s + 2kR
+ Js 2 + 2cR 2 s + 2kR 2
Θ(s)
=1 for perfect mathematical model ⇒ Θ ( s ) = Θr ( s )
Θr ( s ) 10
5
Example of application: motion control
Nc FEED-BACK
θ
J, R
Jθ + 2cR 2θ + 2kR 2θ = f + N cFB
N cFB = k p (θ r − θ ) + kd θr − θ ( )
k c
( Js 2
+ 2cR 2 s + 2kR 2 ) Θ ( s ) = N cFB ( s )
N cFB ( s ) = k p (1 + Td s ) ( Θr ( s ) − Θ ( s ) )
Θr NcFB f Θ
+ +
k p (1 + Td s )
1
Js + 2cR 2 s + 2kR 2
2
- +
Θ(s) k p (1 + Td s )
L ( s) = =
Θr ( s ) Js + ( 2rR + k pTd ) s + ( 2kR 2 + k p )
2 2 11
θ Nc FEED-FORWARD + FEED-BACK
J, R Jθ + 2cR 2θ + 2kR 2θ = f + N cFF + N cFB
N cFB = k p (θ r − θ ) + kd θr − θ ( )
N = Jˆθ + 2cR ˆ 2θ + 2kRˆ 2θ
cFF r r r
k c
( Js 2
+ 2cR 2 s + 2kR 2 ) Θ ( s ) = N cFF ( s ) + N cFB ( s )
N cFB ( s ) = k p (1 + Td s ) ( Θr ( s ) − Θ ( s ) )
N ( s ) = Js
cFF (
ˆ 2 + 2cR
ˆ 2 s + 2kR ˆ 2 Θ (s) ) r
NcFF
+ f
Θr ˆ 2 + 2cR
Js ˆ 2
ˆ 2 s + 2kR
+ + 1
Θ
+ NcFB + Js + 2cR 2 s + 2kR 2
2
k p (1 + Td s )
-
12
6
Example of application: motion control
FEED-FORWARD + FEED-BACK
NcFF
Θr Gˆ ( s ) −1 + Θ
G( s)
+ NcFB
k p (1 + Td s ) +
-
Θ ( s ) = ( N cFF ( s ) + N cFB ( s ) ) G ( s )
N cFF ( s ) = Gˆ ( s ) Θr ( s )
−1
NcFB ( s) = kp (1+ Td s) ( Θr ( s) −Θ( s) )
Θ ( s ) = Θr ( s ) Gˆ ( s ) G ( s ) + k p (1 + Td s ) ( Θr ( s ) − Θ ( s ) ) G ( s )
−1
Θ ( s ) Gˆ ( s ) G ( s ) + k p (1 + Td s ) G ( s )
−1
Θ(s)
= =1 for perfect
Θr ( s ) 1 + k p (1 + Td s ) G ( s ) Θr ( s ) mathematical model
13
1.5
θr 1
0.5
0
0 0.5 1 1.5 2 2.5 3
3
θr 2
0
0 0.5 1 1.5 2 2.5 3
10
θr 0
-10
0 0.5 1 1.5 2 2.5 3
tempo [s]
14
7
Example of application: motion control
FEED-FORWARD
Jˆ = J , cˆ = c, kˆ = k
1.4
Response
Reference
1.2
0.8
[rad]
0.6
0.4
0.2
0
0 0.5 1 1.5 2 2.5 3
[s]
15
FEED-BACK (PD)
Response
Reference
1.2
0.8
[rad]
0.6
0.4
0.2
0
0 0.5 1 1.5 2 2.5 3
[s]
16
8
Example of application: motion control
Jˆ = J , cˆ = c, kˆ = k
1.4
Response
Reference
1.2
0.8
[rad]
0.6
0.4
0.2
0
0 0.5 1 1.5 2 2.5 3
[s]
17
FEED-FORWARD
k
Jˆ = J , cˆ = c, kˆ = ⇒ underestimated stiffness
2
Response
Reference
1.2
0.8
[rad]
0.6
0.4
0.2
0
0 0.5 1 1.5 2 2.5 3
[s]
18
9
Example of application: motion control
Response
Reference
1.2
0.8
[rad]
0.6
0.4
0.2
0
0 0.5 1 1.5 2 2.5 3
[s]
19
1 PID controller
0.8
[rad]
0.6
1 Response FB (PID)
0.4 Reference
0.9
Response FF+FB (PID)
0.8
0.2
0.7
0.6
0
[rad]
0.3
0.2
0.1
0
0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8
[s] 20
10