52AND A CERTAIN NUMBER OF ITS TIME DERIVATIVES. FOR THIS PURPOSE THE...

1.5

2

and a certain number of its time derivatives. For this purpose the corresponding transfer

1

function of the system under consideration is employed

0.5

0

b

0

+

b

1

·s

+

b

2

·s

2

Y

K

(

s

)

x

Kpd

in m/s

y

Kpd

in m/s

−0.5

−1

U

d

(

s

) =

c

T

y

sI−A

y

−1

b

y

=

N

(

s

)

. (44)

−2

−1.5

Obviously, the numerator of the control transfer function contains a second degree polynomial

0

5

10

15

t in s

in s, leading to two transfer zeros. This shows that the considered outputy

K

(

t

)

represents anon-flat output variable that makes computing of the feedforward term more difficult. A pos-Fig. 4. Desired trajectories for the cage motion: desired and actual position in horizontalsible way for calculating the desired input variable is given by a modification of the numeratordirection (upper left corner), desired and actual position in vertical direction (upper rightof the control transfer function by introducing a polynomial ansatz for the feedforward actioncorner), actual velocity in horizontal direction (lower left corner) and actual velocity in verticalaccording todirection (lower right corner).Y

Kd

(

s

)

. (45)U

d

(

s

) =

k

V0

+

k

V1

·s

+

. . .

+

k

V4

·s

4

For its realisation the desired trajectoryy

Kd

(

t

)

as well as the first four time derivatives areand its first three time derivatives are considered. Including the equations of motion (12)available from a trajectory planning module. The feedforward gains can be computed fromyields the following set of equationsa comparison of the corresponding coefficients in the numerator as well as the denominatorpolynomials ofy

Kd

(

t

) =

y

S

(

t

) +

1

2

κ

2

(

3−κ

)

·v

1

(

t

)

, (49)b

0

+

. . .

+

b

2

·s

2

k

V0

+

. . .

+

k

V4

·s

4

y˙

Kd

(

t

) =

y˙

S

(

t

) +

1

2

κ

2

(

3−κ

)

·v˙

1

(

t

)

, (50)Y

Kd

(

s

) =

N

(

s

)

y¨

Kd

(

t

) =

y¨

S

(

t

) +

1

2

κ

2

(

3−κ

)

·v¨

1

(

t

) =

y¨

K

(

v

1

(

t

)

, ˙y

S

(

t

)

, ˙v

1

(

t

)

,u

d

(

t

)

,κ

)

, (51)k

Vj

·s

+

. . .

+

b

V6

·s

6

+

b

V1

...y

Kd

(

t

) =

...y

K

(

v

1

(

t

)

, ˙y

S

(

t

)

, ˙v

1

(

t

)

,u

d

(

t

)

, ˙u

d

(

t

)

,κ

)

. (52)

=

b

V0

a

0

+

a

1

·s

+

. . .

+

s

4

(46)Solving equation (49) to (52) for the system states results in the desired state vector,i

=

0, . . . ,n

=

4 . (47)y

Kd

(

t

)

,u

d

(

t

)

, ˙u

d

(

t

)

,κ

)

y

Sd

(

y

Kd

(

t

)

, ˙y

Kd

(

t

)

, ¨y

Kd

(

t

)

,...a

i

=

b

Vi

v

1d

(

y˙

Kd

(

t

)

, ¨y

Kd

(

t

)

,...y

Kd

(

t

)

,u

d

(

t

)

, ˙u

d

(

t

)

,κ

)

x

d

(

t

) =

y

Kd

(

t

)

,u

d

(

t

)

, ˙u

d

(

t

)

,κ

)

y˙

Sd

(

y˙

Kd

(

t

)

, ¨y

Kd

(

t

)

,... . (53)This leads to parameter-dependent feedforward gainsk

Vj

=

k

Vj

(

κ

)

. It is obvious that duev˙

1d

(

y˙

Kd

(

t

)

, ¨y

Kd

(

t

)

,...y

Kd

(

t

)

,u

d

(

t

)

, ˙u

d

(

t

)

,κ

)

the higher numerator degree in the modified control transfer function a remaining dynamicsmust be accepted. Lastly, the desired input variable in the time domain is represented byThis equation still contains the inverse dynamicsu

d

(

t

)

and its time derivative ˙u

d

. Substitutingu

d

for equation (48) and ˙u

d

(

t

)

for the time derivative of (48), which can be calculated analyti-y

Kd

(

t

)

,y

(4)

Kd

(

t

)

,κy˙

Kd

(

t

)

, ¨y

Kd

(

t

)

,...u

d

(

t

) =

u

d

. (48)To obtain the desired system states as function of the output trajectory the output equation