Vai al contenuto
Controllo Digitale

Osservatori discreti e principio di separazione

Osservatore di predizione e dinamica dell'errore dimostrata, osservatore deadbeat con esempio, osservatore corrente, principio di separazione dimostrato, stima dei disturbi, filtro di Kalman.

La retroazione dello stato (lezione sul controllo deadbeat) richiede di conoscere tutto lo stato, ma di solito si misura solo una parte: la posizione e non la velocità, la temperatura in un punto e non in tutto il forno. L’osservatore ricostruisce lo stato dalle misure e dai comandi, usando il modello. Nel discreto è semplicemente un’equazione alle differenze in più nel programma. In questa lezione vediamo l’osservatore di predizione e la dinamica del suo errore, l’osservatore deadbeat con un esempio, quello corrente, il principio di separazione con la dimostrazione, la stima dei disturbi e il filtro di Kalman.

L’osservatore di predizione

Il programma conosce il modello x(k+1) = \Phi x(k) + \Gamma u(k), y = Cx, i comandi che ha dato e le misure. Simula il modello in parallelo al processo e lo corregge con la differenza tra la misura e la sua previsione:

    \[ \hat{x}(k+1) = \Phi\hat{x}(k) + \Gamma u(k) + L\big(y(k) - C\hat{x}(k)\big) \]

Teorema. L’errore di stima e = x - \hat{x} evolve secondo

    \[ e(k+1) = (\Phi - LC)\,e(k) \]

indipendentemente dal comando.

Dimostrazione. Sottraendo l’equazione dell’osservatore da quella del processo, i termini \Gamma u(k) si cancellano e resta e(k+1) = \Phi e(k) - L(Cx(k) - C\hat{x}(k)) = (\Phi - LC)e(k). ∎

Se gli autovalori di \Phi - LC sono dentro il cerchio unitario, la stima converge allo stato vero qualunque sia l’errore iniziale. Il problema di scegliere L è il duale della retroazione dello stato: gli autovalori di \Phi - LC sono quelli di \Phi^T - C^TL^T, e si possono mettere dove si vuole se il sistema è osservabile (lezione sull’osservabilità di Teoria dei sistemi). Si usano gli stessi metodi, compresa la formula di Ackermann applicata alla coppia (\Phi^T, C^T).

L’osservatore deadbeat

Mettendo tutti gli autovalori di \Phi - LC in zero, l’errore si annulla in n passi (per lo stesso argomento di Cayley-Hamilton della lezione precedente): dopo n misure lo stato è noto esattamente, in assenza di rumore.

Esempio. Doppio integratore con T = 1, misura della sola posizione, C = \begin{bmatrix} 1 & 0 \end{bmatrix}. Con L = (l_1, l_2):

    \[ \Phi - LC = \begin{bmatrix} 1 - l_1 & 1 \\ -l_2 & 1 \end{bmatrix} \]

con traccia 2 - l_1 e determinante 1 - l_1 + l_2. Per avere il polinomio z^2 entrambi devono essere nulli: l_1 = 2, l_2 = 1. La matrice diventa \begin{bmatrix} -1 & 1 \\ -1 & 1 \end{bmatrix}, e il suo quadrato è la matrice nulla. Dopo due campioni di posizione l’osservatore conosce anche la velocità: è, in fondo, il rapporto incrementale tra due posizioni corretto per l’effetto del comando.

Con misure rumorose un osservatore così veloce amplifica il rumore; di solito i poli dell’osservatore si scelgono da 2 a 4 volte più veloci di quelli del regolatore, compromesso tra rapidità e filtraggio.

L’osservatore corrente

L’osservatore di predizione usa la misura y(k) per stimare x(k+1): la stima di x(k) non sfrutta la misura appena arrivata. L’osservatore corrente fa prima una previsione e poi la corregge con la misura dello stesso istante:

    \[ \bar{x}(k) = \Phi\hat{x}(k-1) + \Gamma u(k-1),\qquad \hat{x}(k) = \bar{x}(k) + L_c\big(y(k) - C\bar{x}(k)\big) \]

Il comando calcolato da \hat{x}(k) reagisce senza un passo di ritardo, al costo di dover fare il calcolo tra il campionamento e l’aggiornamento (lezione sull’implementazione). È la stessa struttura previsione-correzione del filtro di Kalman.

Il principio di separazione

Retroazione dallo stato stimato
Il processo, descritto da Phi, Gamma e C, riceve il comando u e produce la misura y. L’osservatore, con il guadagno L, riceve u e y e produce la stima x cappello; il guadagno K la riporta al nodo di confronto con il riferimento, scalato da N.

Si usa la stima al posto dello stato: u(k) = -K\hat{x}(k). È lecito progettare K e L separatamente?

Teorema (principio di separazione). Con u = -K\hat{x} e l’osservatore di predizione, gli autovalori dell’anello chiuso sono l’unione degli autovalori di \Phi - \Gamma K e di quelli di \Phi - LC.

Dimostrazione. Si usano come variabili lo stato x e l’errore e = x - \hat{x}. Poiché \hat{x} = x - e:

    \[ x(k+1) = \Phi x - \Gamma K(x - e) = (\Phi - \Gamma K)x + \Gamma Ke \]

e per il teorema precedente e(k+1) = (\Phi - LC)e. In forma matriciale:

    \[ \begin{bmatrix} x \\ e \end{bmatrix}(k+1) = \begin{bmatrix} \Phi - \Gamma K & \Gamma K \\ 0 & \Phi - LC \end{bmatrix}\begin{bmatrix} x \\ e \end{bmatrix}(k) \]

La matrice è triangolare a blocchi, e il suo polinomio caratteristico è il prodotto di quelli dei blocchi diagonali. ∎

Il regolatore e l’osservatore si progettano quindi indipendentemente. Attenzione però: la separazione riguarda i poli, non la robustezza. I margini di stabilità dell’insieme possono essere molto più piccoli di quelli della retroazione dello stato vera, e vanno verificati.

Stimare i disturbi

Un disturbo costante sconosciuto d sull’ingresso si modella come uno stato in più che non cambia, d(k+1) = d(k), con x(k+1) = \Phi x + \Gamma(u + d). Se il sistema aumentato è osservabile, l’osservatore stima anche d, e il regolatore lo compensa con u = -K\hat{x} - \hat{d}. Il risultato è un’azione integrale ottenuta per altra via, che si estende a disturbi sinusoidali (con un oscillatore nel modello del disturbo) e ad altre forme note: è il principio del modello interno.

Il filtro di Kalman

Quando il processo è soggetto a disturbi casuali e le misure a rumore, con varianze note, esiste un guadagno L ottimo, che minimizza la varianza dell’errore di stima: è il filtro di Kalman. Il guadagno si ottiene da un’equazione di Riccati, duale di quella del controllo ottimo (lezione sul controllo LQ e predittivo), e bilancia automaticamente fiducia nel modello e fiducia nelle misure: misure molto rumorose danno un guadagno piccolo, un modello incerto dà un guadagno grande. È usato ovunque: navigazione inerziale e GPS, stima della carica delle batterie, inseguimento di bersagli.

Subscribe
Notify of
guest
0 Comments
Oldest
Newest Most Voted
0
Would love your thoughts, please comment.x
()
x