Arduino Code ช่วยแก้หน่อยครับ !!!

โค๊ดนี้ใช้ควบคุมมอเตอร์ 
ต้องการมห้มอเตอร์ทำงานเมื่อกดปุ่ม  ปุ่มเป็นแบบกดแล้วปุ่มจะล็อคค้างไว้ กดอีกทีปุ่มเด้งกลับเป็นปกติ
ต้องการให้กดปุ่ม ทำงาน Menu 1 มอเตอร์หมุน 5 วิ แล้วหยุด รอกดปุ่มอีกทีเพื่อ ทำงานคำสั่ง Menu2

ตอนนี้โค๊ตแสดงผลคือ เมื่อกดปุ่ม ทำงานMenu1
println("Motor Left"); และมันเด้งไป println("Motor Right"); เลย แต่คำสั่งไม่ทำงานนะ
แสดงผลแค่ Menu1 ส่วน Menu2 ขึ้นแค่Motor Right มอเตอร์ไม่หมุน

int motor1 = 2;  
int motor2 = 3;
int motor3 = 5;
int motor4 = 6; 
int buttonPin = 4;  
int buttonStart;  
int Menu = 0;
void setup(){
  pinMode(motor1, OUTPUT);
  pinMode(motor2, OUTPUT);
  pinMode(buttonPin, INPUT) ;
  Serial.begin(9600);
}
void loop()

{
  buttonStart = digitalRead(buttonPin);

  if (buttonStart == HIGH)
{
  delay (300);
  Menu=Menu+1;
{   
}
if (Menu==1)
{
  Serial.println("Motor Left");
  digitalWrite(motor1,LOW);
  digitalWrite(motor3,LOW);
  digitalWrite(motor1, HIGH);
  digitalWrite(motor3, HIGH);
  delay (5000);
}
else if(Menu==2)   
{
  Serial.println("Motor Right");
  digitalWrite(motor2,LOW);
  digitalWrite(motor4,LOW);
  digitalWrite(motor2, HIGH);
  digitalWrite(motor4, HIGH);
  delay (5000);}
}
}

  
แสดงความคิดเห็น
โปรดศึกษาและยอมรับนโยบายข้อมูลส่วนบุคคลก่อนเริ่มใช้งาน อ่านเพิ่มเติมได้ที่นี่