ตัวอย่างโปรแกรม
#define IN1 7
#define IN2 6
#define EN1 5
#define EN2 4
#define IN3 3
#define IN4 2
#define SW1 12
#define SW2 11
void setup() {
pinMode(IN1, OUTPUT);
pinMode(IN2, OUTPUT);
pinMode(IN3, OUTPUT);
pinMode(IN4, OUTPUT);
pinMode(EN1, OUTPUT);
pinMode(EN2, OUTPUT);
pinMode(SW1, INPUT);
pinMode(SW2, INPUT);
}
void loop(){
if (digitalRead (SW1)==0)
up();
else if (digitalRead (SW2)==0)
dow();
}
void up(){
digitalWrite(IN1, HIGH);
digitalWrite(IN2, LOW);
digitalWrite(EN1, HIGH);
digitalWrite(IN3, HIGH);
digitalWrite(IN4, LOW);
digitalWrite(EN2, HIGH);
delay(2000);
}
void dow(){
digitalWrite(IN1, LOW);
digitalWrite(IN2, HIGH);
digitalWrite(EN1, HIGH);
digitalWrite(IN3, LOW);
digitalWrite(IN4, HIGH);
digitalWrite(EN2, HIGH);
delay(2000);
}
15 окт 2024