Juan Manuel Rodriguez Aguado
/
Ejer01
SensorCooler
Revision 12:b4f6eed9c339, committed 2019-06-21
- Comitter:
- Jumaroag
- Date:
- Fri Jun 21 02:54:11 2019 +0000
- Parent:
- 11:1be668e096a2
- Commit message:
- Lin zabala Rodriguez Agudo
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
diff -r 1be668e096a2 -r b4f6eed9c339 main.cpp --- a/main.cpp Thu Apr 04 20:48:03 2019 +0000 +++ b/main.cpp Fri Jun 21 02:54:11 2019 +0000 @@ -1,97 +1,277 @@ -/* - * Simple example program - * - * Note: Don't forget to connect a 4.7k Ohm resistor - * between the DS1820's data pin and the +3.3V pin - * - */ +#include "mbed.h" +#include "DS1820.h"//Libreria para medir el sensor de temp + +//Defines Estados +#define Medicion_RPM_Max 0 +#define Lazo_Cerrado 1 +#define Lazo_Abierto 2 + +DigitalIn CoolerIn(PTE5);//Entrada sensor Hall +DigitalIn Pulsador(PTC0);//Entrada Pulsador + +AnalogIn Preset(PTB3);//Entrada analogica del preset + +DigitalOut azul(LED_BLUE); +DigitalOut rojo(LED_RED); +DigitalOut verde(LED_GREEN); + +PwmOut CoolerOut(PTE20);//La salida tiene que variar entre 1.0 y 0.0 + +unsigned char t=0,n=0,HabilitacionMedicion=0; + +Ticker seg,micro; + +void segundos(void);//mediciones y printf +void micro_segundos(void);//antirebote pulsador +unsigned int calculo_RPM(unsigned int pulsos);//funcion que calcula las RPM + +Serial serial(USBTX, USBRX);//Comunicacion con PC -/* Single DS1820 sensor: */ -/* -#include "mbed.h" -#include "DS1820.h" - -Serial pc(USBTX, USBRX); -DigitalOut led(LED1); -DS1820 ds1820(D8); // substitute D8 with the actual pin name connected to the DS1820 sensor -float temp = 0; -int result = 0; - int main() { - if (ds1820.begin()) { - while (1) { - ds1820.startConversion(); // start temperature conversion from analog to digital - wait(1.0); // let DS1820 complete the temperature conversion - result = ds1820.read(temp); // read temperature from DS1820 and perform cyclic redundancy check (CRC) - switch (result) { - case 0: // no errors -> 'temp' contains the value of measured temperature - pc.printf("temp = %3.1f%cC\r\n", temp, 176); - break; - - case 1: // no sensor present -> 'temp' was not updated - pc.printf("no sensor present\n\r"); - break; - - case 2: // CRC error -> 'temp' was not updated - pc.printf("CRC error\r\n"); - } - - led = !led; - } - } - else - pc.printf("No DS1820 sensor found!\r\n"); -} -*/ - - -/*Several DS1820 sensors connected to the 1-wire bus:*/ -#include "mbed.h" -#include "DS1820.h" - -#define MAX_SENSOSRS 32 // max number of DS1820 sensors to be connected to the 1-wire bus (max 256) + Pulsador.mode(PullUp);//Habilitamos pull up interno para el pulsador + + unsigned char Estado_General=0,habCoolerIn=0,antirebote_pulsador=0,habilitacion_pulsador=0,hab=0,hab_max=0; + unsigned int pulsos=0,RPM=0,RPM_Max=0,Velocidad=0; + float Temperatura=0,Valor_Preset=0,Velocidad_Real=1; + + DS1820 ds1820(PTC7);//Entre parentesis va el nombre del pin que recive los datos + ds1820.begin();//Inicio el sensor de Temp + + seg.attach(&segundos, 1);//Inicio Ticker 1 seg + micro.attach(µ_segundos, 0.1);//Inicio Ticker 100uS + + azul=1; + rojo=1; + verde=1; -DS1820* ds1820[MAX_SENSOSRS]; -Serial pc(USBTX, USBRX); -DigitalOut led(LED1); -OneWire oneWire(D8); // substitute D8 with the actual pin name connected to the 1-wire bus -int sensorsFound = 0; // counts the actually found DS1820 sensors - -int main() -{ - pc.printf("\r\n--Starting--\r\n"); - - //Enumerate (i.e. detect) DS1820 sensors on the 1-wire bus - for (sensorsFound = 0; sensorsFound < MAX_SENSOSRS; sensorsFound++) { - ds1820[sensorsFound] = new DS1820(&oneWire); - if (!ds1820[sensorsFound]->begin()) { - delete ds1820[sensorsFound]; - break; - } - } + while(1) + { + switch (Estado_General)//Maquina de estados General del Programa + { + default://En caso de un estado incierto voy a Medicion_RPM_Max que es el estado de reset + + case Medicion_RPM_Max://Mido las RPM maximas del cooler conectado + CoolerOut=1; + if(CoolerIn==1 && habCoolerIn==1)//cuento las vueltas del cooler + { + pulsos++; + habCoolerIn=0; + } + if(CoolerIn==0 && habCoolerIn==0) + { + habCoolerIn=1; + } + //Parpadeo Azul y Blanco + if(t%2==0 && hab==0) + { + printf("Midiendo...\n"); + azul=0; + rojo=1; + verde=1; + hab=1; + } + if(t%2!=0 && hab==1) + { + printf("Midiendo..\n"); + azul=0; + rojo=0; + verde=0; + hab=0; + } + + if(t==4 && hab_max==0)//Dejo un margen de tiempo para asegurar el regimen permanente + { + pulsos=0; + hab_max=1; + } + if(t==7 && hab_max==1)//cada 3 seg calculo las RPM + { + RPM_Max=calculo_RPM(pulsos); + pulsos=0; + hab_max=2; + } + if(t==10 && hab_max==2)//Lo hago 2 veces y promedio para estar seguro + { + RPM_Max=(RPM_Max + calculo_RPM(pulsos))/2;//Necesito este dato para los calculos que voy a realizar + pulsos=0; + t=0; + Estado_General=Lazo_Cerrado;//Termina la medicion asi q voy estado lazo cerrado + printf("===Medicion Finalizada===\n"); + printf("RPM Maxima: %i rpm\n",RPM_Max); + printf("\n======Lazo Cerrado======\n"); + azul=1; + rojo=1; + verde=1; + hab_max=0; + } + break; +//------------------------------------------------------------------------------------ + case Lazo_Cerrado://Controlo las RPM del cooler en funcion de la temperatura (en lazo cerrado) + verde=0; + if(CoolerIn==1 && habCoolerIn==1)//cuento las vueltas del cooler + { + pulsos++; + habCoolerIn=0; + } + if(CoolerIn==0 && habCoolerIn==0) + { + habCoolerIn=1; + } + + if(t==3)//cada 3 seg calculo las RPM y ajusto la velocidad de salida + { + RPM=calculo_RPM(pulsos); + pulsos=0; + t=0; + if(RPM<Velocidad && Velocidad_Real<1)//Control de RPM en lazo cerrado + { + if((Velocidad-RPM)<400 && Velocidad_Real<0.9) + Velocidad_Real=Velocidad_Real+0.01; + if((Velocidad-RPM)>400) + Velocidad_Real=Velocidad_Real+0.1; + } + if(RPM>Velocidad) + { + if((RPM-Velocidad)<400) + Velocidad_Real=Velocidad_Real-0.01; + if((RPM-Velocidad)>400) + Velocidad_Real=Velocidad_Real-0.1; + } + //Cada 3 seg imprimo por pantalla los datos + printf("\nTemperatura: %.2f\nRPM: %i\n",Temperatura,RPM); + printf("RPM Ideal: %i\nPWM Cooler: %.2f\n",Velocidad,Velocidad_Real); + } + + if(HabilitacionMedicion==0)//Cada 1 segundo mido el sensor y calculo la velocidad a la que deberia girar + { + ds1820.startConversion();//Empieza la conversion de temperatura + Temperatura=ds1820.read();//Lees el valor de temperatura + Velocidad=(Temperatura-20)*((RPM_Max-400)/50)+400;//Velocidad en RPM a la q deberia girar el cooler - Responde a la tabla de valores + if(Temperatura>=70)//Si es mayor a 70 se clava al max + { + Velocidad=RPM_Max; + } + if(Temperatura<=20)//Si es menor a 20 se clava en 400 RPM + { + Velocidad=400; + } + CoolerOut=Velocidad_Real;//Fijo un PWM al cooler en funcion a lo controlado + HabilitacionMedicion=1; + } + + //Pulsador - si lo puslo cambio de modo + if(Pulsador==0 && antirebote_pulsador==0 && habilitacion_pulsador==1) + { + n=0; + antirebote_pulsador=1; + } + if(n==1 && Pulsador==0 && habilitacion_pulsador==1)//Cambio de estado + { + antirebote_pulsador=0; + habilitacion_pulsador=0; + Estado_General=Lazo_Abierto; + t=0; + printf("\n======Lazo Abierto======\n"); + azul=1; + rojo=1; + verde=1; + } + if(n==1 && Pulsador==1 && habilitacion_pulsador==1) + antirebote_pulsador=0; + if(Pulsador==1 && antirebote_pulsador==0) + { + n=0; + antirebote_pulsador=1; + } + if(n==1 && Pulsador==1) + { + antirebote_pulsador=0; + habilitacion_pulsador=1; + } + if(n==1 && Pulsador==0) + antirebote_pulsador=0; + + break; +//------------------------------------------------------------------------------------ + case Lazo_Abierto://La velocidad del cooler depende del Preset + rojo=0; + if(CoolerIn==1 && habCoolerIn==1)//cuento las vueltas del cooler + { + pulsos++; + habCoolerIn=0; + } + if(CoolerIn==0 && habCoolerIn==0) + { + habCoolerIn=1; + } + + if(t==3)//cada 3 seg calculo las RPM + { + RPM=calculo_RPM(pulsos); + pulsos=0; + t=0; + } + + if(HabilitacionMedicion==0)//Cada 1 segundo mido el preset y ajusto la salida + { + Valor_Preset=Preset.read(); + CoolerOut=Valor_Preset;//Ajusto la velocidad de salida + printf("\nPreset: %.0f\nRPM: %i\n",Valor_Preset*100,RPM);//Muestro los datos + HabilitacionMedicion=1; + } + + //Pulsador - si lo pulso cambio a lazo cerrado + if(Pulsador==0 && antirebote_pulsador==0 && habilitacion_pulsador==1) + { + n=0; + antirebote_pulsador=1; + } + if(n==1 && Pulsador==0 && habilitacion_pulsador==1)//Cambio de estado + { + antirebote_pulsador=0; + habilitacion_pulsador=0; + Estado_General=Lazo_Cerrado; + t=0; + printf("\n======Lazo Cerrado======\n"); + azul=1; + rojo=1; + verde=1; + } + if(n==1 && Pulsador==1 && habilitacion_pulsador==1) + antirebote_pulsador=0; + if(Pulsador==1 && antirebote_pulsador==0) + { + n=0; + antirebote_pulsador=1; + } + if(n==1 && Pulsador==1) + { + antirebote_pulsador=0; + habilitacion_pulsador=1; + } + if(n==1 && Pulsador==0) + antirebote_pulsador=0; + + break; + + }//SW + }//while +}//main - switch (sensorsFound) { - case 0: - pc.printf("No DS1820 sensor found!\r\n"); - return -1; - - case 1: - pc.printf("One DS1820 sensor found.\r\n"); - break; +void segundos(void) +{ + t++; + HabilitacionMedicion=0; +} - default: - pc.printf("Found %d DS1820 sensors.\r\n", sensorsFound); - } +void micro_segundos(void) +{ + if(n==0) + n++; +} - while (1) { - pc.printf("----------------\r\n"); - for (int i = 0; i < sensorsFound; i++) - ds1820[i]->startConversion(); // start temperature conversion from analog to digital - wait(1.0); // let DS1820 sensors complete the temperature conversion - for (int i = 0; i < sensorsFound; i++) { - if (ds1820[i]->isPresent()) - pc.printf("temp[%d] = %3.1f%cC\r\n", i, ds1820[i]->read(), 176); // read temperature - } - } -} +unsigned int calculo_RPM(unsigned int pulsos) +{ + return (pulsos*10);//Pulsos * 10 porque medimos durante 3 seg y cada 2 pulsos 1 vuelta +} \ No newline at end of file