RuiViana

Bobinadeira_V_5.0__PRESSOR.ino

May 5th, 2020
495
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 10.35 KB | None | 0 0
  1.  
  2. /*
  3.    Nome do Projeto:  Bobinadeira
  4.    Nome do Aquivo:   bobinadeira_Botao13.ino
  5.    link:        http://labdegaragem.com/forum/topics/bobinadeira-autom-tica-controlada-com-arduino
  6.    Dependencias:     funcoes13.ino
  7.    MCU:              ATmega
  8.    Board:            Arduino Uno/Mega/Mini
  9.    Compilador        N/A
  10.    IDE:              Arduino IDE 1.8.5
  11.    Hardware:         Arduino UNO/MEGA/Mini
  12.    Escrito por:      Rui Viana
  13.    Modificado por:   N/A
  14.    Data:             23/06/2018
  15.    Uso:              Didático
  16.    Desenhos          CONTADOR2_SIMU.PDF
  17.    Copyright @       N/A
  18.  
  19.    Este programa é software livre;
  20.    e é distribuído na esperança que possa ser útil, mas SEM QUALQUER GARANTIA;
  21.    mesmo sem a garantia implícita de COMERCIALIZAÇÃO ou ADEQUAÇÃO A UM DETERMINADO FIM.
  22.  
  23.   Feio.e quando termina a bobina, fazer um botão que inicia de novo uma nova bobina
  24.   sem ir pro menu e confg de novo.
  25.  
  26.   tambem ele esta girando só para um lado, quero se possivel que eu consiga escolher
  27.   o sentido de rotação do motor.
  28.  
  29. */
  30. //#define debug
  31. #include <LiquidCrystal.h>
  32.  
  33. #include <Stepper.h>                                        // Biblioteca para uso do step motor
  34. Stepper stepper(200, PA12, PA11);                           // Portas do step e steps por volta
  35.  
  36. LiquidCrystal lcd(PA5, PA4, PA3, PA2, PA1, PA0);
  37.  
  38. #define brk PB9                                              // Controle do break
  39. //Botoes para controle do menu
  40. #define BT1 PB8                                              //Enter                  
  41. #define BT2 PB7                                              //down
  42. #define BT3 PB6                                              //Left
  43. #define BT4 PB5                                              //Right
  44. #define BT5 PB4                                              //Up
  45. #define BT6 R                                                //Reset
  46.  
  47. #define encoder PA15                                          // Entrada do encoder do motor principal
  48.  
  49. int     numEsp         = 903;                               // Numero de espiras previstas
  50. float   bitFio         = 0.5;                                // Bitola do fio em mm
  51. float   carrLeng       = 26;                                // Comprimento do carretel
  52. int     numEspAtual    =  0;                                // Numero de espirar atuais
  53. bool    incrementou = false;                                // Controle de incremento de espiras
  54. int     espFase        =  1;                                // N de espiras por etapa
  55. int     espCam         =  0;                                // Calcula o numero de espira por camada
  56. int     camf           =  0;                                // Numero de camada feita
  57. float   dln            =  0;                                // Fator de correção de largura
  58. float   dciclos        =  0;                                // Fator de correção passo
  59. bool    isolador    = false;                                // Contrele de isolador de camada
  60. int     menu           =  0;                                // Telas do sistema
  61. int     cstep          =  0;                                // Contador de passos
  62. int     ciclos         =  0;                                // Calcula o numero de ciclos da guia linear para cada passo
  63. bool    direct         =  1;                                // Sentido da guia
  64. float   incrementa     =  1;                                // Offset de incremento
  65. bool    pause       = false;                                // Contrele de pause
  66. int contaStep = 0;
  67. // Controle do motor da bobina
  68.  
  69. #define  EnaA PA6                                             // Habilita motor
  70. #define  IN1 PB13                                             // Fase1 do motor
  71. #define  IN2 PB14                                             // Fase2 do motor
  72. #define  cntl PA7                                             // Central do pot
  73. int velocidade = 0;                                           // Velocidade do motor
  74. //---------------------------------------------------------
  75. void ligaMotor()
  76. {
  77.   digitalWrite(IN1, HIGH);
  78.   digitalWrite(IN2, LOW);
  79.   analogWrite(EnaA, velocidade);                            // PWM com o valor de velocidase calculado
  80. }
  81. //---------------------------------------------------------
  82. void desligaMotor()
  83. {
  84.   velocidade = 0;                                           // Zera velocidade
  85.   digitalWrite(IN1, HIGH);                                  //
  86.   digitalWrite(IN2, HIGH);                                  //
  87.   analogWrite(EnaA, velocidade);                            //
  88. }
  89. //---------------------------------------------------------
  90. void setup()
  91. {
  92.   Serial.begin(115200);
  93.   stepper.setSpeed(600);                                    // Define velocidade do step
  94.   lcd.begin(16, 2);                                         // Inicializa LCD
  95.   pinMode(encoder, INPUT);                                  // Encoder como INPUT
  96.   pinMode(brk, INPUT_PULLUP);                               // Break como INPUT
  97. #ifdef  debug
  98.   pinMode(encoder, INPUT_PULLUP);                           // Debug
  99. #endif
  100.   pinMode(BT1, INPUT_PULLUP);                               // Botoes como INPUT
  101.   pinMode(BT2, INPUT_PULLUP);
  102.   pinMode(BT3, INPUT_PULLUP);
  103.   pinMode(BT4, INPUT_PULLUP);
  104.   pinMode(BT5, INPUT_PULLUP);
  105.   desligaMotor();
  106.   // Controle do motor
  107.   pinMode(IN1, OUTPUT);                                     // Fase1 do motor
  108.   pinMode(IN2, OUTPUT);                                     // Fase2 do motor
  109.   pinMode(EnaA, OUTPUT);                                    // Habilita motor
  110.   pinMode(cntl, INPUT);                                     // Central do pot
  111.   digitalWrite(EnaA, HIGH);                                 // Habilita motor em HIGH
  112.   attachInterrupt(digitalPinToInterrupt(PA15), contagem, RISING);
  113.   Serial.println("Iniciando......");
  114. }
  115. //--------------------------------------------------------
  116. void contagem()
  117. {
  118.   numEspAtual++;
  119.   incrementou = true;                                     // Informa incremento de espiras
  120. }
  121. //--------------------------------------------------------
  122. void returnHome()
  123. {
  124.   if (direct == 0)
  125.   {
  126.     while ( contaStep > 0)
  127.     {
  128.       contaStep--;
  129.       stepper.step(-1);                                         // Retorna para o inicio
  130.     }
  131.   }
  132.     if (direct == 1)
  133.   {
  134.     while ( contaStep < 0)
  135.     {
  136.       contaStep++;
  137.       stepper.step(1);                                         // Retorna para o inicio
  138.     }
  139.   }
  140. }
  141. //---------------------------- LOOP -----------------------------
  142. void loop()
  143. {
  144.   int pot = 0;                                              // Variavel para receber o valor analogico
  145.   pot = analogRead(cntl);                                   // Le o port analogico
  146.   velocidade = map(pot, 0, 4095, 20, 252);                  // Converte o valor
  147.   Serial.print("velocidade  "); Serial.println(velocidade);
  148.   selecao();                                                // Rotina IHM
  149.   cstep = 0;                                                // Zera contador de passos do step
  150.   ligaMotor();
  151.   if (incrementou == true)                                  // Houve incremento de espiras
  152.   {
  153.     LCDContagem();                                          // Mostra contagem de espiras e camadas
  154.     incrementou = false;                                    // Desabilita informar incremento de espiras
  155.     if (numEspAtual >= numEsp)                              // Numero de espiras realizadas = num de espiras esperadas
  156.     {
  157.       desligaMotor();
  158.       endProcess();                                         // Para processo
  159.     }
  160.     if (numEspAtual < numEsp)                               // Numero de espiras realizadas < num de espiras esperadas
  161.     {
  162.       if (direct != LOW)                                    // Se direcao e CW
  163.       {
  164.         while (cstep < ciclos)                              // Enquanto contagem de passos for menor que ciclos
  165.         {
  166.           clockwise();                                      // Gira um step CW
  167.           cstep = cstep + 1;                                // Incrementa contador de passos
  168.         }
  169.       }
  170.       else                                                  // Se direcao e CCW
  171.       {
  172.         while (cstep < ciclos)                              // Enquanto contagem de passos for menor que ciclos
  173.         {
  174.           counterclockwise();                               // Gira um step CCW
  175.           cstep = cstep + 1;                                // Incrementa contador de passos
  176.         }
  177.       }
  178.       if (numEspAtual % espCam == 0)                        // Se modulo de qte de espiras por camada = 0
  179.       {
  180.         camf++;                                             // Incremen ta contador de camadas
  181.         LCDContagem();                                      // Mostra contagem de espiras e camadas
  182.         direct = not(direct);                               // Inverte direcao do step
  183.         if (isolador == true)                               // Se precisa de isolador ligado
  184.         {
  185.           desligaMotor();
  186.           int t = 0;                                        // Define t como inteiro e igual a zero  ??
  187.           for (t = 0; t < 50;)                              // Faca 50 vezes ??
  188.           {
  189.             if (digitalRead(brk) == 0)                      // Se o brake foi pressionado
  190.             {
  191.               delay(500);                                   // Delay
  192.               break;                                        // termine o for
  193.             }
  194.           }
  195.         }
  196.       }
  197.       while (pause == HIGH)
  198.       {
  199.         desligaMotor();
  200.         if (digitalRead(brk) == 0)                            // Se o brake foi pressionado
  201.         {
  202.           delay(30);                                          // Debouncing
  203.           if (digitalRead(brk) == 0)                          // Se o brake continua pressionado
  204.           {
  205.             pause = LOW;                                      // Desabilita pause
  206.             delay(500);                                       // Delay
  207.           }
  208.         }
  209.       }
  210.     }
  211.   }
  212.   if (digitalRead(brk) == 0)                                // Se o brake foi pressionado
  213.   {
  214.     delay(30);                                              // Debouncing
  215.     if (digitalRead(brk) == 0)                              // Se o brake continua pressionado
  216.     {
  217.       pause = HIGH;                                         // Habilita pause
  218.     }
  219.   }
  220. }
Add Comment
Please, Sign In to add comment