Escolar Documentos
Profissional Documentos
Cultura Documentos
Abstract— This work concerns the mathematical modeling of quadrotors with cascaded control architectures
for stabilization. The dynamical model presented is used to show, through simulations, the viability of three
different linear and nonlinear control techniques.
Resumo— Este trabalho trata da modelagem matemática de quadrirrotores que fazem uso de arquiteturas de
controle em cascata para estabilização de seus graus de liberdade. O modelo dinâmico apresentado é utilizado
para comprovar, por meio de simulações, a viabilidade de aplicação de três diferentes técnicas de controle linear
e não-linear ao sistema.
Palavras-chave— Quadrirrotor, modelagem, controle em cascata.
1 Introdução
em que b é o mesmo de (1), L é a meia enverga- Diferentes estratégias foram utilizadas na malha
dura do quadrirrotor e d é coeficiente de arrasto de controle de estabilização da Figura 2 durante
da estrutura. as simulações realizadas com o modelo descrito
A substituição de (8), (11), (12) e (13) em na Seção 2. Primeiramente, as Seções 3.1 e 3.2
(6) resulta nas equações diferenciais para a dinâ- apresentam estratégias de controle linear aborda-
mica angular do quadrirrotor, cujo resultado final das em Santana and Braga (2008) e Bouabdallah
é extenso e pode ser encontrado em Santana and et al. (2004). Em seguida, a Seção 3.3 descreve
Braga (2008) 1 . Por representarem um modelo di- um controlador não-linear backstepping baseado
nâmico mais completo, estas equações diferenciais nos projetos de Bouabdallah and Siegwart (2005)
foram utilizadas na construção do simulador. e Madani and Benallegue (2006).
Supondo ângulos de inclinação φ, θ e ψ pe-
quenos, as aproximações 3.1 Controle PID
Esta estratégia de controle PID utiliza controla-
sin(α) ≈ 0,
dores independentes para os graus de liberdade φ,
cos(α) ≈ 1,
θ, ψ e z do quadrirrotor, procurando mantê-lo em
ωx ≈ dφ
dt , (14)
dθ vôo planado a uma altitude definida. Considera-
ω ≈ dt ,
y
dψ se vôo planado a situação em que o quadrirrotor
ωz ≈ dt ,
encontra-se estático com φ = θ = ψ = 0.
Sejam as equações de um controlador PID dis-
1 Se necessário, entre em contato com o primeiro autor. creto
Logo,
˛ ˛
ui (k) = ui (k − 1) + Kid T e(k), ∂f ˛˛ ∂f ˛˛
δ ξ̇ = δξ + δu. (26)
u(k) = Kpd e(k) + ui (k) + KTdd (e(k) − e(k − 1)), ∂ξ ˛ ξ = ξ¯ ∂u ˛ ξ = ξ¯
u = ū u = ū
(22)
Notando que (26) está na forma de espaço de
em que u(k) é o sinal de controle; ui (k) é a compo- estados linear, a lei de controle pode ser escrita
nente integral do controlador; Kpd , Kid , Kdd são, como
respectivamente, os ganhos proporcional, integral δξ = ξ − ξ̄,
e derivativo; e(k) é o sinal de erro; T é o perı́odo δu = −Kδξ, (27)
u = ū + δu.
de amostragem; e k é o número da amostra. Sendo
uj (k), j ∈ {φ, θ, ψ, z}, o sinal de controle para o A matriz de realimentação K determina a aloca-
j-ésimo grau de liberdade, as equações de controle ção dos oito pólos do sistema e pode ser determi-
são dadas por nada computacionalmente por meio da conhecida
fórmula de Ackermann.
τx (k) uφ (k)
τy (k) uθ (k) 3.3 Controle não-linear backstepping
= . (23)
τz (k) uψ (k)
U (k) uz (k) + mg Sendo
X = [φ φ̇ θ θ̇ ψ ψ̇ z ż x ẋ y ẏ]T = [x1 x2 . . . x12 ]T
Os valores dos torques e do empuxo vertical
em (23) são convertidos por (18)-(21) em veloci- o vetor de estados do sistema e
dades de rotação para os motores. F = [τx τy τz U ]T
o vetor de entradas, o modelo dinâmico (3)-(5)
3.2 Controle por linearização de modelo e (15)-(17) do quadrirrotor pode ser escrito na
Assim como na Seção 3.1, o controlador desta Se- forma de espaço de estados como
ção visa à manutenção do quadrirrotor em situ-
2 3
x2
τ
ação de vôo planado a uma altitude definida. A 6
6 x 4 x 6 a 1 + b1 L x 7
7
dedução das equações de controle considera o mo- 6 x 4 7
6 τy 7
delo de translação (3)-(5) e o modelo angular sim-
6
6 x 2 x 6 a 2 + b2 L 7
7
x 6
plificado (15)-(17).
6 7
τ
6 7
6 x 4 x 2 a 3 + b 3
z 7
Sejam o vetor de estados Ẋ = f (X, F ) = 6
x
L 7 , (28)
8
6 7
6 7
T 6−g + (cos(x1 ) cos(x3 )) 1 U 7
m 7
ξ= φ θ ψ z φ̇ θ̇ ψ̇ ż (24)
6
6
6 x10 7
7
1
6
6 u x m
U 7
7
e o vetor de entradas de atuação 4 x12 5
1
T uy m U
u = τx τy τz U . em que
Iyy − Izz Izz − Ixx Ixx − Iyy
a1 = , a2 = , a3 = ,
O sistema dinâmico definido pelas variáveis de Ixx Iyy Izz
(24) pode ser escrito na forma de espaço de es- L L L
tados como b1 = , b2 = , b3 = ,
Ixx Iyy Izz
2
φ̇
3 ux = (cos(x1 ) sin(x3 ) cos(x5 ) + sin(x1 ) sin(x5 )), (29)
6 θ̇ 7 uy = (cos(x1 ) sin(x3 ) sin(x5 ) − sin(x1 ) cos(x5 )). (30)
6 7
6
6 ψ̇ 7
7 Para as Seções 3.3.1 e 3.3.2, considere o vetor de
6
6 ż 7
7 parâmetros do controlador
6 Iyy − Izz 7
ξ˙ = f (ξ, u) = 6
6 ψ̇ θ̇ + Iτxx
x
7.
7
(25) α = [α1 α2 . . . α12 ]T , αi > 0, i ∈ {1, 2, . . . , 12},
Ixx
6 Izz − Ixx
6 7
τy
ψ̇ φ̇ + Iyy o vetor de referências
7
6 7
6 Iyy 7
6 I −I
Xd = [x1d x2d . . . x12d ]T ,
7
6 xx yy
θ̇φ̇ + Iτzz
z 7
4 Izz 5
−g + cos(θ) cos(φ)U em que xid , i ∈ {1, 2, . . . , 12}, é a referência para
m
a i-ésima variável de estado e as mudanças de va-
Considerando ξ̄ = [0 0 0 href 0 0 0 0]T o vetor de riável
referência de estado e ū = [0 0 0 mg] a referência z2k = x2k − ẋ(2k−1)d − α(2k−1) z(2k−1) ,
para a entrada de controle, em que href é a al- z2k−1 = x(2k−1)d − x2k−1 , k ∈ {1, 2, 3, 4, 5, 6}.
titude desejada do quadrirrotor, a linearização de
(25) em torno do ponto (ξ, ¯ ū) resulta em Diferentemente dos controladores das Seções 3.1
e 3.2, o controlador backstepping aqui apresentado
procura levar todos os estados de X para valores
¯ ¯ ū) + ∂f (ξ − ξ)
ξ˙ = ξ̇ + δ ξ˙ ≈ f (ξ, ¯ + ∂f (u − ū).
∂ξ ∂u desejados Xd .
Tabela 1: Parâmetros do modelo do quadrirrotor.
Sı́mbolo Descrição Valor
m massa total 1, 5 kg
g gravidade local 9, 81 sm2
Ixx inércia do eixo x 0, 033 kg.m2
Iyy inércia do eixo y 0, 033 kg.m2
Izz inércia do eixo z 0, 066 kg.m2
L meia envergadura 0, 5 m
b coeficiente de empuxo 2, 64.10−4 N.s2
d coeficiente de arrasto 7, 5.10−7 N.m.s2