![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
sdhfdhfudhg
Dependencies: DebouncedIn TextLCDa mbed
main.cpp
- Committer:
- javiernegrette
- Date:
- 2013-11-08
- Revision:
- 0:54dde34c33f3
File content as of revision 0:54dde34c33f3:
#include "mbed.h" #include "DebouncedIn.h" #include "TextLCD.h" AnalogIn Vin(PTC2); TextLCD lcd(PTB10, PTB11, PTE2, PTE3, PTE4, PTE5); // rs, e, d4-d7 AnalogIn y(PTB0); AnalogOut u(PTE30); DigitalOut led1(LED1); DigitalOut led2(LED2); DigitalOut led3(LED3); DigitalIn button1(PTC12); DigitalIn button2(PTC13); DigitalIn button3(PTC16); DigitalIn button4(PTC17); /* codigos movimiento del cursor 18 para izquierda 1A para derecha */ //int C1=0x0E; // solo muestra el cursor int C2=0x18; // desplaza izquierda int C3=0x1A; // desplaza derecha int C4=0x0C; // quito cursor bajo int C1=0x0F; int err, med, yr, pid, ap, ai, ad, err_v, cycle; float pidn; int spnum=0,kinum=0,kpnum=0,kdnum=0,pos=1; int incremento=1,f=0; Timer t; int main() { lcd.cls(); // Borrar Pantalla lcd.writeCommand(C1);//escribimos un comando segun el manual del modulo LCD lcd.locate(8,0); lcd.printf("Kp=%d",kpnum); lcd.locate(0,1); lcd.printf("Ki=%d",kinum); lcd.locate(8,1); lcd.printf("Kd=%d",kdnum); lcd.locate(0,0); lcd.printf("Sp=%d",spnum); while(1) { if (!button1) { if(f==0) { t.start(); f=1; } led1 =!led1; wait(0.50); if(!button1) { if(t.read()>10) { incremento=100; } else if(t.read()>5.5) { incremento=10; } if(pos==1) { if(spnum+incremento>=999) { spnum=999; lcd.locate(3,0); lcd.printf(" "); lcd.locate(3,0); lcd.printf("%d", spnum); } else { spnum+=incremento; lcd.locate(3,0); lcd.printf("%d", spnum); } } else if(pos==2) { if(kpnum+incremento>=999) { kpnum=999; lcd.locate(11,0); lcd.printf(" "); lcd.locate(11,0); lcd.printf("%d", kpnum); } else { kpnum+=incremento; lcd.locate(11,0); lcd.printf("%d", kpnum); } } else if(pos==3) { if(kinum+incremento>=999) { kinum=999; lcd.locate(3,1); lcd.printf(" "); lcd.locate(3,1); lcd.printf("%d", kinum); } else { kinum+=incremento; lcd.locate(3,1); lcd.printf("%d", kinum); } } else if(pos==4) { if(kdnum+incremento>=999) { kdnum=999; lcd.locate(11,1); lcd.printf(" "); lcd.locate(11,1); lcd.printf("%d", kdnum); } else { kdnum+=incremento; lcd.locate(11,1); lcd.printf("%d", kdnum); } } } } if (!button2) { if(f==0) { //t.reset(); t.start(); f=1; } led1 =!led1; wait(0.50); if(!button2) { if(t.read()>10) { incremento=100; } else if(t.read()>5.5) { incremento=10; } led2 =!led2; if(pos==1) { if(spnum-incremento<0) { //No ocurre nada } else { spnum-=incremento; lcd.locate(3,0); lcd.printf(" "); lcd.locate(3,0); lcd.printf("%d", spnum); } } else if(pos==2) { if(kpnum-incremento<0) { //No ocurre nada } else { kpnum-=incremento; lcd.locate(11,0); lcd.printf(" "); lcd.locate(11,0); lcd.printf("%d", kpnum); } } else if(pos==3) { if(kinum-incremento<0) { //No ocurre nada } else { kinum-=incremento; lcd.locate(3,1); lcd.printf(" "); lcd.locate(3,1); lcd.printf("%d", kinum); } } else if(pos==4) { if(kdnum-incremento<0) { //No ocurre nada } else { kdnum-=incremento; lcd.locate(11,1); lcd.printf(" "); lcd.locate(11,1); lcd.printf("%d", kdnum); } } } } if (!button3) { led3 =!led3; if(pos==4) { pos=1; lcd.locate(3,0); lcd.printf("%d", spnum); } else if (pos==1) { pos++; lcd.locate(11,0); lcd.printf("%d", kpnum); } else if(pos==2) { pos++; lcd.locate(3,1); lcd.printf("%d", kinum); } else if(pos==3) { pos++; lcd.locate(11,1); lcd.printf("%d", kdnum); } wait(0.25); } if (button1 && button2) { f=0; t.reset(); incremento=1; } if (!button4){ break; //sale del bucle si pisan suiche4 } } lcd.writeCommand(C4);//escribimos un comando segun el manual del modulo LCD para quitar cursor bajo lcd.cls(); //borra la pantalla lcd.printf("GUARDAMOS \nVALORES |m|"); wait(2); // se imprimen los parches del control ***************************************** lcd.cls(); lcd.printf("Er%d",err); lcd.locate(8,0); lcd.printf("Me%d",med); lcd.locate(0,1); lcd.printf("Sp%d",spnum); lcd.locate(8,1); lcd.printf("Co%d",pid); wait(5); // CICLO PRINCIPAL CONTROLADOR PID while(1) { med=999*y.read(); //leer puerto analogo y asignar a med err = (spnum-med); ap = kpnum*err; // se verifica que la accion integral no sea muy grande if(ai<100) { ai =(kinum*err)+ai; //calculo de la integral del error } else{ //Dejo de sumar la accion integral } ad = kdnum*(err-err_v); //calculo de la accion derivativa pid = (ap+ai+ad); // se actualizan las variables ******************************************* err_v = err; // se verifica que pid sea positivo ************************************** if(pid<=0){ pid=0; } // se verifica que pid sea menor o igual la valor maximo ***************** if (pid > 999){ pid=999; } // se actualizan las variables ******************************************* err_v = err; //se muestran las variables****************************************** wait(0.3); lcd.locate(2,0); lcd.printf(" "); lcd.locate(2,0); lcd.printf("%d",err); lcd.locate(10,0); lcd.printf(" "); lcd.locate(10,0); lcd.printf("%d",med); lcd.locate(2,1); lcd.printf(" "); lcd.locate(2,1); lcd.printf("%d",spnum); lcd.locate(10,1); lcd.printf(" "); lcd.locate(10,1); lcd.printf("%d",pid); //Normalizacion de la salida pidn=pid/999; // se envia el valor pid a puerto analogico de salida (D/A) ************** u.write(pidn); // se repite el ciclo } }