Modelo, Pendulo Invertido
Modelo, Pendulo Invertido
Modelo, Pendulo Invertido
net/publication/321255124
CITATIONS READS
0 3,658
2 authors:
Some of the authors of this publication are also working on these related projects:
Método de Euler-Lagrange en el modelado y control de un péndulo invertido sobre un carro View project
All content following this page was uploaded by J. R. García Martínez on 23 November 2017.
Resumen Abstract
Un problema clásico de la teoría de control es el A classic problem of control theory is the inverted
péndulo invertido sobre un carro, donde estan pendulum on a cart, where two masses in motion are
conectadas dos masas en movimiento. Este tipo de connected. This type of mechanical system is
sistema mecánico es difícil de controlar debido a su difficult to control because of its inherent instability
inherente inestabilidad y con un comportamiento and with highly non-linear behavior. The objective of
altamente no lineal. El objetivo de este artículo es this paper is to obtain a mathematical model by
obtener un modelo matemático derivando las deriving the equations governing the dynamics of the
ecuaciones que rigen la dinámica del sistema péndulo inverted pendulum system using the Euler-Lagrange
invertido usando el método de Euler-Lagrange y una method and a state space representation for the
representación en espacio de estados para el diseño controller design. The controller is validated by
del controlador. El controlador se valida implementing a plant diagram and controller in
implementando un diagrama de la planta y el MATLAB/Simulink. The results demonstrate that
controlador en MATLAB/Simulink. Los resultados the method used in the controller design achieves the
demuestran que el método empleado en el diseño del control objective. This work provides a methodology
controlador logra el objetivo de control. Este trabajo that can be adapted and serve as a basis in the
aporta una metodología que puede ser adaptada y modeling and control design of other nonlinear
servir como base, en el modelado y diseño de control systems.
de otros sistemas no lineales.
Inverted pendulum, state space, linear controller
Péndulo invertido, espacio de estado, controlador
lineal
© ECORFAN-Perú www.ecorfan.org/republicofperu
2
Artículo Revista de Ingeniería Eléctrica
Diciembre 2017 Vol.1 No.3, 1-8
𝑑 𝜕𝐿 𝜕𝐿
( ) − 𝜕𝑞 = 𝑄𝑖 (𝑖 = 1, 2, 3, … , 𝑛) (1)
𝑑𝑡 𝜕𝑞𝑖̇ 𝑖
𝑇 = 𝑇𝑐 + 𝑇𝑝 (7)
la ecuación (12). 𝜕𝐿
=0 (20)
𝜕𝑥
1 2 2
𝑇𝑝 = 2 𝑚 [(𝑥̇ + 𝑙𝜃̇𝑐𝑜𝑠𝜃) + (−𝑙𝜃̇𝑠𝑒𝑛𝜃) ] (12)
Aplicando las derivadas a la ecuación
Desarrollando la ecuación (12) y anterior se obtiene
reduciendo términos se obtiene la energía
(𝑀 + 𝑚)𝑥̈ − 𝑚𝑙𝜃̇ 2 𝑠𝑒𝑛𝜃 + 𝑚𝑙𝑐𝑜𝑠𝜃𝜃̈ + 𝑏𝑥̇ = 𝐹 (21)
cinética total del péndulo:
1 1 En el caso 2, la coordenada generalizada
𝑇𝑝 = 2 𝑚𝑥̇ 2 + 𝑚𝑙𝑥̇ 𝜃̇𝑐𝑜𝑠𝜃 + 2 𝑚𝑙 2 𝑥̇ 2 (13) 𝑞2 = 𝜃:
La energía potencial del péndulo queda 𝑚 𝑙 2 𝜃̈ + 𝑚𝑙𝑥̈ 𝑐𝑜𝑠𝜃 − 𝑚𝑔𝑙𝑠𝑒𝑛𝜃 + 𝑑𝜃̇ = 0 (23)
expresada como:
Las ecuaciones (21) y (23) son las
𝑉𝑝 = 𝑚𝑔𝑙𝑐𝑜𝑠𝜃 (15) ecuaciones que definen el movimiento del
SPISC y representan el modelo matemático no
Y la energía potencial del carro se lineal y se expresan en forma matricial en la
expresa: ecuación (24):
𝑉 = 𝑉𝑐 + 𝑉𝑝 = 𝑉𝑝 (17)
ISSN-2523-2517 RAMÍREZ-GONZÁLEZ, Luis, GARCÍA-MARTÍNEZ, José,
SIORDIA-VÁSQUEZ, Xochitl y GARCIA-RAMOS, Roman. Euler-
ECORFAN® Todos los derechos reservados.
Lagrange en el modelado y control de un péndulo invertido sobre un
carro. Revista de Ingeniería Eléctrica. 2017.
5
Artículo Revista de Ingeniería Eléctrica
Diciembre 2017 Vol.1 No.3, 1-8
Siendo u la entrada del sistema que es Siendo 𝛼𝑛 los coeficientes del polinomio
igual a la fuerza F aplicada, y D la matriz de característico deseado. La ubicación de los polos
transmitancia del sistema la cual tiene un valor de lazo cerrado en la localización deseada se
0. Usando, los parámetros de la Tabla 1, del expresa por la ecuación siguiente:
SPISC, en la ecuación de estado se obtienen los
valores numéricos de las matrices A y B, por lo s = μ1 ; s = μ2 ; ⋯ ∙∙; s = 𝜇𝑛 (41)
que la ecuación de estado (34) queda ahora
expresada por la ecuación (36). Para realizar el diseño, primero es
necesario que el sistema sea de estado
𝑥̇ 1 0 1 0 0 𝑥1 0
𝑥̇ 0 −0.0455 0 −0.0545 𝑥2 0.4545
completamente controlable, por lo que se
[ 2] = [ ] [𝑥 ] + [ ]𝑢 (36)
𝑥̇ 3
𝑥̇ 4
0 0 0 1 3
𝑥4
0 necesita verificar la controlabilidad del SPISC
0 0.0833 6.4746 0 −0.8333
con la matriz de controlabilidad 𝑀𝑐 expresada
Con la ecuación de estado del SPISC se por la ecuación siguiente:
evaluan los polos en lazo abierto, quedando
expresados en la ecuación (37). 𝑀𝐶 = [𝐵 𝐴𝐵 ⋯ 𝐴𝑛−1 𝐵]; 𝑀𝑐 ≠ 0 (42)
u y1
El método de diseño por asignación de polos y el .
X=Ax+Bu Cx
y2
uso de la fórmula de Ackerman, consiste en
determinar la ley de control por
retroalimentación, expresada por la ecuación -K
(38).
Figura 2 Diagrama de bloques del SPISC con control de
𝑢 = −𝐾𝑥 (38) retroalimentación de estados
Conclusiones
Agradecimiento
Referencias