Professional Documents
Culture Documents
NACIONAL
ESCUELA SUPERIOR DE INGENIERA
MECNICA Y ELCTRICA
SECCIN DE ESTUDIOS DE
POSGRADO E INVESTIGACIN
T E S I S
QUE PARA OBTENER EL GRADO DE:
MAESTRO EN CIENCIAS
CON ESPECIALIDAD EN INGENIERA ELCTRICA
PRESENTA
2003
INGENIERA ELCTRICA
Gracias seor por permitirme vivir estos momentos con las personas que mas
quiero y te agradezco infinitamente por iluminar mi camino ayer hoy y siempre.
DEDICATORIA
A MIS PADRES
Abraham Herrera Daz y Herminia Espinosa, por su constante apoyo y buenos consejos
que siempre han tenido para la superacin de sus hijos. Con mucho amor y cario.
A MIS HERMANOS
Rosa Mara Irala Espinosa; Jos Joaqun Irala Espinosa y Jos Francisco Herrera Espinosa
por el apoyo y cario que siempre nos hemos dado.
A MI ESPOSA
y su cario que me
Francisco Javier Herrera Aguilera y Abraham Herrera Aguilera, que son una de las
satisfacciones ms grandes que Dios me ha dado en la vida y la razn de mi superacin.
A MI AMIGA
Jorge Ramrez Trujillo, por ser un hermano de corazn. Recuprate pronto hermano.
SEPI-ESIME
INGENIERA ELCTRICA
A LA MEMORIA
De Juan Manuel Carrillo Espinosa y Manuel Garca Rivas que me ensearon que lo ms
preciado que uno tiene es la vida, y que por ningn motivo hay que desperdiciarla.
AGRADECIMIENTOS
Al consejo
econmico brindado.
SEPI-ESIME
INGENIERA ELCTRICA
RESUMEN
En este trabajo se describe el anlisis, diseo y construccin de un regulador de
velocidad difuso tipo Takagi Sugeno para un arreglo motor de corriente directa (c.d.) alternador. El regulador difuso de velocidad se realiza a travs de la variacin del voltaje
de armadura del motor de
SEPI-ESIME
INGENIERA ELCTRICA
ii
SEPI-ESIME
INGENIERA ELCTRICA
ABSTRACT
Analysis, design and implementation of a fuzzy speed regulator type Takagi
Sugeno for a direct current motor - alternator set is presented in this thesis. The fuzzy
speed regulator by the variation of the armature voltage of the direct current motor is
tested in order to keep the alternator at a frequency of 60Hz, which is subjected to load
changes and short circuit failures.
Furthermore, the tuning algorithm for the fuzzy regulator based on the relations
between Mandanis and Takagi Sugenos mathematical models and a proportional
integral control is presented.
Simulations to validate the operation of the control are performed with the direct
current motor - alternator system subjected to load changes. After tuning the controller
the response the control system is stable.
Stability analysis
current motor - alternator system is done, using Kasuo Tanakas criteria. This criteria is
based upon Liapunovs second method. Its application is important for fuzzy regulators
design, because it allows to evaluate the system stability prior to its implementation.
Analysis results allowed to know that fuzzy regulator is stable under the operation
conditions proposed.
iii
SEPI-ESIME
INGENIERA ELCTRICA
The prototype was tested on a 1.8Kw 1.1KVA direct current motor alternator
set subjected to load changes, short circuit and fault liberation. In all the test results, the
system behavior was stable.
iv
SEPI-ESIME
INGENIERA ELCTRICA
INDICE
Pgina
Resumen.
Abstract.
iii
ndice.
Glosario.
ix
Lista de smbolos.
ix
Lista de figuras.
xii
Lista de tablas.
xv
Captulo 1: Introduccin.
1.1. Generalidades.
1.3. Justificacin.
1.4. Objetivo.
2.1. Introduccin.
12
15
15
18
19
SEPI-ESIME
INGENIERA ELCTRICA
Pgina
Captulo 3: Elementos fsicos de sistema de control.
23
3.1. Introduccin.
23
23
3.2.1. Alternador.
25
26
27
27
27
28
28
29
31
34
34
36
37
40
41
42
45
4.1. Introduccin.
45
45
47
49
vi
SEPI-ESIME
INGENIERA ELCTRICA
Pgina
4.5. Detalles del diseo y programacin de cada uno los bloques que
integran el programa del sistema de control
50
51
53
55
55
57
60
61
66
5.1. Introduccin.
66
66
79
6.1. Conclusiones.
79
80
80
Referencias.
81
85
A.1. Introduccin.
85
85
Constante.
vii
SEPI-ESIME
INGENIERA ELCTRICA
Pgina
92
97
101
103
107
107
108
109
Apndice F.
110
110
122
123
127
viii
SEPI-ESIME
INGENIERA ELCTRICA
GLOSARIO
Bauds
Buffer
Macro
Son lneas de programa que se ocupan ms de una vez, dentro del programa
principal. Su objetivo es el de minimizar el contenido de un programa,
permitiendo una programacin ms sencilla y entendible.
LISTA DE SIMBOLOS
A/D
a1
Es la constante del error actual cuando el valor absoluto del error es bajo.
a2
Es la constante del error actual cuando el valor absoluto del error es alto.
b1
Es la constante del error anterior cuando el valor absoluto del error es bajo.
b2
Es la constante del error anterior cuando el valor absoluto del error es alto.
BL
Bm
c.a.
Corriente alterna.
c.d.
Corriente directa.
DSP
e(k)
Error actual.
|e(k)|
e(k-1)
Error anterior.
fe
Frecuencia elctrica.
I1
Corriente de Campo.
IA
Corriente de armadura.
ix
SEPI-ESIME
INGENIERA ELCTRICA
IEEE
IGBT
ISR
Momento de inercia.
JL
Jm
Kexc
Kt
L11
Inductancia de campo.
LA1
LAA
Inductancia de armadura.
LME
Grado de membresa.
alto
bajo
PWM
R1
Resistencia de campo.
RA
Resistencia de armadura.
SCI
SEP
SEPI -ESIME
Te
Par electromagntico.
x
SEPI-ESIME
INGENIERA ELCTRICA
Tex
TL
Tt
u(k)
u1 (k)
Salida actual real evaluada cuando el valor absoluto del error esta en BAJO.
u2 (k)
Salida actual real evaluada cuando el valor absoluto del error esta en ALTO.
u1 (k-1)
Salida anterior real evaluada cuando el valor absoluto del error esta en BAJO.
u2 (k-1)
Salida anterior real evaluada cuando el valor absoluto del error esta en ALTO.
V1
Voltaje de campo.
VA
Voltaje de armadura.
Vcd
Vent.
Voltaje de entrada.
Vm
Voltaje medido.
VPWM
Voltaje modulado.
Vsal.
Voltaje de salida.
Vref.
Voltaje de referencia.
xi
SEPI-ESIME
INGENIERA ELCTRICA
LISTA DE FIGURAS
Pgina
CAPTULO 2
Figura 2.1.
10
Figura 2.2.
10
Figura 2.3.
11
Figura 2.4.
13
Figura 2.5.
13
Figura 2.6.
13
Figura 2.7.
13
Figura 2.8.
Respuesta a un escaln con :Kpb = 2, Kib =.20, Kpa = 3, Kpb =.20 p1 = .5,
p 2 =1.5.
Figura 2.9.
14
Figura 2.10
14
Respuesta a un escaln con: Kpb = 2, Kib =.22, Kpa = 2.9, Kpb =.25 p1 = .3
p 2 =.9.
14
Figura 2.11.
15
Figura 2.12.
Sistema de control.
16
Figura 2.13.
16
Figura 2.14.
20
CAPTULO 3
Figura 3.1.
23
Figura 3.2.
28
Figura 3.3.
Etapa de potencia.
29
Figura 3.4.
33
Figura 3.5.
34
Figura 3.6.
38
xii
SEPI-ESIME
INGENIERA ELCTRICA
Pgina
Figura 3.7.
39
CAPTULO 4
Figura 4.1.
46
Figura 4.2.
49
Figura 4.3.
52
Figura 4.4.
57
Figura 4.5.
59
Figura 4.6.
61
Figura 4.7.
62
Figura 4.8.
63
Figura 4.9.
65
CAPTULO 5
Figura 5.1.
Figura 5.2.
68
Figura 5.3.
68
69
Figura 5.4.
70
Figura 5.5.
70
xiii
SEPI-ESIME
INGENIERA ELCTRICA
Pgina
Figura 5.6.
Figura 5.7.
71
Figura 5.8.
72
Figura 5.9.
72
Figura 5.10.
73
Figura 5.11.
73
Figura 5.12.
74
Figura 5.13.
74
75
Figura 5.14.
75
Figura 5.15.
76
APNDICE A
Figura A.1.
Figura A.2.
85
para simulacin.
Figura A.3.
89
Simulacin del motor de corriente directa con el modelo lineal. (a) corriente
de armadura. (b) Velocidad angular.
Figura A.4.
89
Figura A.5.
90
90
xiv
SEPI-ESIME
INGENIERA ELCTRICA
Pgina
Figura A.6.
Respuesta
del
tipo rampa.
91
Respuesta del motor de c.d. con lazo de corrie nte. (a)Velocidad angular.
(b) Corriente de armadura. Kp=10,Ki=Kp/Ti=9.2.
Figura A.8.
91
Figura A.9.
92
Figura A.10.
93
Figura A.11.
93
de VA tipo rampa.
Figura A.12.
94
VA tipo rampa.
Figura A.13.
94
VA tipo rampa.
95
95
LISTA DE TABLAS
APNDICE A
Tabla A.1.
87
xv
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 1
INTRODUCCIN
1
CAPTULO
1.1 Generalidades
Los motores de corriente directa (c.d.), son mquinas de c.d. que producen energa
mecnica a partir de energa elctrica de c.d. Estos dispositivos hasta hace algunos aos,
fueron indispensables en aplicaciones en donde se requeran amplias variaciones en la
velocidad, sin embargo con la miniaturizacin de los elementos en estado slido, los
motores de induccin con paquetes de accionamiento se han hecho mas competitivos. Esto
se debe a que los motores de c.d. requieren mayor mantenimiento debido a la existencia del
conmutador y las escobillas. A pesar de ello, los motores de c.d. no se podrn dejar de
utilizar repentinamente, ya que
aplicaciones industriales y una gran cantidad de ellos cuentan con una larga vida til.
En el campo del control de velocidad de los motores de c.d, adems de poder aplicar
las tcnicas convencionales del control se pueden aplicar tcnicas de control inteligente,
como lo es la lgica difusa. Dentro de la lgica difusa, existen dos algoritmos muy
conocidos que son: Mamdani y Takagi Sugeno [1,2]. Estos algoritmos han tenido gran
utilidad en aplicaciones reales, ya que existen actualmente avances significativos en
microelectrnica y electrnica de potencia. [3, 4, 5, 6, 7, 8, 9, 10].Una de las herramientas
ms poderosas que han aparecido en el mercado de la microelectrnica, lo constituyen los
procesadores de seales digitales (DSP) ya que presentan gran versatilidad en su
programacin [11,12]. Dentro de sus caractersticas de programacin ms importantes
destaca el procesamiento en paralelo, ya que esto permite hacer operaciones de
multiplicacin en un solo ciclo de reloj.
1
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 1
Inglaterra, Ebrahim Mamdani us la lgica difusa para controlar una mquina de vapor, la
cual no poda tener bajo control con tcnicas convencionales. Por tal razn se le debe la
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 1
Inspirados los japoneses por las primeras aplicaciones Europeas las compaas
comenzaron a usar la lgica difusa. Una de ellas fue en una planta de tratamiento de agua
por Fuji Electric en 1983 y un sistema del metro por Hitachi que oper en 1987 [17]. A
mediados de 1985 Tomohiro Takagi y Michio Sugeno proponen un nuevo modelo de
control difuso que se emplea en un proceso de limpiado de agua y en un convertidor que se
utiliza en el proceso de hacer acero [2]. En ese mismo ao dos hombres Japoneses Masaki
Togai y Hiroyuki Watanabe inventaron el primer circuito integrado difuso, lo cual provoc
que muchas compaas empezaran a interesarse por el circuito integrado para
implementarlo en sus sistemas.
lgica difusa, dado que fabrica actualmente aparatos de la industria de consumo, tales como
vdeo cmaras, cmaras fotogrficas, televisores, lavadoras, componentes de carros
japoneses, entre otros [3].
exitosos han sido lanzados al mercado Europeo. Adems, han tenido xito con el uso de la
lgica difusa un incontable nmero de aplicaciones en el control de procesos y en
automatizacin industrial [17].
En los 90s se desarrollaron varios trabajos con lgica difusa que sirvieron como
base para la realizacin de la tesis y que fueron desarrollados por:
Timothy A. Adcock en 1993 [4]. l reporta una breve descripcin de la lgica difusa
en forma general y describe detalladamente el algoritmo de Mamdani. Este algoritmo
es implementado en un procesador de seales digitales TMS320C14 para el control de
un Servo Motor.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 1
Daz Garca Luis M [8]. En su trabajo desarrolla una tarjeta para el control difuso de
velocidad de un motor de c.d. basado en el paquete FUDGE. En el se muestra el
diseo y construccin de un sistema de control de velocidad difuso para un motor de
corriente directa mediante el microcontrolador 68HC11. El algoritmo de control usado
fue el de Mamdani. El programa determina el ngulo de disparo de los tiristores del
semiconvertidor monofsico controlado por fase permitiendo con ello variar la
velocidad del motor por voltaje de armadura.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 1
Un trabajo que no emplea lgica difusa pero que ayudo a la elaboracin de la tesis es:
1.3 JUSTIFICACIN
2.-
1.4 OBJETIVO
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 1
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 1
En el Captulo 5
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
CAPTULO
2.1 INTRODUCCIN
A partir de la publicacin en 1965 del repote llamado conjuntos difusos hecho por
Lotfi Zadeh, profesor
desarroll
cuenta con
mltiples valores. En lugar de que sea 100% verdadero o falso la lgica difusa considera
grados de verdad, esto quiere decir que una proposicin puede ser parcialmente verdadera
o parcialmente falsa [3].
Con la lgica difusa se pueden disear aplicaciones para que las mquinas
respondan con mayor inteligencia a la imprecisin y a las condiciones del mundo exterior,
con lo que se busca imitar el comportamiento humano. La creacin de una mquina con
lgica difusa, es la creacin de un sistema experto, en donde el comportamiento de la
mquina, va ha estar basado totalmente en el conocimiento del experto o de la persona que
aporta sus conocimientos empricos para el funcionamiento de sta.
En los ltimos aos el control difuso ha surgido como una de las reas ms activas
en la aplicacin de la teora de los conjuntos difusos. Los controles difusos estn basados en
la lgica difusa, que es lo ms cercano al pensamiento humano y a los sistemas lgicos
tradicionales. En esencia un controlador
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
Dentro de la lgica difusa existen dos mtodos muy conocidos que son: Mamdani
y Takagi Sugeno [1,2]. De estos dos mtodos el algoritmo que emplearemos para el control
de velocidad ser el de Takagi Sugeno. La razn principal radica en que este algoritmo
tiene la caracterstica de ocupar muy poco espacio de memoria, cuando se realiza la
programacin para la implementacin en sistemas simulados o en sistemas fsicos
experimentales.
La caracterstica antes mencionada puede ser vista en la figura 2.1 ya que en ella se
muestra la comparacin en diagrama a bloques del algoritmo de Takagi Sugeno y el
algoritmo de Mandami [1, 2, 6].
Para describir en este apartado como se obtuvo el diseo del regulador de velocidad
para el arreglo motor de c.d. alternador empleando el algoritmo de Takagi Sugeno, es
necesario auxiliarnos de la figura 2.1.
En ella se puede ver que se necesita una etapa de generacin de valores difusos
mediante funciones de membresa de entrada. Para ello consideraremos las funciones de
membresa de tipo trapezoidal tal como lo muestra figura 2.2.
La abscisa corresponde al valor absoluto del error siendo este, el valor absoluto de
la diferencia existente entre un valor de referencia y un valor medido.
La ordenada corresponde al grado de membresa del valor absoluto del error, siendo
este la salida difusa.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
Algoritmo de Mandami
Entradas
Valores
Reales
Funciones de
Membresa de
Entrada
Entradas
Valores
Reales
Generacin de
Valores
Difusos
Funciones de
Membresa de
Entrada
Salidas
Difusas
Reglas
Generacin de
Valores
Difusos
Salidas
Difusas
Evaluacin de
reglas
Reglas
Salidas
Reales
Evaluacin de
reglas
Salidas
Difusas
Funciones de
Membresa de
Salida
Generacin de
Valores
Reales
Salidas
Reales
ALTO
BAJO
Xo
X1
Una vez que se obtiene la salida difusa, se puede ver en la figura 2.1 que la siguiente
etapa es la evaluacin de reglas. Un anlisis que se desarroll en la referencia [6] llevo a
que esta etapa poda ser evaluada por la siguiente ecuacin:
10
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
u(k) =u(k-1)+ae(k)-be(k-1)
con :
(2.1)
figura 2.2,
se puede construir un control difuso con el modelo de Takagi Sugeno como sigue:
(2.2)
(2.3)
La salida real que se muestra en el ltimo bloque del algoritmo de Takagi - Sugeno
de la figura 2.1 es obtenida de la siguiente ecuacin:
u(k) =
(2.4)
El esquema bsico del controlador difuso tipo Takagi Sugeno aplicado al control
de velocidad de un arreglo motor de c.d. - alternador se muestra a continuacin:
V ref.
Absoluto
Adquisicin
de Datos
e(k)
e(k)
Funciones de alto
Memebresia bajo
e(k)
-1
e(k-1)
Algoritmo de
Takagi-Sugeno
Salida
Real
Ecuaciones de
Diferencia
u(k)
u 1(k)
u 2(k)
Arreglo
Motor de c.d - alternador
Figura 2.3. Diagrama a bloques del regulador de velocidad difuso tipo Takagi Sugeno
para el arreglo motor de c.d. - alternador.
11
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
Este algoritmo
pasos:
1. Ajustar Ki en el mnimo para ambas regiones del error. Al ajustar los valores de las
constantes en ambas regiones en el mismo valor, se comporta como si fuera una
sola regla un control PI convencional.
2. Ajustar el valor mximo permitido de Kp para ambas regiones del error, antes de
que oscile el sistema.
3. Ajustar Ki en las regiones de error bajo y alto en un valor que de una respuesta
sobreamortiguada.
4.
Ajustar las funciones de membresa de error alto y bajo de forma conservadora por
ejemplo, si se tiene p1=.15 y p2=.3 se puede cambiar por p1=.2 p2=.4 .
5.
7. Disminuir
el valor de
oscilaciones y sobretiro.
8.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
9. Cada vez que se ajusten las funciones de membresa de error alto y bajo de la misma
forma como se realizo en el paso 4 hay que repetir los pasos 5,6,7,8 hasta obtener
una transicin mnima.
La aplicacin de este algoritmo al regulador de velocidad para el arreglo motor de c.d.alternador, se puede ver en la serie de figuras de la 2.4 a la 2.11, donde Kpb,Kib son
las ganancias proporcional e integral para la regin de error bajo, Kpa ,Kia son las
ganancias proporcional e integral para la regin de error alto respectivamente y p1 y
383
383
381
381
379
379
377
377
375
Velocidad(rad/seg)
Velocidad (rad/seg)
,p2, son los puntos de cruce con cero de las funciones de membresa.
373
371
369
367
375
373
371
369
367
365
365
363
363
361
361
359
9
9.5
10
10.5
Tiempo (seg.)
11
11.5
359
9
12
10
10.5
Tiempo(seg)
11
11.5
12
383
383
381
381
379
379
377
377
375
Velocidad(rad/seg)
Velocidad(rad/seg)
9.5
373
371
369
367
365
375
373
371
369
367
365
363
363
361
361
359
9
9.5
10
10.5
Tiempo(seg)
11
11.5
12
359
9
9.5
10
10.5
11
11.5
12
Tiempo(seg)
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
383
381
379
Velocidad(rad/seg)
377
375
373
371
369
367
365
363
361
359
9
9.5
10
10.5
Tiempo(seg)
11
11.5
12
Figura 2.8. Respuesta a un escaln con: Kpb = 2, Kib =.20, Kpa = 3, Kpb =.20 p1 = .5, p 2 =1.5
383
381
379
Velocidad(rad/seg)
377
375
373
371
369
367
365
363
361
359
9
9.5
10
10.5
Tiempo(seg)
11
11.5
12
Figura 2.9. Respuesta a un escaln con: Kpb = 2, Kib =.20, Kpa = 3, Kpb =.20 p1 = .3, p2 =.9
383
381
379
Velocidad(rad/seg)
377
375
373
371
369
367
365
363
361
359
9
9.5
10
10.5
Tiempo(seg)
11
11.5
12
Figura 2.10. Respuesta a un escaln con: Kpb = 2, K ib =.22, K pa = 2.9, K pb =.25 p 1 = .3, p 2 =.9
14
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
383
381
379
Velocidad(rad/seg)
377
375
373
371
369
367
Figura 2.8
Figura 2.9
Figura 2.10
365
363
361
359
9
9.5
10
10.5
Tiempo(seg)
11
11.5
12
(2.5)
15
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
y por medio de la frmula de Masons, tal y como se observa en la figura 2.12 se obtienen
las ecuaciones en variables de estado en forma discreta:
x (k + 1) = x( k ) + e( k )
u (k ) = ( a b) x( k ) + ae (k )
(2.6)
a
e(k)
z -1
x(k)
u(k)
-b
1
Figura 2.12. Sistema de control.
e(k)
r(k)
Control
Xi+1 (k)....X n (k)
r(k)
u(k)
Sistema
equivalente
X1(k),X 2(k)....Xn (k)
Planta
X1(k),X2(k)....Xi(k)
y(k)
y(k)
Figura 2.13. Diagrama a bloques de una planta con control y sistema equivalente.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
(2.7)
(2.8)
(2.9)
(2.10)
(2.11)
(2.12)
(2.13)
17
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
w (k ){ A
i
x (k + 1) =
eqi
i =1
x( k ) + Beqi r ( k )}
(2.14)
w (k )
i
i =1
donde:
l=2
wi = Implica el grado de verdad de la regla i.
y el sistema libre esta representado por:
w (k ) A
i
x (k + 1) =
eqi
i =1
x( k )
(2.15)
w (k )
i
i =1
con: l = 2.
2.4.2
para asegurar la
estabilidad de la ecuacin (2.15) ha sido analizada en [20, 21 ,22], a partir del siguiente
teorema:
(2.16)
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
Se puede notar que la ecuacin (2.16) depende solo de Ai, en otras palabras no
depende de wi. Este teorema es reducido al teorema de estabilidad de Liapunov para
sistemas discretos lineales cuando l =1.
2.4.3
(2.17)
La funcin de transferencia del sistema equivalente obtenida del diagrama a bloques del
apndice A (ecuacin A.9) es:
ft =
0.578952
0.0001244 s + 0.0149895s + 0.340526
2
x = Ax + Bu
y = Cx
con:
120.5
A=
1
- 2737.3
1
; B = ;
C = [0
4654 ] ;
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
con
0.1969600
A=
0 .0059848
- 16.38200
0.59848
; B=
;
0.91809
0.0029924
C = [0.13926 44.633] ;
El regulador de velocidad del arreglo motor de c.d. alternador con las ecuaciones
de membresa como las de la figura 2.14 esta representado por las siguientes ecuaciones:
ALTO
BAJO
.35
.9
0.13167000
0.00065824 ;
1.00000000
Beq1
1.32867000
= 0.00664224
1.00000000
20
SEPI-ESIME
INGENIERA ELCTRICA
A eq2
CAPITULO 2
- 0.86265273070360
Beq2 =
0.28820207616699
- 0.13660811909041 - 0.28701210517354
A1 A 2 =
0.11461127935842 - 0.31151198640868
- 0.13660811909041 - 0.11461127935842
A 2A 1 =
0.28701210517354 - 0.31151198640868
Los eigenvalores de A1 A2 y A2 A1 son:
-0.22406005274954 + 0.15889299501416i
-0.22406005274954 - 0.15889299501416i
21
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 2
- 0.36547558223151 1.38811252212837
1.70910744797213 - 0.30050503689586
P2 =
- 0.30050503689586 1.63665470878196
3.-
Probar que al menos una de las matrices P es la solucin comn para la ecuacin
(2.16).
R1 = A1T P2 A1 P2
R2 = A2T P1 A2 P1
- 1.00662958983824 - 0.13607266438124
R1 =
- 0.13607266438124 - 1.20091394890496
- 1.00104979805824 0.12775141091554
R2 =
0.12775141091554 - 0.80828631636748
Se calculan los eigenvalores para R1
0.93658213740747
1.27096140133574
Se calculan los eigenvalores para R2
1.06469887599254
0.74463723843317
22
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
CAPTULO
3.1 INTRODUCCIN
En este captulo se detallar cada elemento fsico que forma parte de la
implementacin del regulador de velocidad tipo Takagi Sugeno para el arreglo motor de
c.d. alternador.
ETAPA DE
M cd
POTENCIA
TRANSDUCTOR
DE VOLTAJE
ref=377rad/seg (2.4V)
DSP TMS320F240
PWM
CONTROL
LOGICA
DIFUSA
|error|
Absoluto
0-5Vcd
+
-
error
A/D
regulador de
velocidad.
23
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
Adecuando el
valor de voltaje mediante una etapa de entrada del control, se introduce el valor a
tarjeta de evaluacin del DSP, por medio del convertidor analgico digital
la
que se
Las tcnicas de lgica difusa sern las encargadas de producir una seal de salida
que provocar la modulacin del ancho de pulso. Dicha tcnica es generada en el DSP y
es la responsable de controlar la velocidad del motor de c.d.
Como el motor maneja altas corrientes, comparadas con las que se manejan en la
tarjeta, es necesario adecuar la seal PWM mediante una etapa de potencia. Esta etapa
esta constituida principalmente por un inversor, un opto acoplador, un IGBT, un excitador
(drivers) y una fuente de corriente directa.
24
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
y las
3.2.1. Alternador.
Un alternador es
La
fe =
nm P
120
(3.1)
En este caso, como el generador es de dos polos el rotor debe girar a 3600 r.p.m.
para generar una frecuencia de 60Hz.
depende de la velocidad de
rotacin de su eje y la magnitud del flujo del campo. La diferencia entre el voltaje en
terminales de cada fase y el voltaje generado internamente radica principalmente en las
cadas de potencial de la resistencia y la reactancia interna del los embobinados del
inducido (en el estator).
El voltaje en las terminales del alternador ser igual al voltaje por fase bien,
ser
necesario relacionarlo
Cuando un alternador
determinadas por la carga, por lo que las variaciones del gobernador y la corriente de
campo son las que controlan la frecuencia y el voltaje nominal respectivamente.
25
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
Cuando el alternador se conecta con un bus infinito su frecuencia y voltaje son fijos,
de tal manera que las variaciones del gobernador y de la corriente de campo, controlan los
flujos de la potencia real y reactiva del alternador.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
27
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
+5
V
Vt
1K
39
1N4007
A/D
33 F
8.2K
1N4007
47 F
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
0.7H
Mcd
RPG10D
+ 15 VCD
+ 15 VCD
120
8
3
1F
INVERSOR
7404
2.7K
3 9
10 HIN
HO 7
12 LIN
LO 1
11 SD
6 Vb IR2110
5 Vs
COM
VDD
VCC
PWM
Pin 12
del DSP
IGBT
47nF
1MH60-100
RPG10D
33
26
ECG3095
2
Inversor.
Este dispositivo tiene la finalidad de invertir la seal PWM que sale del procesador
de seales digitales y proporciona la corriente necesaria para manejar el led. La clave del
inversor empleado en el proyecto es 7404.
29
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
Opto acoplador.
objetivo de esto, es el de
evitar la
introduccin de niveles de voltaje y corriente por parte de la etapa de potencia, que daen el
funcionamiento de dicha tarjeta.
En este trabajo se emple el opto acoplador ECG 3095, cuya unidad sencilla fue
usada en las aplicaciones de las referencias [26,27].
Excitador (driver)
Al IGBT
30
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
El diagrama funcional y las dems especificaciones tcnicas del inversor, del opto
acoplador, del driver y del IGBT, se muestran el apndice B. La eleccin de cada uno de
ellos, se tom en base a las especificaciones tcnicas del motor de c.d.
3.3.
31
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
La
diagrama
esquemtico de la tarjeta de
evaluacin.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
Los voltajes de corriente directa que se tienen en las terminales 2 y 19 del conector P1,
servirn para alimentar al inversor que se localiza en la etapa de potencia que se ocupa
para el control de la velocidad del motor, mientras que las terminales 1 y 33, alimentarn al
circuito de proteccin que se tiene en el divisor de voltaje mostrado en la figura 3.2.
33
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
apartado
se
describir
las
Texas Instrument.
caractersticas
generales
dispositivo
posteriormente se explicarn con detalle las partes del procesador empleados para el
desarrollo del proyecto.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
Controles de programa:
- Ocho Niveles de operacin Pipeline .
- Seis interrupciones externas: Proteccin contra controles de potencia, reseteo
( Reset ), interrupciones no mascarables (NMI) y tres interrupciones
mascarables.
35
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
Conjunto de instrucciones:
- Cdigo compatible con las familiaTMS320C5x.
- Multiplicacin y adicin en un ciclo de reloj.
- Movimiento de memoria de programa a memoria de datos y viceversa.
- Capacidad de direccionamiento indexado.
Velocidad: 50s (20 MIPS) por instruccin de un solo ciclo de reloj.
Manejador de eventos ( las partes que contiene este elemento se describirn en forma
detallada en el siguiente apartado ).
Mdulo de conversin analgico digital (ADC) de 10 bits con 6s de tiempo de
conversin y 16 entradas analgicas, divididas en dos bloques de ocho entradas cada
uno, lo que permite la lectura de dos canales a la vez.
28 lneas de entrada/salida multiplexadas.
Interfase de comunicacin serial (SCI).
Interface perifrica serial.
El
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
- TxPR (x = 1, 2, 3). Este registro es el que permite definir el periodo de la seal PWM.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
TxPR
Registro del perido
TxCMP
Registro de
comparacin
T1PR
Registro del perido
MUX
Comparacin
Logica
TxCNT
Contador de reloj del GP
Reloj
Interno del
CPU
Control
Logico
Generador de forma de
onda
Simetrica/Asimetrica
GPTCON
Registro de control del
reloj GP
Salida
Logica
TxPWM/
TxCMP
Banderas
de
Interrupcin
Inicio del
ADC
TMRCLK
TMRDIR
TxCON
Registro de control del
GPTx
descendente.
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
donde:
(3.2)
cumplirse este,
original.
Periodo1
PWM
Periodo2
PWM
Punto de
comparacin
+
+
Punto de
comparacin
mas grande que el
periodo
TxPWM/TxCMP
Activacin en bajo
Inactivo
Activo
TxPWM/TxCMP
Activacin en alto
+ Punto de comparacin
39
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
Este mdulo genera eventos que pueden ser tratados por interrupciones y que se
encuentran agrupados en tres bloques llamados A,B,C. Las fuentes ms comunes de
interrupcin empleando temporizadores de propsito general son:
1.- IMR: Este es el registro de mscaras de interrupcin, el cual habilita o no los seis
primeros niveles de interrupcin.
2.- IFR: Este es el registro de las banderas de interrupcin, el cual permite conocer el
estado de las fuentes de interrupcin. Escribiendo un 1 en el bit correspondiente se
limpia esa solicitud de la interrupcin.
3.- EVIMRA, EVIMRB, EVIMRC: Estos son los registros de las mascaras de
interrupcin de cada una de las fuentes de interrupcin del modulo manejador de
eventos.
40
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
4.- EVIFRA, EVIFRB,EVIFRC: Estos son los registros de las banderas de interrupcin
de cada una de las fuentes de interrupcin del modulo manejador de eventos.
En este trabajo se programo la interrupcin por periodo del temporizador uno, para
generar el tiempo de muestreo en nuestro programa. La forma de programacin de los
registros se vera en el capitulo siguiente.
(3.3)
41
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
En este proyecto se utiliza el canal 1 para medir la velocidad del generador. Este
valor se almacena en la variable TEMP cada que existe una interrupcin por periodo en el
manejador de eventos.
el
el
El esquema general del modulo SCI se muestra despus del convertidor A/D que se
encuentra en el apndice E, el cual presenta las siguientes caractersticas:
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
empadronamiento (polled).
-
Formato NRZ.
1.- SCICCR: Este es el registro de control para la comunicacin, el cual define el formato
para los caracteres, el protocolo y el modo de comunicacin del SCI.
3.- SCICTL2: Este es el registro dos de control del SCI, en el cual se habilita/deshabilita la
interrupcin por transmisin y/o recepcin y permite mediante el bit 7 (TXRDY) checar si
el dato del buffer ha sido transmitido.
4.- SCIHBAUD: Este registro guarda los datos (bits ms significativos), que son
necesarios para configurar la velocidad de comunicacin.
5.- SCILBAUD: Este registro guarda los datos (bits menos significativos), que son
necesarios para configurar la velocidad de comunicacin.
6.-
recepcin de datos.
43
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 3
graficaron
velocidad.
en
Los valores que tomaron cada registro para la configuracin del SCI, se
44
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
PROGRAMA DEL
SISTEMA DE CONTROL
4
CAPTULO
4.1 INTRODUCCIN
En este captulo
estructura y
convertidor
analgico digital que se tiene incorporado en la tarjeta de evaluacin y que fue descrito en
el apartado 3.4.3 del captulo 3.
45
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
TMS320F240
Vref.
Absoluto
Convertidor
A/D
Vm
e(k)
e(k)
Funciones de
Memebresia
alto
bajo
e(k)
-1
e(k-1)
Algoritmo de
Takagi-Sugeno
Salida
Real
Ecuaciones de
Diferencia
u(k)
PWM
u1(k)
u2(k)
VPWM
Vcd
Circuito
de Potencia
VPWM
Amplificado
Tansductor/ Divisor
de voltaje
Motor
de
c.d
Acoplamiento
Generador
El error (e (k)) y su valor anterior (e (k-1)) sirven para evaluar las ecuaciones de
diferencia dadas en las ecuaciones 2.2 y 2.3 del captulo 2. Los valores obtenidos por estas
ecuaciones completan la ecuacin 2.4.
46
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
motor de c.d.
La consecuencia de controlar la
velocidad del motor es la regulacin de frecuencia del alternador ya que estos dispositivos
estn acoplados mediante su rotor.
El programa escrito para realizar el sistema de control mediante este algoritmo fue
escrito en lenguaje ensamblador del procesador de seales TMS320F240 de Texas
Instrument. El listado completo del mismo se muestra en el apndice F y esta estructurado
de la siguiente forma:
Programa principal.
En este bloque se hace arrancar el motor de c.d. a tensin reducida. La razn de este
tipo de arranque es evitar que la demanda de corriente que necesita inicialmente el motor
para moverse sea mnima, logrando de esta manera que el IGBT que se emplea en la
etapa de potencia no se dae ( se recomienda leer el apndice A ).
47
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
Este algoritmo se realiza cada vez que se obtiene una medicin de voltaje en el A/D
(50 s) e incluye las siguientes rutinas:
a)
b)
c)
d)
e)
f)
voltaje.
de
48
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
Inicio
No
BANDERA1=1
Si
No
BANDERA2=1
Si
BANDERA1=0
MACRO OBT_ABS_ERROR
(Programa para obtener el error y el absoluto del error)
CALL PANTALLA
(Llama a la rutina para mandar datos a pantalla)
BANDERA2=0
MACRO OBT_ABS_ERROR
( Programa para obtener el error y el absoluto del error)
CALL MEMBERSHIP
(Llama a la rutina para obtener el grado de membresia)
CALL IMPLICACIONES_SUGENO
(Llama a la rutina para obtener u_bajo y u_alto)
CALL SALIDA_ REAL
(Llama a la rutina para obt. valor que modulara el PWM )
CALL PWM_OUT
(Llama a la rutina para modular el ancho de pulso )
CALL PANTALLA
(Llama a la rutina para mandar datos a pantalla)
Si
PWM<= Vnominal
No
linker, utiliza un archivo con extensin cmd, en el cual se definen todas las
49
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
1.- Memoria de programa (Pgina 0): Se utiliza para colocar el cdigo de programa y los
vectores de interrupcin. El origen de la memoria es 40h y su longitud es 65472 bytes.
2.-
Memoria de datos DRAM (Bloque B1): Es la zona en donde se encuentran todas las
El listado completo del archivo con extensin cmd se encuentra en el apndice F.2.
En este archivo
del archivo
Para poder detallar el diseo y la programacin de los distintos bloques con los
que cuenta el programa del sistema de control, lo dividiremos de la siguiente manera:
- Etapa de entrada.
- Etapa de arranque.
- Etapa del control.
- Etapa de salida.
50
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
Esta etapa corresponde a los mecanismos que se llevaron a cabo, para digitalizar el
voltaje en c.d. La descripcin de esta etapa se realiza a continuacin:
El convertidor A/D incorporado en la tarjeta de evaluacin, adquiere mediante su
canal cero, un voltaje de c.d. del divisor que fue mostrado en la figura 3.2, cada vez que
termina un periodo de la seal PWM (50s).
La etapa de arranque del programa de control se ejecuta hasta que el motor alcanza
su velocidad nominal (3600 r.p.m). Alcanzado
este valor,
CONT que aparece en la rutina de servicio de la figura 4.3 es un contador que tiene la
funcin de cambiar el tiempo de muestreo.
51
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
ADCTL1
ADCTL2
ISR A/D
TEMP = ADCFIFO1,10
(Lectura del A/D)
No
Si
Incrementa
contador
CONT=CONT+1
RET
El valor del pre -escalador elegido fue 12, para garantizar los requerimientos del la
ecuacin 3.3, con un reloj de 100s, obtenindose as un tiempo de conversin de 7.2s.
52
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
IMR
EVIMRA
Como su nombre lo indica, esta etapa permite arrancar al motor de c.d a tensin
reducida y llevarlo mediante esta forma a su velocidad nominal. El motivo de la etapa, es
el de minimizar el valor de las corrientes que demanda el motor de c.d. durante el arranque
y, para proteccin del IGBT empleado en la etapa de potencia que fue descrita en el
apartado 3.2 del captulo 3. El bloque que constituye esta etapa viene dado en la figura 4.2
con el nombre de Arranque del motor a tensin reducida.
es
[32,33]. En el apartado 3.4.2.1 del captulo 3 se vio con detalle la forma de generar la seal
PWM, en el cual los registros TXCMPR son los encargados de llevar la seal de
comparacin, mientras que los temporizadores TXCNT son los causantes de generar la
seal triangular de tipo asimtrica tal y como fue mostrada en la figura 3.7 del captulo 3.
En
la etapa de
53
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
LACC T1CMPR
ADD #1h
SACL T1CMPR
En nuestro programa el
y el valor del
registros en el
diseo:
54
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
GPTCON
T1CON
T1PR
T1CNT
OCRA
En esta etapa se explica con detalle los mdulos que integran el control difuso tipo
Takagi Sugeno, cuyo objetivo es el de controlar la velocidad del motor de c.d. y a su vez
la frecuencia del alternador.
4.5.3.1 Obtencin del error, el absoluto del error y sus valores anteriores.
En la figura 4.1 se puede ver que el error e(k) es la variable de entrada al control, la
cual se manipula para obtener el error anterior e(k-1), el absoluto del error |e(k)| y el valor
absoluto del error anterior |e(k-1)|.
programa principal de la figura 4.2., contiene las lneas de programa causantes de generar
estas variables. A continuacin se muestran dichas lneas:
55
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
OBT_ABS_ERROR .macro
LDP #ERROR
LACC ERROR
SACL ERROR+2
LACC ERROR+1
SACL ERROR+3
LAR AR0,#TEMP
MAR *, AR0
LACC #01EAh
SUB *
SACL ERROR
ABS
SACL ERROR+1
.endm
El valor
valor de referencia que equivale a la velocidad nominal del motor (3600 r.p.m.). Si se le
resta a este valor la variable TEMP (voltaje de c.d. medido del divisor), se produce la
variable e(k). Para la obtencin del |e(k)| se emplea el comando ABS mientras que para la
obtencin de los valores anteriores e(k-1) y |e(k-1)|, se guardan los valores del e(k) y
|e(k)| al principio de cada ejecucin del macro.
obtener un e(k-1) diferente de cero en el momento de ejecutase por primera vez la etapa de
control, logrando evitar as, aumentos sbitos de voltaje por seal PWM, que daaran al
IGBT.
ocasionando
que el
56
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
Entrada de
la etapa
de control
4500
e(k-1)-velocidad (rpm)
4000
Etapa de
Arranque
3500
3000
2500
2000
1500
Velocidad vs Tiempo
Error anteior vs Tiempo
1000
500
0.5
1.5
2.5
3.5
Tiempo (seg)
de
este,
se
emplean
en
los
bloques
MEMBERSHIP
Para poder tener la variable de salida (dada por la ecuacin 2.4 del captulo 2) que
sirve para controlar la velocidad del motor de c.d. por medio del algoritmo de Takagi Sugeno, es necesario haber obtenido antes el grado de membresa y haber evaluado las
ecuaciones de diferencia 2.2 y 2.3 del captulo 2.
tres regiones de evaluacin del |e(k)| que fueron importantes para la programacin:
57
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
En
Xo .
X1 .
la segunda regin ( Xo < |e(k |<X1 ) los grados de membresa tienen que ser
bajo =
alto =
X1 e( k )
(4.1)
X1 X 0
e( k ) X 0
(4.2)
X1 X 0
La obtencin de bajo y alto por medio de la ecuacin 4.1 y 4.2 se debe a las
pendientes existentes en las funciones de tipo trapezoidal BAJO y ALTO. En la tercera
regin ( |e(k)|
MEMBERSHIP fue:
58
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
Rutina
MEMBERSHIP
Incrementa apuntador de
tabla ( INC_T )
Si
|e(k)| <= Xo
No
BAJO=FFh(Q8)
A L T O=00h(Q8)
Incrementa apuntador de
tabla ( INC_T )
|e(k)| < X
No
1
RET
Si
DIVISOR =
X1 - X o
MACRO BAJADAS
MACRO SUBIDAS
La variable INC_T que aparece en diagrama de flujo de la figura 4.5 tiene como
objetivo obtener Xo
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
El valor de FFh en Q8 cubre los requisitos dados por la figura 2.2 del capitulo 2.
Para ver el modo en que se implemento el diagrama de flujo en lenguaje ensamblador, es
necesario ver el listado del programa de control que se encuentra en el apndice F.
Para evaluar las ecuaciones de diferencia 2.2 y 2.3 del captulo 2 se utiliz la rutina
denominada IMPLICACIONES_SUGENO. El diagrama de flujo de esta rutina pude ser
vista en la figura 4.6, mientras que su programacin en lenguaje ensamblador se encuentra
en el apndice F. En el diagrama de flujo de la figura antes mencionada, se puede ver que
las ecuaciones de diferencia 2.2 y 2.3 del captulo 2 sufrieron dos tipos de modificaciones.
La primera correspondi a un cambio de variable ( u1 (k)= ubajo , u2 (k)= ualto, a1 = ab a2 = aa,
b1 = bb y b2 = ba ) y la segunda la eliminacin del termino u(k-1) ya que este valor se
encuentra implcito en la rutina PWM.
ab, aa ,ba y bb
ab = 47h = 2.21875
bb = 40h = 2.00000
aa = 68h = 3.15000
ba = 60h = 3.00000
60
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
Rutina
IMPLICACIONES_SUGENO
No
e(k)<0
El producto ab*|e(k)|
queda positivo
Se clculo
bb*e(k-1) ?
Si
No
El producto bb*|e(k-1)|
queda positivo
Si
e(k-1)<0
No
Si
ubajo=ab*|e(k)| - bb*e(k-1)
Ret
Se clculo
ualto?
2
1
No
e(k)<0
No
El producto aa*|e(k)| queda
positivo
Si
Niega el producto (aa*|e(k)|)
2
Se clculo
ba*e(k-1) ?
Si
ualto=aa*|e(k)| - ba*e(k-1)
No
El producto ba*|e(k-1)|
queda positivo
No
e(k-1)<0
Si
Niega el producto(ba*|e(k-1)|)
La etapa de salida permite evaluar la ecuacin 2.4 del captulo 2 y manda los datos
de la seal PWM a pantalla, logrando ver as el comportamiento del control de velocidad.
Las rutinas SALIDA _ REAL, PWM_OUT y PANTALLA que se encuentran en la figura
4.2, realizan estas funciones. La forma en que lo hacen se describe a continuacin.
61
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
Una vez obtenido los valores difusos y haber evaluado las ecuaciones de diferencia
en las rutinas MEMBERSHIP e IMPLICACIONES_SUGENO correspondientes a la etapa
de control, el programa entra a la etapa de salida.
Rutina
SALIDA_REAL
RET
En la figura 4.7 el registro DIVISOR se emplea para guardar la suma de los grados
de membresa (ALTO + BAJO) y, el registro out _ real tiene la funcin de guardar el
resultado de la evaluacin. El valor de este registro, corresponde a la variable de salida del
control tipo Takagi Sugeno y cuyo formato es Q5. Debido a la necesidad de tener una
seal modulada al 0-100% el valor es transformado al formato Q0.
La rutina encargada de cambiar el formato del valor del registro out _ real
desplazamiento
por
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
Mediante el primer bloque condicional de la figura 4.8, se puede ver que el cambio
del formato de la variable out _ real no se realiza de forma inmediata, ya que primero se
checa si este valor es positivo o negativo. Esto se realiza con el objetivo de permitir un
aumento o una disminucin del voltaje por seal PWM.
el punto
mnimo y mximo en voltaje por seal PWM. Estos puntos permiten la saturacin de la
seal PWM, logrando tener siempre la posibilidad de controlar la velocidad del motor de
c.d por este tipo de seal.
Rutina PWM_OUT
Si
out_real<0
No
NEG(out_real)
Cambio de Formato
Cambio de Formato
ACC = FACTOR_PWM+out_real
ACC = FACTOR_PWM+out_real
No
Si
No
FACTOR_PWM = ACC
FACTOR_PWM = #Ah
T1CMPR = FACTOR_PWM
RET
de
salida de la etapa que lleva el mismo nombre y cuyo objetivo es modular la seal PWM de
la forma descrita en el apartado 3.4.2.1 del capitulo 3.
63
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
La rutina TX se auxilia de la rutina TRANSMITE, para checar si los datos han sido
exitosamente mandados a la pantalla de la PC. Las lneas de comando de esta ltima
se
muestran a continuacin:
TRANSMITE:
SACL *,AR3
xmit_rdy
LDP
#00E0h
BIT
SCICTL2, BIT7
BCND xmit_rdy,NTC
LDP
#ERROR
RET
SCICCR
SCICTL1
SCICTL2
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 4
- Un bit de inicio.
- 8 bits de datos.
- Paridad impar.
- Un bit de paro.
La Terminal
configuracin sirvi para crear un archivo de datos capaz de ser graficado y cuyo objetivo
fue el de observar el comportamiento del control.
65
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
PRUEBAS Y RESULTADOS
DEL SISTEMA DE CONTROL
EN LABORATORIO
CAPTULO
5.1 INTRODUCCIN
pruebas realizadas al
sistema de control.
5.2 PRUEBAS Y RESULTADOS DEL REGUALDOR DE VELOCIDAD TIPO
TAKAGI SUGENO PARA UN ARREGLO MOTOR DE CD - ALTERNADOR.
etapas de prueba: La primera etapa, permiti localizar el motivo por el cual el IGBT dejaba
de operar a la hora de entrar la etapa de control del regulador de velocidad y, la segunda
etapa permiti ver el comportamiento del regulador de velocidad ante diferentes formas de
operacin.
66
SEPI-ESIME
INGENIERA ELCTRICA
Valor de atenuacin
de la punta e prueba.
CAPITULO 5
Nivel de referencia
de voltaje cero, del
canal 1.
Ciclo til de
la seal PWM
a)
c)
Frecuencia de
la seal PWM
Periodo de la
seal PWM
b)
d)
67
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
e)
f)
Figura 5.1. Las grficas a, c y e muestra diferentes etapas de seal PWM que entrega el
DSP mediante el pin 12. Las grficas b, d, y f muestran la misma seal pero ahora medida
en la compuerta del IGBT.
La siguiente fase de
del colector a
emisor del IGBT, cuando este dispositivo es alimentado con la fuente de voltaje de c.d. y
esta operando el regulador de velocidad a lazo abierto. Los resultados de estas mediciones
se pueden ver en los oscilogramas de la figura 5.2
a)
b)
68
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
Figura 5.2. a) Seal medida en la compuerta del IGBT. b) Seal medida entre el
colector y emisor del IGBT.
Comparando las grficas de la figura 5.1 incisos b, d f con la grfica de la figura 5.2a,
se pudo ver
que las seales son semejantes ante diferentes modos de operacin, dando
como conclusin que la seal PWM que permite la conmutacin de IGBT no era la
causante de la destruccin del mismo. Otra comparacin que corroboro esto, fue la seal
PWM medida entre el colector y emisor del IGBT (figura
semejante a las mostradas en la referencia [34] y cubre los requerimientos del dispositivo
que se muestran en el apndice B.
Como la seal PWM que sale del DSP no era la causante del problema ni tampoco la
fuente de c.d. se paso a graficar la seal que controla el PWM ( Factor_PWM ), la seal de
entrada al convertidor A/D del DSP (A/D) y la seal de entrada al regulador (e). Estas
variables fueron obtenidas bajo las condiciones antes descritas y su grafica se puede ver en
la figura 5.3.
800
700
Factor_PWM
PWM
|e(k)|
600
500
400
300
200
A/D
100
0
0
Tiempo (seg)
Figura 5.3. Comportamiento del Factor PWM, del absoluto del error y de la seal
medida en el convertidor A/D durante la etapa de arranque del regulador.
Los resultados de la figura 5.3 permitieron ver que la seal de entrada al DSP (A/D),
tena un comportamiento anormal durante la etapa de arranque. Debido a esto se procedi a
realizar el siguiente experimento: se arranco nicamente el programa de control con
69
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
retroalimentacin y se dejo correr por unos minutos. Esto dio como resultado la grafica de
la figura 5.4.
500
450
400
|e(k)|
350
300
250
200
150
100
A/D
50
0
0
0.5
1.5
2.5
Tiempo (seg)
450
400
|e(k)|
350
300
250
A/D
200
PWM
Factor_PWM
150
100
50
0
0
0.5
1.5
2.5
3.5
Tiempo (seg)
70
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
Figura 5.5. Comportamiento del Factor PWM, del absoluto del error y de la seal
medida en el convertidor A/D durante la etapa de arranque del regulador.
a)
c)
b)
d)
71
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
Figura 5.6. a),c) Comportamiento de la seal PWM, medido en el pin 12 del DSP. b),d)
Comportamiento de la seal PWM, medido en la compuerta del IGBT.
800
900
PWM
Factor_PWM
700
Entrada de la etapa
de control del regulador
600
|e(k)|
500
400
300
200
100
ADC
0
0
10
11
12
13
Tiempo (seg.)
Figura 5.7. Comportamiento del Factor PWM, del absoluto del error y de la seal medida
en el convertidor A/D desde la etapa de arranque hasta la entrada de la etapa de control.
400
Entrada de la etapa
de control
350
377rad/seg.
300
Estado estable
200
150
Etapa de arranque
del motor
100
50
0
0
10
12
Tiempo (seg.)
72
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
382
380
velocidad (rad/seg)
Adicion de carga
378
376
374
372
370
0
0.5
1.5
2.5
3.5
4.5
Tiempo(seg)
73
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
384
382
Eliminacin de
carga
Velocidad (rad/seg)
380
378
376
374
372
370
0
0.5
1.5
2.5
3.5
4.5
Tiempo (seg)
380
(Velocidad (rad/seg)
379
378
377
376
375
374
373
0
0.5
1.5
2
2.5
Tiempo (seg)
3.5
74
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
380
Velocidad (rad/seg)
379
378
377
376
375
374
373
0.5
1.5
2
2.5
Tiempo (seg)
3.5
75
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
381
380
Velocidad (rad/seg)
379
378
377
376
375
374
373
0.5
1.5
2
2.5
Tiempo (seg)
3.5
76
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
Las grficas del osciloscopio mostradas en la figura 5.6, muestran la seal PWM
medidas a diferentes tiempos. Estas mediciones se realizaron en la salida del DSP y en la
entrada del IGBT. En las grficas a y c de la misma figura, se observa que la seal presenta
ruido, que no afecta al funcionamiento del IGBT, ya que esta seal se limpia cuando entra
al driver evitando de esta manera disparos en falso en la compuerta del IGBT.
En la figura 5.9 se muestra la respuesta del motor de c.d., cuando se le aplica una
carga resistiva que demanda 300 watts de potencia al alternador. En ella se observa que la
velocidad del motor disminuye. Sin embargo al actuar el regulador, la velocidad de
377rad/seg. se vuelve a recuperar. El tiempo que tarda el regulador
para estabilizar al
77
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
frecuencia de 60.79Hz, mientras que la parte mas baja es de 372rad/seg. que equivale a una
frecuencia de 59.2Hz.
78
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 5
Para todos los casos el sistema se comporto estable. En la figura 5.14 se muestra el
equipo de laboratorio empleado para los experimentos y en la figura 5.15 se muestra la
tarjeta de aplicacin TMS320F240.
79
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 6
CONCLUSIONES
APORTACIONES
Y TRABAJOS A FUTURO
6
CAPTULO
6.1 CONCLUSIONES
En el desarrollo de esta tesis, se realizaron las siguientes etapas: Obtencin de
los parmetros del motor de c.d. [36,37] ; sintonizacin del regulador de velocidad;
anlisis de estabilidad del control;
simulacin, permiti variar las ganancias proporcional e integral entre las diferentes
regiones del error. Estas ganancias se tomaron como base para la implementacin.
2.- El anlisis de estabilidad permiti comprobar que el regulador de velocidad era
estable bajo las condiciones dadas.
3.-
79
SEPI-ESIME
INGENIERA ELCTRICA
CAPITULO 6
Se obtuvieron los parmetros del motor de corriente directa, que servirn para
futuros estudios de investigacin y docencia, ya que este dispositivo forma parte del
equipo de laboratorio de mquinas elctricas (LME ) que se encuentra en la SEPIESIME Zacatenco.
80
SEPI-ESIME
INGENIERA ELCTRICA
REFERENCIAS
REFERENCIAS
[1] Takagi and Sugeno, Fuzzy identification of systems and its applications to modeling
and control. IEEE, Trans. Syst., Man, Cybern., vol.15, pp.116-132, 1985.
[2] Mamdani E.H. , Application of fuzzy algorithms for control of simple dynamic plant .
Proc.IEEE, vol.121, no.12, pp. 1585-1588, 1976.
[3] Chuen Chien Lee, Fuzzy Logic in Control Systems: Fuzzy Logic Controller-Part I.
IEEE Transactions on Systems, Man, and Cibernetics. Vol. 20 No 2, pp. 404-418,
Marzo/Abril 1990.
[4] Timothy A. Adcock. Fuzzy Logic: An Overview of the Latest Control Methodology.
Application Report, SPRA028. Texas Instrument, Enero 1993.
[5] Romero Romero David y Cortes Mateos Ral, Diseo de un sistema de regulacin de
voltaje de una mquina sncrona por control Difuso. IEEE Seccin Mxico, RVP.
Julio 1994.
[6] Cortes Mateos Ral, Control de excitacin difuso de un generador sncrono. SEPIESIME ZACATENCO. Tesis para obtener el Grado de Doctor en Ciencias, Mxico
D.F. 1997.
81
SEPI-ESIME
INGENIERA ELCTRICA
REFERENCIAS
[8] Daz Garca Luis M, Desarrollo de una tarjeta para el control difuso de velocidad de
un motor de c.c. basado en un paquete Fudge. SEPI-ESIME Zacatenco. Tesis para
obtener el Grado de Maestro en Ciencias, Mxico D.F. 1999.
y Ramrez T. J. Control de
Mxico 2000.
[11] Texas Instruments. Dsp Controllers Reference Set Volumen 1. Cpu System and
Instruction. Diciembre 1997.
[12] Texas Instruments. Dsp Controllers Reference Set Volumen 2.Peripherial Library
and Specific Devices. Diciembre 1997.
82
SEPI-ESIME
INGENIERA ELCTRICA
REFERENCIAS
[16] Glenn Anderson, Fuzzy Logic: What It Is; What It Does; What It Can Do. Current
Technology Report., pp. 38-42 October 1994.
[17] Constantin Von Altrock, Fuzzy Logic and NaeuroFuzzy Aplications Explained,
Prentice Hall 1995.
[18] Figoli David, Generating a PWM Signal Modulated by an Analog Input Using the
TMS320F240. Application Report: SPRA413, Texas Instrument,1999.
[20] K. Tanaka and Sugeno,Stability analysis and design of fuzzy control systems. Fuzzy
Sets and Sistems, vol.45, no.2,pp. 135-156,1992.
[21] Tanaka and Manabu Sano, Fuzzy Stability Criterion of a Class of Nonlinear
Systems. Information Sciencies, no.71,pp. 3-26,1993.
[22] K. Tanaka and Manabu Sano, A Robust Stabilization Problem of Fuzzy Control
Systems and its application to backing up control of a truck trailer. IEEE Trans. On
Fuzzy Systems.,Vol.2,No.2, pp. 119-134,1994.
FA8-E,1980.
[25] Sthepen J. Chapman., Mquinas Elctricas. Ed. Mc Graw Hill. Segunda edicin,
pp. 1-8,1993.
83
SEPI-ESIME
INGENIERA ELCTRICA
REFERENCIAS
[26] Mantilla Caeiros Alfredo Vctor, Control Vectorial de motores de induccin usando
procesadores de seales digitales. SEPI-ESIME Zacatenco. Tesis para obtener el
grado de maestro en ciencias, Mxico D.F., Mayo 2000.
[29] Brod M.D. & Novotny W.D., Current Control VSI-PWM Inverters , IEEE Ind.
Applications,vol 2 IA-21, No 4,pp 562-570, May/June 1985.
[30] Bose B.K., Power Electronics and Variable Frecuency Drives. Technology
Applications, IEEE Press, 1996.
[31] Chokhawala Rahul, Sobhani Sae. Switching Voltage Transient Protection Schemes
For High Current IGBT Modules. International Rectifier Corporation. Applications
Engineering. 233 Kansas St. 1998.
[32] Herrera Espinosa Javier, Ramrez Trujillo Jorge, Modelo Matemtico de una
Mquina de C.D. Tesina para obtener el Diplomado de Matemticas Aplicadas a la
Ingeniera, ESIME- ZACATENCO-IPN, Mxico D.F. 2000.
[33] Rotating Machinery Committee of the IEEE Power Engineering Society. Test
Procedures for Direct Current Machines. IEEE Std. 113-1885.
[34] Wildi de Vito. Experimentos con mquinas elctricas. Ed. Limusa. Mxico1987.
84
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
A.2. Modelado matemtico del motor de c.d. con corriente de campo constante.
Figura A.1. Motor de c.d. con excitacin separada y corriente de campo constante.
como:
T e = K IA = J
d
dt
+ B + TL
(A.1)
85
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
Donde
Kg m2
seg .
dI A
dt
(A.2)
K I A 1
L AA + L AA
B
0
J
0 V A
1
TL
J
(A.3)
&
TL
Para obtener la
(A.4)
86
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
derivada de la corriente de armadura I& A y la derivada de la velocidad & son iguales a cero,
por lo tanto la ecuacin algebraica lineal resultante quedara:
0
I A
V A
0
120.1 28.38 49.02
160.82 0.30 + 0
277.77
TL
(A.5)
(A.6)
IA = 0.70 amperes.
= 377 rad. / seg.
Especificaciones
Potencia : P = 1.8Kw
87
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
(A.7)
donde IA(s), TL(s) y (s) son las Transformadas de Laplace de IA, TL y respectivamente.
Similarmente, la ecuacin A.2. puede expresarse en Transformada de Laplace como:
VA (s) = ( RA + s LAA) IA (s) + K (s) LAA IA (0)
(A.8)
(s)
K
= 2
V A (s) s (JL AA ) + s (R A J + BL AA ) + (R A B + K 2 )
(A.9)
(s)
( RA + sL AA )
= 2
TL(s) s (JLAA ) + s (R A J + BL AA ) + (RA B + K 2 )
(A.10)
88
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
TL(s)
VA
1
sLAA+RA
IA(s)
Te(s)
(s)
1
sJ+B
Fuerza contraelectromotriz
K
Figura A.2.Diagrama a bloques de un motor de c.d. con excitacin separada utilizado para
simulacin .
70
400
63
360
56
320
49
280
377 rad/seg
Velocidad ( rad/seg )
42
35
28
21
200
160
120
0.7 A
14
80
7
0
0
240
40
0.5
1.5
Tiempo (seg)
(a)
2.5
0
0
0.5
1.5
Tiempo (t)
2.5
(b)
Figura A.3.Simulacin del motor de corriente directa con el modelo lineal. (a) corriente de
armadura. (b) Velocidad angular.
89
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
y,
T L(s)
V A (s)
Te(s)
sLAA +R A
(s)
1
sJ+B
Figura A.4.Diagrama a bloques del motor de c.d. con excitacin separada considerando la
corriente de campo constante y alimentacin tipo rampa.
Lazo de corriente
u(s) _
Kp
+
1
RA + sLAA
+
+
1/Ti(s)
TL (s)
IA(s)
Te (s)
1
B + sJ
(s)
Fuerza contraelectromotriz
Figura A.5. Diagrama a bloques del motor de c.d. con excitacin separada considerando la
corriente de campo constante, con lazo de corriente y limitador de corriente.
Las respuestas en
90
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
400
0.9
350
300
0.7
Velocidad (rad/seg)
0.8
0.6
0.5
0.4
0.3
250
200
150
100
0.2
50
0.1
0
0
0
10
12
Tiempo(seg)
(a)
6
Tiempo(seg)
10
12
(b)
Figura A.6. Respuesta del motor de c.d. con alimentacin tipo rampa. a) Velocidad
angular. (b). Corriente de armadura.
0.8
400
360
0.7
Velocidad (rad/seg)
320
0.6
0.5
0.4
0.3
280
240
200
160
120
0.2
80
0.1
0
0
40
5
10
15
20
Tiempo (seg)
25
30
0
0
(a)
Figura A.7. Respuesta del
12 15 18
Tiempo (seg)
21
24
27
30
(b)
motor de c.d. con lazo de corriente. (a) Velocidad angular. (b).
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
A.3. Simulacin del control de velocidad Tipo Takagi Sugeno del motor de c.d
alternador con lazo de corriente.
El diagrama a bloques del sistema de control del motor de c.d.- alternador con lazo
de corriente se presenta a continuacin:
Lazo de corriente
TL (s)
Kp
+
1
RA + sLAA
+
+
IA(s)
Te (s)
1
B + sJ
(s)
1/Ti(s)
Fuerza contraelectromotriz
Control de
velocidad tipo
Takagi-Sugeno
u(s)
Figura A.8.
El primero es un
92
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
Los resultados de las simulaciones del control de velocidad tipo Takagi Sugeno
para el arreglo motor de c.d. - alternador se muestran a continuacin:
12
400
350
300
Velocidad(rad/seg)
10
250
200
150
100
2
50
0
0
1.5
4.5
7.5
10.5
12
13.5
15
1.5
4.5
7.5
10.5
12
13.5
15
Tiempo (seg)
Tiempo (seg)
Figura A.9. Respuesta ante el control de la IA y la del motor de c.d.- alternador bajo las
siguientes condiciones: Kp = 0.52 ; Ki =0.40; Kpb =1.75; Kib = 0.01; Kpa =1.9;
Kia =
800
11
600
Velocidad (rad/seg)
700
10
8
7
6
5
4
3
500
400
300
200
2
100
1
A.10. (a)
0
0
10
0
15
20
25
30
35
40
45
50
Tiempo (seg)
10
15
20
25
30
35
40
45
50
Tiempo (seg)
Figura A.10. Respuesta ante el control de la IA y la del motor de c.d.- alternador bajo las
siguientes condiciones: Kp = 0.52 ; Ki =0.40; Kpb =1.75; Kib = 0.01; Kpa =1.9;
Kia =
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE A
400
1.8
350
1.6
Velocidad (rad/seg)
1.2
0.8
0.6
250
200
150
100
0.4
50
0.2
0
0
10
10
Tiempo (seg)
Tiempo (seg)
Figura A.11.Respuesta ante el control de la IA y la del motor de c.d.- alternador bajo las
siguientes condiciones: Kp = 0.52 ; Ki =0.40; Kpb =26.75; Kib = 15.53; Kpa =28;
Kia
12
400
10.5
350
300
Velocidad (rad/seg)
300
1.4
7.5
4.5
Adicin
de carga
200
Arranque
tipo
rampa
150
100
1.5
50
Eliminacin
de carga
250
0
0
1.5
4.5
7.5
10.5
12
Tiempo (seg)
1.5
4.5
7.5
10.5
Tiempo (seg)
Figura A.12. Respuesta ante el control de la IA y la del motor de c.d.- alternador bajo las
siguientes condiciones: Kp = 0.52 ; Ki =0.40; Kpb =26.75; Kib = 15.53; Kpa =28;
Kia
SEPI-ESIME
12
APNDICE A
400
3.5
350
300
Velocidad (rad/seg)
2.5
1.5
250
200
150
100
0.5
50
0
0
10
12
1.5
Tiempo (seg)
4.5
7.5
10.5
12
Tiempo (seg)_
Figura A.13. Respuesta ante el control de la IA y la del motor de c.d.- alternador bajo las
siguientes condiciones: Kp = 0.52 ; Ki =0.40; Kpb =26.75; Kib = 15.53; Kpa =28;
Kia
Eliminacin
de carga
Velocidad (rad/seg)
INGENIERA ELCTRICA
380
375
Arranque
del motor
Adicin
de carga
370
7.0336
8.0336
9.0336
10.0336
11.0336
Tiempo (seg)_
SEPI-ESIME
INGENIERA ELCTRICA
Debido a lo anterior
APNDICE A
rampa y se realiz una nueva sintonizacin dando como resultado las graficas presentadas
en las figuras A.11. , A.12 , A 13 y A.14.
En la figura A.11. se observa que el valor de corriente mas alto en el arranque del
motor de c.d.-alternador es de 1.95 A y su valor en estado estable es 1.43A. Ambos
valores se encuentran dentro del valor nominal del motor ( ver tabla A.1.). El tiempo que
tarda el motor de c.d. desde el reposo hasta su velocidad nominal es de 7.6 seg.
corriente
mxima al
aplicar carga nominal 11.9A;corriente en estado estable con carga nominal 9.63A;
velocidad mnima 360rad./seg. equivalente a 57.3 Hz.; velocidad mxima 394 rad. / seg.
equivalente a
59.53 Hz.;
velocidad mxima
381 rad. / seg. equivalente a 60.63 Hz.; y por ltimo el tiempo de estabilizacin una vez
presentada la adicin de carga es de 0.3 seg. mientras que el tiempo de estabilizacin a la
hora de la eliminacin de carga es de 0.5 seg.
( figura
5.9 y 5.10 ), se puede ver una mejora en el control de velocidad tipo Takagi Sugeno con
lazo de corriente, ya que los valores mnimos y mximos que se tienen en la velocidad al
adicionar y eliminar la carga de 300 W son ms cercanos a 60 Hz.
96
SEPI-ESIME
INGENIERA ELCTRICA
B.
APNDICE B
97
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE B
98
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE B
99
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE B
100
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE C
101
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE C
102
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE D
103
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE D
104
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE D
105
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE D
106
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE E
107
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE E
108
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE E
109
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
.include "f240regs.h"
.include "mcr_sug.h"
*-----------------------------------------------------------------------------------------------------------------------------*
Declaracin de variables para el bloque de memoria en RAM
*------------------------------------------------------------------------------------------------------------------------------
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
ERROR,1
ABS_ERROR,1
ERROR_ANT,1
ABS_ERROR_ANT,1
u_membresia,2
u_bajo,1
u_alto,1
out_real,1
prod_previo,2
GPR0,1
VAL_MEM,1
FACTOR,1
DIVISOR,1
ab,1
bb,1
aa,1
ba,1
PRODUCTO,1
FACTOR_PWM,1
ap_tabla,1
INC_DEC,1
BANDERA1,1
BANDERA2,1
TEMP,1
CONT,1
110
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
.bss
.bss
.bss
.bss
.bss
.bss
.bss
.bss
DEC_MILLAR,1
MILLAR,1
CENTENA,1
DECENA,1
UNIDAD,1
NULO,1
DIVIDENDO,1
COCIENTE,1
;
;
;
;
;
;
;
;
;-----------------------------------------------------------------------------------------------------------------------------;
Declaracin de constantes
;-----------------------------------------------------------------------------------------------------------------------------DP_PF1
DP_PF2
DP_EV
resultado
.set
.set
.set
.set
224
225
232
UNIDAD
*-----------------------------------------------------------------------------------------------------------------------------*
Definicin de vectores de interrupcin
*-----------------------------------------------------------------------------------------------------------------------------.sect ".vectors"
RSVECT
B
INI_PROG
INT1
B
PHANTOM
INT2
B
ADC
INT3
B
PHANTOM
INT4
B
PHANTOM
INT5
B
PHANTOM
INT6
B
PHANTOM
RESERVED
B
PHANTOM
SW_INT8
B
PHANTOM
SW_INT9
B
PHANTOM
SW_INT10
B
PHANTOM
SW_INT11
B
PHANTOM
SW_INT12
B
PHANTOM
SW_INT13
B
PHANTOM
SW_INT14
B
PHANTOM
SW_INT15
B
PHANTOM
SW_INT16
B
PHANTOM
TRAP
B
PHANTOM
NMINT
B
PHANTOM
EMU_TRAP
B
PHANTOM
SW_INT20
B
PHANTOM
SW_INT21
B
PHANTOM
SW_INT22
B
PHANTOM
SW_INT23
B
PHANTOM
111
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
*----------------------------------------------------------------------------------------------*
Inicio del programa principal
*----------------------------------------------------------------------------------------------.text
NOP
;
BAJO ALTO
; Etiquetas de las funciones de membresa
BAJO
.word 0000h,0040h,00C0h
; Funciones de membresa
INI_PROG:
SETC
CLRC
CLRC
CLRC
INTM
OVM
SXM
CNF
; Inhabilita interrupciones
; Resetea modo sobrefujo
; Resetea modo extensin de signo
; Configura el bloque B0 para memoria de datos
; DP-->300h-400h
; Limpia el Bloque 0
; Limpia el Bloque 1
; Limpia el Bloque 2
#0047h,ab
#0040h,bb
#0068h,aa
#0060h,ba
; 47
; 40
; 68
; 60
Kib+Kpb
Kpb
Kia+Kpa
Kpa
;
SCI_INIT:
#4h,GPR0
GPR0,WSGR
; GPR0=4H
; Coloca XMIF w/no estados de espera
#DP_PF1
#0037h, SCICCR
; DP-->7000h-707fh.
; 1 bit de paro,paridad impar,8 bits de
; datos,modo asncrono
SPLK
#0013h, SCICTL1
SPLK
SPLK
SPLK
SPLK
SPLK
#0002h, SCICTL2
#0000h, SCIHBAUD
#0040h, SCILBAUD
#0022h, SCIPC2
#0032h, SCICTL1
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
#DP_PF2
#0801h,OCRA
; DP-->Pgina 7080h-70ffh
; Activa la salida T1PWM/T1CMP
EV_PWM:
t1period .SET
999
#DP_EV
#2141h,GPTCON
#t1period,T1PR
#0000h,T1CNT
#0000h,T1CMPR
#100Ah,T1CON
#0FFFFh,EVIFRA
#080h,EVIMRA
T1CON,B6_MSK
; DP-->7400h-747fh.
; T1 asc. con arranque del ADC por periodo
; Periodo de la seal PWM
; Inicializacin del contador de tiempo 1
; Se limpia la variable que modula la seal PWM
; Hab. la comp. y el modo de conteo asc. contino
; Limpia las banderas de interrupcin del registro A
; Habilita las interrupciones por periodo
; Habilita la op. del reloj de conteo asc. (T1CNT)
LDP
LACC
SACL
SPLK
CLRC
#0
IFR
IFR
#0002h,IMR
INTM
#DP_PF1
#8D00h,ADCTRL1
#0404h,ADCTRL2
;
ARRANQUE:
; DP-->7000h-707fh.
; Hab. el canal 0 del ADC para conv. contina
; Hab. la conv. por el EV. Vel. conv. 7.2 seg.
Arranque del motor
lect_adc LDP
#ERROR
LACC BANDERA1
BCND lect_adc,EQ
SPLK #0,BANDERA
LDP
#ERROR
LACC FACTOR_PWM
ADD
#1h
SACL FACTOR_PWM
LDP
#DP_EV
SACL T1CMPR
; DP-->300h-400h
; Variable que controla el ancho del pulso
; FACTOR_PWM = FACTOR_PWM + 1
; DP--> 7400-747f
; T1CMPR = FACTOR_PWM. Registro
;que controla el ancho de pulso
113
SEPI-ESIME
INGENIERA ELCTRICA
OBT_ABS_ERROR
CALL PANTALLA
LDP
#ERROR
LACC FACTOR_PWM
SUB
#0300h
BCND
;
ARRANQUE,LT
APNDICE F
INI_CONTROL:
LDP
#ERROR
LACC BANDERA2
BCND INI_CONTROL,EQ
SPLK #0,BANDERA2
OBT_ABS_ERROR
CALL MEMBERSHIP
CALL
CALL
CALL
CALL
B
*-----------------------------------------------------------------------------------------------------------------------------*
Fin del Programa Principal
*-----------------------------------------------------------------------------------------------------------------------------*************************************************************************************
*************************************************************************************
*
Bloques de Rutinas
*************************************************************************************
*************************************************************************************
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina MEMBERSHIP
*
( Primera etapa del control de frecuencia tipo Takagi-Sugeno )
*
* DESCRIPCIN: En esta rutina se pasan el valores reales (ERROR) a valores difusos.
*
Este procedimiento es conocido como fusificacin.
*-----------------------------------------------------------------------------------------------------------------------------MEMBERSHIP:
SPLK
#01h,INC_DEC
tabla
SPLK #BAJO,ap_tabla
SPLK #00FFh,FACTOR
LAR
AR1,#ERROR+1
LAR AR3,#ap_tabla
LAR AR5,#u_membresia
LAR AR6,#VAL_MEM
INC_T
LACC *,AR1
SUB
*,AR5
BCND value1,GEQ
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
sigue
INC_T
LACC *,AR1
SUB
*,AR5
BCND f_interm,GT
;
f_interm
; BAJO = 0
; FFh (valor mximo de membresa en F-Q8) = 1dec.
; ALTO =$0FF
SPLK
#080h,DIVISOR
BAJADAS
SUBIDAS
B
DIVISOR
DIVISOR
dif_end
value1
LACC FACTOR
SACL *+
LACC #0000h
SACL *
RET
dif_end
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina IMPLICACIONES_SUGENO
*
( Segunda etapa del control de frecuencia tipo Takagi-Sugeno )
*
* DESCRIPCIN: Esta rutina se encarga de evaluar las ecuaciones de diferencia en las regiones
*
BAJO y ALTO. Dichas ecuaciones son:
*
*
u_(bajo) actual = (ab)*(e(k)) - (bb)*(e(k-1))
*
u_(alto) actual = (aa)*(e(k)) - (ba)*(e(k-1))
*-----------------------------------------------------------------------------------------------------------------------------IMPLICACIONES_SUGENO:
LDP
LAR
LAR
LAR
LAR
LAR
#ERROR
AR0,#1
AR2,#u_bajo
AR3,#ab
AR4,#1
AR5,#prod_previo
115
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
alto
LAR
MAR
e_e_ant
BIT *+,0,AR3
BCND val_neg,TC
LT
*+,AR1
MPYU *+,AR5
PAC
SACL *+,AR4
BANZ e_e_ant,AR1
val_neg
sum_res
AR1,#ERROR
*,AR1
; Checa el edo del LSB del (ERROR/ERROR_ANT)
; Brinca si TC=1, el (ERROR/ERROR_ANT) es (-)
; Multiplica (a)x por ABS(e(k))
; ACC = PREG
; Prod_previo = (a)x por ABS(e(k/k-1))
; Regresa apuntando a e(k-1)
sum_res
LT
MPYU
PAC
NEG
SACL
BANZ
*+,AR1
*+,AR5
*+,AR4
e_e_ant,AR1
LAR
MAR
LACC
SUB
SACL
LAR
LAR
BANZ
RET
AR5,#prod_previo
*,AR5
*+
*,AR2
*+,AR0
AR4,#1
AR5,#prod_previo
alto
; u_(bajo/alto) actual =
; (a)x por (e(k)) - (b)x por (e(k-1))
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina SALIDA_REAL
*
( ltima etapa del control de frecuencia tipo Takagi-Sugeno )
*
* DESCRIPCIN: Esta rutina se encarga de obtener el valor real que nos servir para la
*
modulacin del ancho del pulso. La obtencin de la salida real se hace
*
mediante la siguiente ecuacin:
*
*
out_real=((u_bajo*u(error_bajo))+(u_alto*u(error_alto)))/u(error_alto)+u(error_bajo)
*-----------------------------------------------------------------------------------------------------------------------------SALIDA_REAL:
SPLK #0FFh,DIVISOR
LAR
AR0,#u_membresia
LAR
AR1,#u_bajo
LAR
AR2,#prod_previo
LAR AR3,#1
uno_mas
MAR *,AR0
LT
*+,AR1
MPYU *+,AR2
PAC
; u(error_alto)+u(error_bajo)
116
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
DIVIDE DIVISOR
; Realiza la divisin
SACL *+,AR3
;
BANZ uno_mas,AR1
LAR
AR2,#prod_previo
MAR *,AR2
LACC *+
ADD
*
SACL out_real
; out_real=((u_bajo*u(error_bajo))+(u_alto*u(error_alto)))
RET
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina PWM_OUT
* DESCRIPCIN: Esta rutina se encarga de la modulacin del ancho de pulso (PWM) que controla la
*
velocidad del motor corriente directa.
*
La modulacin del ancho de pulso se hace mediante la insercin de out_real
*
obtenida en la rutina SALIDA_REAL al registro T1CMPR de esta rutina.
*-----------------------------------------------------------------------------------------------------------------------------PWM_OUT:
LDP
#ERROR
LACC out_real,16
; Checa si el valor es negativo
BCND sal_neg,LT
; Brinca si el valor es negativo
sal_neg
LACC
SUB
BCND
FACTOR_PWM
#t1period-10
n_mod,GEQ
LACC
RPT
SFR
ADD
SUB
BCND
out_real
#4
ADD
SACL
B
#03DAh
FACTOR_PWM
out
LACC
SUB
BCND
FACTOR_PWM
#0Ah
n_mod,LEQ
LACC
NEG
AND
RPT
SFR
NEG
ADD
out_real
SUB
#0Ah
BCND
min_neg,LEQ
ADD
SACL
B
#0Ah
FACTOR_PWM
out
; Convierte de Q5 a Q0
FACTOR_PWM
#03DAh
max_pos,GEQ
#0FFFFh
#4
; Convierte de Q5 a Q0
FACTOR_PWM
117
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
LACC #03DAh
FACTOR_PWM
out
; Valor mnimo de la modulacin
min_neg
LACC
SACL
#0Ah
FACTOR_PWM
out
LDP
SACL
#DP_EV
T1CMPR
n_mod
RET
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina PANTALLA
*
* DESCRIPCIN: Esta rutina se encarga de llamar a HEXDEC y a rutina TX.
*
HEXDEC es la rutina encargada de convertir los valores hexadecimales a decimales.
*
TX es la rutina encargada de transmitir los datos decimales a pantalla auxilindose
*
de la rutina TANSMITE.
*
TANSMITE es la rutina encargada de checar si se ha transmitido el dato.
*-----------------------------------------------------------------------------------------------------------------------------PANTALLA:
LAR
AR2,#TEMP
; Por pantalla se visualiza la lectura del ADC
SAL_A_PANTALLA
; Macro
LAR
AR2,#FACTOR_PWM
SAL_A_PANTALLA
LAR
AR2,#ABS_ERROR
SAL_A_PANTALLA
RET_CAR
; Transmite retorno de carro
RET
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina HEXDEC
*
*DESCRIPCIN: Esta rutina se encarga de convertir un dato hexadecimal a decimal
*
*-----------------------------------------------------------------------------------------------------------------------------HEXDEC:
;
Limpieza del area de resultados
LDP
#ERROR
MAR *,ar5
LAR
AR5,#resultado
ZAC
RPT
#4
SACL *LAR
AR5,#resultado
MAR *,ar2
LACC *+,ar5
; Se carga el acumulador con el dato a convertir
SPLK #0Ah,DIVISOR
118
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
hd1
DIVIDE
SACH
AND
SUB
BCND
ADD
B
hd2
DIVISOR
*#0FFFFh
#9
hd2,LEQ
#9
hd1
ADD
#9
SACL *
RET
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina TX
*
*DESCRIPCIN: TX es la rutina encargada de transmitir los datos decimales a pantalla auxiliandose
*
de la rutina TANSMITE.
*-----------------------------------------------------------------------------------------------------------------------------TX:
tx1
LAR
LAR
MAR
LACC
ADD
CALL
MAR
BANZ
ar5,#4
AR3, #DEC_MILLAR
*,AR3
*+,AR0
#0030h
TRANSMITE
*,ar5
tx1,ar3
Transmisin de espacio entre dato y dato
MAR *,ar0
LACC #20h
CALL TRANSMITE
RET
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina TRANSMITE
*
*DESCRIPCIN: TRANSMITE es la rutina encargada de checar si se ha transmitido el dato.
*
*-----------------------------------------------------------------------------------------------------------------------------TRANSMITE:
SACL *,AR3
; TRANSMITE dato a terminal
LDP #00E0h
xmit_rdy
BIT SCICTL2, BIT7
; Prueba el bit TXRDY
BCND xmit_rdy,NTC
; SI TXRDY=0, Repite loop
LDP
#ERROR
RET
*-----------------------------------------------------------------------------------------------------------------------------*
Fin de los Bloques de Rutinas
*-----------------------------------------------------------------------------------------------------------------------------119
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
*************************************************************************************
*************************************************************************************
*
Rutinas de interrupcin
*************************************************************************************
*************************************************************************************
*-----------------------------------------------------------------------------------------------------------------------------*
ADC
*
* DESCRIPCIN:
Esta rutina hace la conversin de analgico a digital.
*-----------------------------------------------------------------------------------------------------------------------------ADC:
PUSH_REG
LDP
SBIT1
LACC
SACL
LACC
RPT
#DP_PF1
ADCTRL1,B0_MSK
ADCTRL1
ADCTRL1
ADCFIFO1
#05h
SFR
LDP
SACL
#ERROR
TEMP
int.
derecha
increm_cont
CONT
#0000H
increm_cont,LT
#0FFFFh,BANDERA1
#0FFFFh,BANDERA2
#0000h,CONT
limpiar
LACC
ADD
SACL
CONT
#1h
CONT
limpiar
LDP
LACC
SACL
#DP_EV
EVIFRA
EVIFRA
LDP
#0
LACC IFR
SACL IFR
CLRC INTM
LDP
#ERROR
POP_REG
RET
120
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina PHANTOM
*
* DESCRIPCIN:
Esta rutina se encarga de darle un reset al wachdog
*-----------------------------------------------------------------------------------------------------------------------------PHANTOM:
KICK_DOG
B
PHANTOM
*-----------------------------------------------------------------------------------------------------------------------------*
Rutina BAD_INT
*
* DESCRIPCIN:
Esta rutina se presenta cuando existe una mala interrupcin
*-----------------------------------------------------------------------------------------------------------------------------BAD_INT:
B
LACC #0BADh
BAD_INT
*----------------------------------------------------------------------------------------------*
Fin de Rutinas de interrupcin
*----------------------------------------------------------------------------------------------; Coneccin del PWM pin 12 del I/O
; Entrada de ADC0 pin 3 del ANALOG
; TESIS.CMD
121
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
/* MMRS
/* DARAM
/* DARAM
/* DARAM
/* XDM
*/
*/
*/
*/
*/
}
/*--------------------------------------------------------------------------------------------------------------*/
/*
SECCION DE ASIGNACION
/*--------------------------------------------------------------------------------------------------------------*/
SECTIONS
{
.vectors
: { } > VECS PAGE 0
/* Tabla de vector de interrupcin
.reset
: { } > VECS PAGE 0
/* Cdigo de reset
.start
: { } > PROG PAGE 0
/* Cdigo
.text
: { } > PROG PAGE 0
/* Cdigo
.data
: { } > PROG PAGE 0
/* Inicializacin tabla de datos
.mmrs
: { } > MMRS PAGE 1
/* Registro de mapeo de memoria
.bss
: { } > B1
PAGE 1
/* Block B2
.blk0
: { } > B0
PAGE 1
/* Block B0
.blk1
: { } > B1
PAGE 1
/* Block B1
.blk2
: { } > B2
PAGE 1
/* Block B2
.blk3
: { } > DATA PAGE 1
/* Memoria de datos externa
}
*/
*/
*/
*/
*/
*/
*/
*/
*/
*/
*/
*/
122
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
124
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
125
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
126
SEPI-ESIME
INGENIERA ELCTRICA
APNDICE F
.macro
LACC
OR
SACL
.endm
DMA, MASK
DMA
#(MASK)
DMA
TBIT
.macro
LACC
AND
.endm
DMA, MASK
DMA
#(MASK)
XORBIT
.macro
LACC
XOR
SACL
.endm
DMA, MASK
DMA
#(MASK)
DMA
KICK_DOG
.macro
LDP
SPLK
SPLK
.endm
.macro
LARP
MAR
SST
SST
SACH
SACL
.endm
PUSH_REG
.macro
LARP
MAR
LACL
ADD
LST
LST
CLRC INTM
.endm
AR7
*#1,*#0,***-
POP_REG
AR7
*+
*+
*+,16
#0,*+
#1,*+
;Recupera ACC_L
;Recupera ACC_H
;Recupera ST1
;Recupera ST0
;Limpia bandera de mscara de INT
127
SEPI-ESIME
INGENIERA ELCTRICA
DIVIDE
APNDICE F
.macro dma
RPT
#15
SUBC dma
.endm
CLRBLQ0
CLRBLQ1
CLRBLQ2
INC_T
BAJADAS
.macro
LAR AR2,#B0_SADDR
MAR *,AR2
ZAC
RPT #0ffh
SACL *+
.endm
; AR2->Inicio de la direc. de B0
; ARP=AR2
; ACC = 0
; Repite 255+1 loops
; Escribe ceros a B0 RAM
.macro
LAR AR2,#B1_SADDR
MAR *,AR2
ZAC
RPT #0ffh
SACL *+
.endm
.macro
LAR AR2,#B2_SADDR
MAR *,AR2
ZAC
RPT #1fh
SACL *+
.endm
.macro
LDP #ERROR
MAR *,AR3
LACC *
ADD
INC_DEC
SACL *,AR6
TBLR *
.endm
.macro dma
MAR *,AR6
LACC *,AR1
SUB
*,AR5
SACL GPR0
LT FACTOR
MPYU GPR0
PAC
DIVIDE DIVISOR
SACL *+
.endm
; AR5 actual
; VAL_MEM carga x1
; ERROR
; X1-ERROR (NUMERADOR)
; FACTOR = FF
; (NUMERADOR)
; ACC = PREG Se carga el acum.. con el dato a convertir
; Realiza la divisin
; Almacena valor difuso de bajada
128
SEPI-ESIME
INGENIERA ELCTRICA
SUBIDAS
.macro
APNDICE F
dma
; AR5 actual
SPLK #0FFFFh,INC_DEC
INC_T
LACC *
SACL *,AR1
LACC *,AR6
SUB
*,AR5
SACL GPR0
LT FACTOR
MPYU GPR0
PAC
DIVIDE DIVISOR
SACL *
.endm
SAL_A_PANTALLA
.macro
LAR AR0,#SCITXBUF
CALL HEXDEC
CALL TX
.endm
RET_CAR
.macro
MAR *,ar0
LACC #0Dh
CALL TRANSMITE
.endm
OBT_ABS_ERROR
; ERROR
; VAL_MEM (carga el Xo)
; ERROR-Xo (NUMERADOR)
; (NUMERADOR)
; ACC = PREG Se carga el acc. con el dato a con.
; Realiza la divisin
; Almacena valor difuso de subida
.macro
LDP
#ERROR
LACC ERROR
SACL ERROR+2
LACC ERROR+1
SACL ERROR+3
LAR
AR0,#TEMP
MAR *,AR0
LACC #01EAh
SUB
*
SACL ERROR
ABS
SACL ERROR+1
.endm
; Carga Error
; Error_ANTERIOR = Error_ACTUAL
; Carga ABS(Error)
; ABS(Error_ANTERIOR) = ABS(Error_ACTUAL)
129
SEPI-ESIME