Professional Documents
Culture Documents
State Feedback Control Algorithm
State Feedback Control Algorithm
Controller design
1. Check rank of controllab ility matrix for given (, )
2. Select closed loop poles and find controller matrix G that
places poles at the designed location
Observer design
1. Check rank of observability matrix for given (C, )
2. Select closed loop poles and find controller matrix L that
places poles at the designed location
Innovation Bias Algorithm Summary
Sequence of calculation steps at k'th sampling instant
1. Get measurement at instant k : y (k ) Y(k ) Ys
2. Compute innovation : e(k ) y ( k ) Cxˆ (k )
3. Filter innovation s : e f (k ) ee f ( k 1) (1 e )e(k )
4. Compute target input and target state
u s (k ) K u1 r (k ) K I e f (k )
x s (k ) I u u s (k ) Le f (k )
1
s u
u (k ) K 1 r ( k ) K βˆ (k ) K 1r (k ) βˆ (k )
u
x s (k ) I u K u1r (k )
1