Desenvolvimento de um VeÃculo Aéreo Não-Tripulado - LARA ...
Desenvolvimento de um VeÃculo Aéreo Não-Tripulado - LARA ...
Desenvolvimento de um VeÃculo Aéreo Não-Tripulado - LARA ...
Create successful ePaper yourself
Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.
O <strong>de</strong>senvolvimento completo <strong>de</strong>ssas equações é dado em [85].<br />
As entradas do processo serão: δ a , δ r , δ e , δ th , significando as entradas do aileron, leme (ou em<br />
inglês, explicando o subíndice r, rud<strong>de</strong>r), profundor (elevator), e motor (throttle). As constantes<br />
L, M e N com subíndices relacionam estados e entradas com os momentos aerodinâmicos. Através<br />
<strong>de</strong>ssas equações que as entradas interagem com os estados. Uma mudança na atuação <strong>de</strong> <strong>um</strong>a<br />
entrada modifica os momentos aerodinâmicos que por sua vez influenciam os estados.<br />
Este mo<strong>de</strong>lo será i<strong>de</strong>ntificado da forma caixa cinza, pois os parâmetros possuem significado<br />
físico e serão i<strong>de</strong>ntificados pelo Filtro <strong>de</strong> Kalman. Os vetores <strong>de</strong> estado e entrada serão:<br />
x = [p q r] T (6.21)<br />
u = [δ e δ r δ a δ th ] (6.22)<br />
Definimos f função <strong>de</strong>:<br />
As saídas nada mais são que os três estados.<br />
[pq qr pr p 2 r 2 p q r δ e δ r δ a δ th ] (6.23)<br />
Para implementação do Filtro <strong>de</strong> Kalman, <strong>de</strong>screvemos o mo<strong>de</strong>lo como:<br />
x − k+1 = f(x k, u k , w k ) (6.24)<br />
⎡ ⎤<br />
p + v k<br />
y k = ⎢<br />
⎣q + v ⎥ k ⎦ (6.25)<br />
r + v k<br />
on<strong>de</strong> w k e v k são os ruídos <strong>de</strong> processo e observação.Na equação 6.25, f representa as Equações<br />
<strong>de</strong> 6.15 a 6.17 . Como queremos fazer a i<strong>de</strong>ntificação dos parâmetros, <strong>de</strong>vemos a<strong>um</strong>entar a matriz<br />
<strong>de</strong> estados para:<br />
x = [p q r L p L r L δr L δa N p N r N δr N δa M q M δe M δth L δth N δth I x I y I z I xz ] T (6.26)<br />
totalizando 17 parâmetros para serem i<strong>de</strong>ntificados mais 3 estados a serem estimados.<br />
Das Equações <strong>de</strong> 6.15 a 6.17 notamos que o problema é não linear e por isso <strong>de</strong>ve ser utilizado o<br />
Filtro <strong>de</strong> Kalman Estendido. Como o problema é não linear também nos parâmetros, não é possível<br />
utilizar o método dos Mínimos Quadrados. A i<strong>de</strong>ntificação proposta, utilizando Filtro <strong>de</strong> Kalman,<br />
é muito parecida com [86], porém com a diferença entre o mo<strong>de</strong>lo i<strong>de</strong>ntificado. A abordagem aqui<br />
utilizada para i<strong>de</strong>ntificação foi <strong>um</strong> pouco diferente do artigo original [85], justamente por utilizar<br />
o Filtro <strong>de</strong> Kalman.<br />
130