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);

  }

}

fsdfsdfsd

About Mr. Facebook