SHARE
TWEET

Untitled

a guest Jun 24th, 2019 62 Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. //INPUTS
  2. const int boton_subir = 4;
  3. int valor_boton_subir;
  4. bool subir_presionado;
  5. bool subir;
  6. int anterior_subir = 3;
  7.  
  8. const int sensor_superior = 2;
  9. const int sensor_inferior = 3;
  10. const int boton_bajar = 5;
  11. const int automatico = 1;
  12.  
  13. //const int laser = 6;
  14. //const int sensor_mesa = 10;
  15. //
  16. //const int contador_arriba = 8;
  17. //const int contador_abajo = 9;
  18.  
  19. //OUTPUTS
  20. const int bajar_motor = 12;
  21. const int subir_motor = 11;
  22.  
  23. int valor_sensor_superior;
  24. int valor_sensor_inferior;
  25. int valor_boton_bajar;
  26. int valor_automatico;
  27.  
  28. int anterior_sensor_superior = 3;
  29. int anterior_sensor_inferior = 3;
  30. int anterior_boton_bajar = 3;
  31. int anterior_automatico = 3;
  32. //int valor_laser;
  33.  
  34. //int valor_sensor_mesa;
  35. //
  36. //int valor_contador_arriba;
  37. //int valor_contador_abajo;
  38. //int valor_subir_motor;
  39. //int valor_bajar_motor;
  40.  
  41. void setup()
  42. {
  43.     // put your setup code here, to run once:
  44.  
  45.     Serial.begin(9600);
  46.  
  47.     pinMode(sensor_superior, INPUT);
  48.     pinMode(sensor_inferior, INPUT);
  49.     pinMode(boton_subir, INPUT);
  50.     pinMode(boton_bajar, INPUT);
  51.  
  52.     /*pinMode(subir_motor, OUTPUT);
  53.     pinMode(bajar_motor, OUTPUT);
  54.     pinMode(laser, INPUT);
  55.     pinMode(automatico, INPUT);
  56.     pinMode(sensor_mesa, INPUT);*/
  57. }
  58.  
  59. void leerValores()
  60. {
  61.     //leer input subir elevador
  62.     valor_boton_subir = digitalRead(boton_subir);
  63.  
  64.     if (valor_boton_subir == 1)
  65.     {
  66.         subir_presionado = true;
  67.     }
  68.     else
  69.     {
  70.         if (subir_presionado == true)
  71.         {
  72.             if (subir == false)
  73.             {
  74.                 subir = true;
  75.             }
  76.             else
  77.             {
  78.                 subir = false;
  79.             }
  80.  
  81.             subir_presionado = false;
  82.         }
  83.     }
  84.  
  85.     //leer input bajar elevador
  86.     valor_boton_bajar = digitalRead(boton_bajar);
  87.     //leer input sensor superior
  88.     valor_sensor_superior = digitalRead(sensor_superior);
  89.     //leer input sensor superior
  90.     valor_sensor_inferior = digitalRead(sensor_inferior);
  91.  
  92.     ////leer laser de proximidad 1/0
  93.     //valor_laser = digitalRead(laser);
  94.     ////leer input boton modo automatico
  95.     valor_automatico = digitalRead(automatico);
  96.     ////leer input sensor superior
  97.     //valor_sensor_mesa = digitalRead(sensor_mesa);
  98. }
  99.  
  100. void imprimirValores()
  101. {
  102.     if (subir != anterior_subir)
  103.     {
  104.         Serial.println("subir: ");
  105.         Serial.println(subir);
  106.         Serial.println("\n");
  107.  
  108.         anterior_subir = subir;
  109.     }
  110.  
  111.     if (valor_boton_bajar != anterior_boton_bajar)
  112.     {
  113.         Serial.println("valor_boton_bajar: ");
  114.         Serial.println(valor_boton_bajar);
  115.         Serial.println("\n");
  116.  
  117.         anterior_boton_bajar = valor_boton_bajar;
  118.     }
  119.  
  120.     if (valor_sensor_superior != anterior_sensor_superior)
  121.     {
  122.         Serial.println("valor_sensor_superior: ");
  123.         Serial.println(valor_sensor_superior);
  124.         Serial.println("\n");
  125.  
  126.         anterior_sensor_superior = valor_sensor_superior;
  127.     }
  128.  
  129.     if (valor_sensor_inferior != anterior_sensor_inferior)
  130.     {
  131.         Serial.println("valor_sensor_inferior: ");
  132.         Serial.println(valor_sensor_inferior);
  133.         Serial.println("\n");
  134.  
  135.         anterior_sensor_inferior = valor_sensor_inferior;
  136.     }
  137.  
  138.     if (valor_automatico != anterior_automatico)
  139.     {
  140.         Serial.println("valor_automatico: ");
  141.         Serial.println(valor_automatico);
  142.         Serial.println("\n");
  143.  
  144.         anterior_automatico = valor_automatico;
  145.     }
  146. }
  147.  
  148. void subirMotor()
  149. {
  150.     //si no ah llegado al sensor superior
  151.     if (valor_sensor_superior == 0)
  152.     {
  153.         //subir motor
  154.         digitalWrite(subir_motor, true);
  155.     }
  156.     else
  157.     {
  158.         digitalWrite(subir_motor, false);
  159.     }
  160. }
  161.  
  162. void bajarMotor()
  163. {
  164.     //si no ah llegado al sensor inferior
  165.     if (valor_sensor_inferior == 0)
  166.     {
  167.         //bajar motor
  168.         digitalWrite(bajar_motor, true);
  169.     }
  170.     else
  171.     {
  172.         digitalWrite(bajar_motor, false);
  173.     }
  174. }
  175.  
  176. void moverManual()
  177. {
  178.     if (valor_automatico == 0)
  179.     {
  180.         //si esta activo el boton de subir
  181.         if (valor_boton_subir == 1)
  182.         {
  183.             subirMotor();
  184.         }
  185.         else
  186.         {
  187.             digitalWrite(subir_motor, false);
  188.         }
  189.  
  190.         //si esta activo el boton de bajar
  191.         if (valor_boton_bajar == 1)
  192.         {
  193.             bajarMotor();
  194.         }
  195.         else
  196.         {
  197.             digitalWrite(bajar_motor, false);
  198.         }
  199.     }
  200. }
  201.  
  202. void loop()
  203. {
  204.     // put your main code here, to run repeatedly:
  205.  
  206.     leerValores();
  207.  
  208.     imprimirValores();
  209.  
  210.     if (valor_boton_bajar == 1 || valor_boton_subir == 1)
  211.     {
  212.         moverManual();
  213.     }
  214. }
RAW Paste Data
We use cookies for various purposes including analytics. By continuing to use Pastebin, you agree to our use of cookies as described in the Cookies Policy. OK, I Understand
 
Top