//ชื่อ ชั้น เลขที่ //тайский
//เมื่อกด sw แดง มอเตอร์ X,Y หมุนทวนเข็ม ทั้งสองตัว
//เมื่อกด sw น้ำเงิน มอเตอร์ X,Y หมุนทวนเข็ม ทั้งสองตัว
//เมื่อกด sw แดง มอเตอร์ X,Y หมุนทวนเข็ม ทั้งสองตัว
//เมื่อกด sw น้ำเงิน มอเตอร์ X,Y หมุนทวนเข็ม ทั้งสองตัว
const int DirX = 8;
const int StepX = 9;
const int DirY = 4;
const int StepY = 5;
const int sw1_pin = 2;
const int sw2_pin = 3;
void setup() {
pinMode(DirX, OUTPUT);
pinMode(StepX, OUTPUT);
pinMode(DirY, OUTPUT);
pinMode(StepY, OUTPUT);
pinMode(sw1_pin, INPUT_PULLUP);
pinMode(sw2_pin, INPUT_PULLUP);
}
void loop() {
if(digitalRead(sw1_pin) == LOW){
//มอเตอร์ X,Y หมุนตามเข็ม
digitalWrite(DirX, HIGH); // กำหนดการหมุน HIGH ตามเข็มนาฬิกา - LOW ทวนเข็มนาฬิกา
digitalWrite(DirY, HIGH);
digitalWrite(StepX, HIGH);
digitalWrite(StepY, HIGH);
delayMicroseconds(1000); // กำหนดความเร็วในการหมุน
digitalWrite(StepX, LOW);
digitalWrite(StepY, LOW);
delayMicroseconds(1000);
}
//เมื่อกด sw2 มอเตอร์ X,Y หมุนทวนเข็ม
if(digitalRead(sw2_pin) == LOW){
//มอเตอร์ X,Y หมุนตามเข็ม
digitalWrite(DirX, LOW); // กำหนดการหมุน HIGH ตามเข็มนาฬิกา - LOW ทวนเข็มนาฬิกา
digitalWrite(DirY, LOW);
digitalWrite(StepX, HIGH);
digitalWrite(StepY, HIGH);
delayMicroseconds(1000); // กำหนดความเร็วในการหมุน
digitalWrite(StepX, LOW);
digitalWrite(StepY, LOW);
delayMicroseconds(1000);
}
delay(10);
}