Diferencias para "LabElectronica/ProyectoQuadricoptero/PVTOL_ControlDelAngulo"

Diferencias entre las revisiones 3 y 8 (abarca 5 versiones)

Tabla de Contenidos

Modelo Balancín
Modelo Balancín con Compensación Proporcional y Realimentación
Modelo Balancín con Compensación Proporcional-Derivativa y Realimentación
Cálculo Aproximado de las constantes
1. Cálculo de la constante de Inercia
2. Cálculo de la constante del Motor
  1. Estabilización en modo común

Modelo Balancín

$$G_p = \frac{K_J}{s^2}$

$$$G_c = K_p$$

$$K_M = \frac{\Delta_F}{\Delta_D}$

$$K_J = \frac{r}{J_T}$

En donde

$$G_c$$

es el compensador,

$$k_M$$

es la función de transferencia entre fuerza y duty, y

$$k_J$$

es la función de transferencia entre fuerza y ángulo.

$$r$$

representa la distancia desde la aplicación de la fuerza hasta el centro de giro y

$$J_T$$

es la inercia total.

La función de transferencia a Lazo abierto queda:

$$G_{LA}(s) = \frac{K_pK_MK_J}{s^2}$

Modelo Balancín con Compensación Proporcional y Realimentación

Suponemos que la función de transferencia del sensor es lineal, por esto podemos decir que la

$$H(s)=1$$

De esto obtenemos:

$$\frac{\Phi_{ref}(s)}{\Phi_{Med}(s)}=\frac{G_{LA}(s)}{1+G_{LA}(s)H(s)}=\frac{K_pK_MK_J}{s^2 + K_pK_MK_J}$

Modelo Balancín con Compensación Proporcional-Derivativa y Realimentación

Suponemos que la función de transferencia del sensor es lineal, por esto podemos decir que la

$$H(s)=1$$

De esto obtenemos:

$$$G_c(s) = K_p + K_ds$$

$$G_{LA}(s) = \frac{K_MK_J}{s^2}$

$$\frac{\Phi_{ref}(s)}{\Phi_{Med}(s)}=\frac{G_{LA}(s)G_c(s)}{1+G_{LA}(s)H(s)G_c(s)}=\frac{K_pK_MK_J + K_dK_MK_Js}{s^2 + K_dK_MK_Js + K_pK_MK_J}$

Cálculo Aproximado de las constantes

Cálculo de la constante de Inercia

$$K_J = \frac{r}{J_T}$

$$J = \sum{m.r^2}$

$$J_T = 2(J_{motor} + J_{ESC} + J_{helice}) + J_{barra}$

$$J_{motor} = 52.{20,5}^2 [g.{cm}^2] = 21853 [g.{cm}^2]$

$$J_{ESC} = 32.{10}^2 [g.{cm}^2] = 3200 [g.{cm}^2]$

$$J_{helice} = 15.{20,5}^2 [g.{cm}^2] = 6303,75 [g.{cm}^2]$

$$J_{barra} = \frac{m.L^2}{12} = \frac{110.{51}^2}{12} [g.{cm}^2] = 23842,5 [g.{cm}^2]$

$$J_T = 86556 [g.{cm}^2]$

$$\boxed{K_J = \frac{21}{86556}[\frac{1}{g.cm}]}$

Cálculo de la constante del Motor

Según las mediciones realizadas podemos aproximar estas constantes.

$$K_{MPusher} = \frac{\Delta_F}{\Delta_D} = \frac{40}{3000}\frac{g}{cuentas}$

$$K_{MNormal} = \frac{\Delta_F}{\Delta_D} = \frac{70}{3000}\frac{g}{cuentas}$

Estabilización en modo común

En esta medición se trato de llevar el ángulo del PVTOL a cero seteando el pwm de un motor y ajustando el otro para que el ángulo sea 0.

Motor Normal	Motor Pusher
7700	5750
8350	7600
10100	11150
11750	14200

None: LabElectronica/ProyectoQuadricoptero/PVTOL_ControlDelAngulo (última edición 2010-09-24 23:27:14 efectuada por Jaarac)

-  ⇤ ← Versión 3 con fecha 2010-08-03 20:46:23 → 
  Tamaño: 1928
  Editor: Jaarac
  Comentario:
+   ← Versión 8 con fecha 2010-08-03 21:12:36 → ⇥
  Tamaño: 2708
  Editor: Jaarac
  Comentario:
-Los textos eliminados se marcan así.
+Los textos añadidos se marcan así.
 Línea 4:
+<<TableOfContents(6)>>
-Línea 7:
+Línea 10:
+$$$G_p = \frac{K_J}{s^2}$$
-Línea 28:
+Línea 33:
+{{attachment:FdTLA_PD.png || width="600"}}
-Línea 40:
+Línea 48:
+$$$K_J = \frac{r}{J_T}$$
-Línea 53:
+Línea 64:
+$$$\boxed{K_J = \frac{21}{86556}[\frac{1}{g.cm}]}$$

=== Cálculo de la constante del Motor ===
Según las mediciones realizadas podemos aproximar estas constantes.

$$$K_{MPusher} = \frac{\Delta_F}{\Delta_D} = \frac{40}{3000}\frac{g}{cuentas}$$

$$$K_{MNormal} = \frac{\Delta_F}{\Delta_D} = \frac{70}{3000}\frac{g}{cuentas}$$

==== Estabilización en modo común ====
En esta medición se trato de llevar el ángulo del PVTOL a cero seteando el pwm de un motor y ajustando el otro para que el ángulo sea 0. 
|| Motor Normal || Motor Pusher ||
|| 7700 || 5750 ||
|| 8350 || 7600 ||
|| 10100 || 11150 ||
|| 11750 || 14200 ||

Buscar

Herramientas