26.12.2014 Views

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 ...

SHOW MORE
SHOW LESS

Create successful ePaper yourself

Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.

Porém como são muitos parâmetros a serem i<strong>de</strong>ntificados é muito gran<strong>de</strong> e existem somente<br />

três entradas, existem muitos graus <strong>de</strong> liberda<strong>de</strong> para que o Filtro acha <strong>um</strong>a solução que não<br />

seja a <strong>de</strong>sejada, ou que haja divergência nas matrizes <strong>de</strong> covariância <strong>de</strong> processo e <strong>de</strong> estados.<br />

Para diminuir essa possibilida<strong>de</strong>, utilizamos dados conhecidos (no caso da i<strong>de</strong>ntificação em <strong>um</strong><br />

voo simulado), pois o programa <strong>de</strong> simulação fornece os parâmetros utilizados.<br />

O mo<strong>de</strong>lo proposto está escrito na forma <strong>de</strong> Espaço <strong>de</strong> Estados, e essa forma relaciona a<br />

<strong>de</strong>rivada das variáveis <strong>de</strong> estado (acelerações) com os estados (velocida<strong>de</strong>s). Os estados, que serão<br />

a saída do processo, são as <strong>de</strong>rivadas das variáveis <strong>de</strong>sejadas. Assim para obter as velocida<strong>de</strong>s<br />

angulares através das acelerações, a integração feita foi <strong>de</strong> natureza n<strong>um</strong>érica.<br />

A vantagem <strong>de</strong> se utilizar esse mo<strong>de</strong>lo em face do mo<strong>de</strong>lo linear completo é sua “menor linearida<strong>de</strong>”.<br />

Isso significa que há interações não lineares <strong>de</strong> parâmetros como a multiplicação, porém<br />

não há a presença <strong>de</strong> funções não lineares como sen, cos e arctan. Isso acontece pois nesse mo<strong>de</strong>lo<br />

só as velocida<strong>de</strong>s e acelerações angulares são utilizadas, e como as velocida<strong>de</strong>s e acelerações<br />

lineares não estão presentes, não é necessário relacionar as gran<strong>de</strong>zas lineares e angulares, razão<br />

do surgimento das funções não lineares citadas, o que facilitará a i<strong>de</strong>ntificação.<br />

6.5.5 Mo<strong>de</strong>lo não linear completo<br />

Uma das formas <strong>de</strong> atacar o problema da i<strong>de</strong>ntificação é utilizar o mo<strong>de</strong>lo não linear completo,<br />

incluindo todas as velocida<strong>de</strong>s e acelerações lineares e angulares. O mo<strong>de</strong>lo retirado <strong>de</strong> [7],<br />

<strong>de</strong>senvolvido no sistema <strong>de</strong> coor<strong>de</strong>nadas fixas no corpo, é dado por:<br />

˙U = K tδ t<br />

m + ¯qS ( )<br />

( )<br />

W W<br />

m (C¯L sin(arctan )) − C D cos(arctan ) + RV − QW − g sin θ (6.27)<br />

U<br />

U<br />

˙V = ¯qS m C Y − RU + P W − g sin φ cos θ (6.28)<br />

Ẇ = ¯qS ( )<br />

( )<br />

W W<br />

m (−C D sin(arctan )) − C¯L cos(arctan ) + QU − P V + g cos φ cos θ (6.29)<br />

U<br />

U<br />

˙ P = (c 1 R + C 2 P )Q + c 3¯qSbC ¯L + c 4¯qSbC N (6.30)<br />

˙Q = c 5 P R − c 6 (P 2 − R 2 ) + c 7¯qScC M (6.31)<br />

Ṙ = (c 8 P − c 2 R)Q + c 4¯qSbC ¯L + c 9¯qSbC N (6.32)<br />

˙φ = P + Q sin φ tan θ + R cos φ tan θ (6.33)<br />

˙θ = Q cos φ − R sin θ (6.34)<br />

˙ψ = Q sin φ<br />

cos θ + Rcos φ<br />

cos θ<br />

(6.35)<br />

E os coeficientes são dados por:<br />

131

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!