Arduino thực hành-đk vị trí động cơ bước

Bài 1: nhập số mm muốn động cơ bước chạy vào màn hình monitor. Động cơ bước sẽ chạy theo đúng số mm đã nhập lúc trước.

ở ví dụ này,

- Driver : tôi áp dụng cho động cơ bước, vi bước 1/2 tức 400 xung quay một vòng.

- Pully gt2 20 răng, như vậy cứ quay một vòng thì động cơ đi được 40mm

Vậy để đi 1mm cần 10 xung.

#include <Arduino.h>
int dirX = 5;
int stepX = 2;
int soBuoc = 100;
int longX = 0;
int i = 0;

void setup() {
  Serial.begin(9600);
  pinMode(dirX, OUTPUT);
  pinMode(stepX, OUTPUT);
}

void loop() {
  // Xuất ra màn hình monitor số mm muốn nhập vào
  Serial.print("Motor di chuyen bao nhieu mm ");  
  Serial.println("\n");  
  while(Serial.available() == 0){
  }

  // gán số mm đã gõ ở trên vào biến longX
  longX = Serial.parseInt(); 

  //Tính tổng số bước (tức số lần biến i tăng)
  // Thiết lập động cơ quay xuôi
  soBuoc = longX*10;
  dirX = HIGH;

  //Vòng lặp for băm xung cho động cơ quay
  for(i = 1; i <= soBuoc; i++){
    Serial.print(String("Số xung đã chạy là: ") + i);
    Serial.print("\n");
    digitalWrite(stepX, HIGH);
    delay(1);
    digitalWrite(stepX, LOW);
    delay(1);
  }


}