Juan Ignacio Cobas
TP1 Ejer 1: Cooler cobas, montero
Dependencies: mbed tsi_sensor DHT11
Revision 0:af75ea285b6b, committed 2019-06-06
- Comitter:
- cobasjuan
- Date:
- Thu Jun 06 13:46:17 2019 +0000
- Commit message:
- tp1 ejer1 cooler
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/DHT11.lib Thu Jun 06 13:46:17 2019 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/fossum_13/code/DHT11/#5da6f6de3e42
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Thu Jun 06 13:46:17 2019 +0000
@@ -0,0 +1,240 @@
+#include "mbed.h"
+#include "tsi_sensor.h"
+#include "Dht11.h"
+
+/* This defines will be replaced by PinNames soon */
+#if defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
+#define ELEC0 9
+#define ELEC1 10
+#elif defined (TARGET_KL05Z)
+#define ELEC0 9
+#define ELEC1 8
+#else
+#error TARGET NOT DEFINED
+#endif
+
+#define ESPERO_ARRANQUE 0
+#define MODO_A 1
+#define MODO_C 2
+#define LEO_TEMP 3
+#define CALC_RPM 4
+#define COMPARO 5
+#define DESHABILITADO_A 6
+#define RECTA 8
+#define DESHABILITADO_C 9
+
+//Timer
+Timeout velocidad;
+Timeout temperatura;
+
+// Funciones
+void modo();
+void lazo_cerrado();
+void lazo_abierto();
+void sensado_temp();
+void calculo_vel_la();
+void calculo_vel_lc();
+void lectura_tsi();
+
+// Variables
+unsigned int variacion_tsi=0, hab_modo_a=0, hab_modo_c=0, rpm=0, alto=0, hab_sens_temp=0, rps=0;
+unsigned int temp, flag_t1=0, rpm_real=0, flag_t2=0, segunda=0;
+unsigned int flanco=0, flanco_t=0;
+float veloc=0;
+unsigned int paso_abierto=DESHABILITADO_A;
+unsigned int nivel_temp=DESHABILITADO_C;
+
+// Entradas
+TSIAnalogSlider tsi(ELEC0, ELEC1, 40);
+AnalogIn pote(A1);
+Dht11 sensor(PTD7);
+DigitalIn rev(A2); // Funcion para rpm
+
+//Salidas
+PwmOut cooler(A3);
+
+int main(void)
+{
+ while (true) {
+ lectura_tsi();
+ modo();
+ lazo_cerrado();
+ lazo_abierto();
+ }
+}
+
+void modo() // Encendido y selector de modo
+{
+ static unsigned int paso_modo=ESPERO_ARRANQUE;
+ switch(paso_modo) {
+ case ESPERO_ARRANQUE:
+ if(variacion_tsi == 1 && alto == 0) { // alto = flag para detectar el flanco
+ alto=1;
+ printf("Comienzo\n\r");
+ printf("LAZO ABIERTO\n\r");
+ paso_modo=MODO_A;
+ }
+ break;
+ case MODO_A:
+ hab_modo_a=1;
+ hab_modo_c=0;
+ if(variacion_tsi == 1 && alto == 0) {
+ alto=1;
+ printf("LAZO CERRADO\n\r");
+ paso_modo=MODO_C;
+ }
+ break;
+ case MODO_C:
+ hab_modo_a=0;
+ hab_modo_c=1;
+ if(variacion_tsi == 1 && alto == 0) {
+ alto=1;
+ printf("LAZO ABIERTO\n\r");
+ paso_modo=MODO_A;
+ }
+ break;
+ }
+}
+
+void lazo_cerrado()
+{
+ switch(nivel_temp) {
+ case DESHABILITADO_C: // Este caso espera que se habilite la maquina de estados
+ if(hab_modo_c == 1) {
+ hab_sens_temp=1;
+ nivel_temp=LEO_TEMP;
+ }
+ break;
+ case LEO_TEMP: // despues de 2 segundos attachea una funcion que lee la temperatura
+ if(flanco_t == 0) { // flag para que entre una sola vez
+ flanco_t=1;
+ temperatura.attach(&sensado_temp, 2);
+ }
+ if(hab_modo_c == 0) { // si se cambia el modo se deshabilita la maquina de estados
+ nivel_temp=DESHABILITADO_C;
+ hab_sens_temp=0;
+ }
+ break;
+ case CALC_RPM: // Mido la cantidad de veces que se pone en 1 la pata del cooler de las revoluciones y saco el calculo dentro de un tiempo
+ if(flag_t2 == 0) { // para obtener las revoluciones por minuto
+ flag_t2=1;
+ velocidad.attach(&calculo_vel_lc, 0.5);
+ }
+ if(rev == 0 && flanco==1) { // flanco = variable para detectar el flanco
+ flanco=0;
+ }
+ if(rev == 1 && flanco==0) {
+ flanco=1;
+ rps++;
+ }
+ if(hab_modo_c == 0) {
+ nivel_temp=DESHABILITADO_C;
+ hab_sens_temp=0;
+ }
+ break;
+ case COMPARO: // comparo las RPM que deberia haber teoricamente con las que fueron medidas anteriormente y corrijo
+ segunda=1;
+ rpm_real=(140*temp)-2600; // calculo teorico
+ if(rpm_real <= 200) {
+ printf("RPM TEORICO = 200\n\r");
+ } else if(rpm_real > 200) {
+ printf("RPM TEORICO = %d\n\r",rpm_real);
+ }
+ if(temp > 20 && temp < 70) {
+ if(rpm_real > rpm) { // si las rpm teoricas son superiores a las medidas aumentamos las rpm
+ cooler.write(veloc + 0.05);
+ } else if(rpm_real < rpm) { // si las rpm teoricas son inferiores a las medidas bajamos las rpm
+ cooler.write(veloc - 0.05);
+ }
+ }
+ nivel_temp=CALC_RPM; // una vez que comparo y corrigio vuelvo a calcular las rpm
+ if(hab_modo_c == 0) {
+ nivel_temp=DESHABILITADO_C;
+ hab_sens_temp=0;
+ }
+ break;
+ }
+}
+
+void lazo_abierto()
+{
+ switch(paso_abierto) {
+ case DESHABILITADO_A:
+ if(hab_modo_a == 1) {
+ paso_abierto=RECTA;
+ }
+ break;
+ case RECTA:
+ if(flag_t1 == 0) {
+ if(pote >= 0.027) { // Asigno el valor del pote al cooler
+ cooler.write(pote);
+ } else if(pote < 0.027) {
+ cooler.write(0.027);
+ }
+ flag_t1=1;
+ velocidad.attach(&calculo_vel_la, 0.5); // Timeout que realiza el calculo de los rpm cada medio segundo
+ }
+ if(rev == 0 && flanco==1) {
+ flanco=0;
+ }
+ if(rev == 1 && flanco==0) {
+ flanco=1;
+ rps++;
+ }
+ if(hab_modo_a == 0) {
+ paso_abierto=DESHABILITADO_A;
+ }
+ break;
+ }
+}
+
+void sensado_temp() // Funcion que lee el sensor y se guarda en una variable la temperatura
+{
+ sensor.read();
+ temp=sensor.getCelsius();
+ printf("T = %d\n\r",temp);
+ if(temp <= 20) {
+ cooler.write(0.027);
+ } else if(temp >= 70) {
+ cooler.write(1);
+ } else if(temp < 70 && temp > 20) {
+ veloc=(0.0195 * temp) - 0.365; // ecuacion de la velocidad en funcion de la temperatura
+ cooler.write(veloc);
+ }
+ flanco_t=0;
+ nivel_temp=CALC_RPM;
+}
+
+void calculo_vel_la() // saco el calculo de las rpm a partir de las revoluciones que midio en un determinado tiempo
+{
+ rpm=rps*120;
+ printf("RPM = %d \n\r", rpm);
+ rps=0;
+ flag_t1=0;
+}
+
+void calculo_vel_lc() // saco el calculo de las rpm a partir de las revoluciones que midio en un determinado tiempo
+{
+ rpm=rps*120;
+ printf("RPM REAL = %d \n\r", rpm);
+ rps=0;
+ flag_t1=0;
+ if(flag_t2 == 1 && segunda == 0) {
+ flag_t2=0;
+ nivel_temp=COMPARO;
+ } else if(flag_t2 == 1 && segunda == 1) { // segunda = variable que se pone en 1 luego de haber comparado y corregido
+ flag_t2=0;
+ segunda=0;
+ nivel_temp=LEO_TEMP;
+ }
+}
+
+void lectura_tsi() // funcion que lee el tsi
+{
+ if(tsi.readPercentage() != 0) {
+ variacion_tsi=1;
+ } else {
+ variacion_tsi=0;
+ alto=0;
+ }
+}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Thu Jun 06 13:46:17 2019 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mbed_official/code/mbed/builds/65be27845400 \ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/tsi_sensor.lib Thu Jun 06 13:46:17 2019 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/Kojto/code/tsi_sensor/#976904559b5c