CODE ARDUINO DIY máy in phẳng epson L800

[tranhung123456]

up đoạn code arduino này cho các bạn yêu thích tham khảo cho ý kiến
quan trọng là điểm đọc encoder chuyển sang pulse cho motor (step hay servo)

/* DIY DTG Arduino Uno code for Epson L800 DIY máy in phẳng UV(cẩn thận mua mực xịn nếu mua mực dỏm ; hư đầu in ráng chụi nha)
 * http://www.cncprovn.com
 * http://forum.cncprovn.com/forums/80-Arduino
 * Created: 26/4/2018 
 */

#define ENCODER_OPTIMIZE_INTERRUPTS
#include <Encoder.h>
#include <Bounce2.h>
//Khai báo chân encoder
Encoder epsonEncoder(2, 3); 
//Khai báo các nút nhấn (lấy khay in ra nút 5 )(đẩy khay in vào nút 4)(in trắng 2 pass nút 6)(cảm biến nhận in nút 10 start print)
int peSignal = 10;   
int inBtn = 4;     
int outBtn = 5;     
int passBtn = 6;   

int motorEnable = 7;     //  enable driver(step hay servo)
int motorDirection = 8;  // driver dir pin
int motorStep = 9;       // driver Pulse pin

int backStop = 11;  // Back or Home position

// khai báo các pulse (khoảng cách lấy khay in )ra vào 
int stepperPosition;  
int stepperCount;    
int stepperFactor = 35;                            
int platenState;         
int passCount;
int maxPasses;
int ejectSpeed = 550;  
int homeSpeed = 750;
int maxSteps = 9000;
long platenEncoder = 260000; 
int peMinEncoder = 12000;
int peMaxEncoder = 12500;
long positionEncoder  = -800; 
long newEncoder; 
    Bounce debouncer_inBtn = Bounce(); 
    Bounce debouncer_outBtn = Bounce(); 
    Bounce debouncer_backStop = Bounce();                         
void setup() {   
  Serial.begin(115200);
  Serial.println("Epson Encoder:");
  pinMode(motorStep, OUTPUT);
  pinMode(motorDirection, OUTPUT);
  pinMode(passBtn, INPUT_PULLUP);
  platenState = 1;  
  stepperPosition = 0;
  stepperCount = 0; 
  passCount = 0;
  pinMode(inBtn,INPUT_PULLUP);
  debouncer_inBtn.attach(inBtn);
  debouncer_inBtn.interval(5);
  pinMode(outBtn,INPUT_PULLUP);
  debouncer_outBtn.attach(outBtn);
  debouncer_outBtn.interval(5); 
  pinMode(backStop,INPUT_PULLUP);
  debouncer_backStop.attach(backStop);
  debouncer_backStop.interval(5);
  analogWrite(peSignal, 165);
}
void loop() {
    debouncer_inBtn.update();
    debouncer_outBtn.update();
    debouncer_backStop.update();
  int value_inBtn = debouncer_inBtn.read();
  int value_outBtn = debouncer_outBtn.read();
  int value_backStop = debouncer_backStop.read();
    if (value_inBtn == LOW & (stepperPosition) > 0){
      platenState = 2;
      passCount = 0;  // Reset the pass counter to 0.    
      }
     if (value_outBtn == LOW & (stepperPosition) < (maxSteps)) {
      platenState = 4;      
      }
switch (platenState) { 
   case 1:
          if (value_backStop == LOW) { 
            epsonEncoder.write(0);
            stepperPosition = 0;
            platenState = 4; 
            break;
          }          
        digitalWrite(motorDirection, HIGH); // Set motor to reverse
        digitalWrite(motorStep, HIGH); // Take a step
          delayMicroseconds(homeSpeed); // Step Speed
        digitalWrite(motorStep, LOW);  
     break;   
     case 2: 
          if (value_backStop == LOW) {
            epsonEncoder.write(0); 
            stepperPosition = 0; 
            platenState = 3;
            break;
          }          
        digitalWrite(motorDirection, HIGH);
        digitalWrite(motorStep, HIGH);
          delayMicroseconds(homeSpeed);
        digitalWrite(motorStep, LOW);
        stepperPosition--;       
     break;    
     case 3: 
     if (value_backStop == LOW) { 
        digitalWrite(motorDirection, LOW); 
        digitalWrite(motorStep, HIGH);
          delayMicroseconds(12500);
        digitalWrite(motorStep, LOW);     
      break;
      }
       newEncoder = epsonEncoder.read(); 
       if (newEncoder != positionEncoder) {
      stepperCount = newEncoder / stepperFactor;
   Serial.print("Encoder = ");
   Serial.print(newEncoder);
   Serial.println();
   Serial.print("Stepper Count = ");
   Serial.print(stepperCount);
   Serial.println();
   Serial.println(); 
    positionEncoder = newEncoder;
  }
      if (stepperCount > stepperPosition) { 
        digitalWrite(motorDirection, LOW);      
        digitalWrite(motorStep, HIGH); 
          digitalWrite(motorStep, LOW);
          stepperPosition++;
      }
      if (stepperCount < stepperPosition) {  
          digitalWrite(motorDirection, HIGH);                 
          digitalWrite(motorStep, HIGH);
          digitalWrite(motorStep, LOW);
          stepperPosition--;
      }
       if ((newEncoder) > peMinEncoder & (newEncoder) < peMaxEncoder) {
            analogWrite(peSignal, 0);     
       }
        if ((newEncoder) > platenEncoder) {
            analogWrite(peSignal, 165);
              passCount = passCount + 1;
            if (digitalRead(passBtn) == HIGH){ 
                maxPasses = 1;
            }
              else
            {
                maxPasses = 2;
            }
            if (passCount == maxPasses){ 
                 platenState = 4;   
            }
               else
            {
                platenState = 2; // Send the platen back in for automatic 2nd pass
            }                    
            }     
     break;    
     case 4:
       if (stepperPosition > maxSteps) {
        platenState = 0;        
        }
       digitalWrite(motorDirection, LOW); 
        digitalWrite(motorStep, HIGH); 
          delayMicroseconds(ejectSpeed);
        digitalWrite(motorStep, LOW);
        stepperPosition++;
     break;    
     default: 
     break; 
  }
}