1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
|
int m1enA = 6;
int m1enB = 5;
int m1pwm1 = 4;
int m1pwm2 = 3;
int m1encoA = 32;
int m1encoB = 31;
void setup() {
Serial.begin(9600);
pinMode(m1enA, OUTPUT);
pinMode(m1enB, OUTPUT);
pinMode(m1pwm1, OUTPUT);
pinMode(m1pwm2, OUTPUT);
pinMode(m1pwm1, INPUT);
pinMode(m1pwm2, INPUT);
}
void loop() {
digitalWrite(m1enA, HIGH);
digitalWrite(m1enB, LOW);
digitalWrite(m1pwm1, HIGH);
digitalWrite(m1pwm2, LOW);
delay(500);
digitalWrite(m1enA, HIGH);
digitalWrite(m1enB, LOW);
digitalWrite(m1pwm1, LOW);
digitalWrite(m1pwm2, HIGH);
delay(500);
}
|
