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
33
34
35
36
37
38
|
#include <SoftPWM.h>
int m1enA = LED_BUILTIN;
int m1enB = 5;
int m1pwm1 = 4;
int m1pwm2 = 3;
int m1encoA = 32;
int m1encoB = 31;
void setup() {
Serial.begin(9600);
SoftPWMBegin();
SoftPWMSetPolarity(m1enA, 0);
SoftPWMSet(m1enA, 0);
pinMode(m1enB, OUTPUT);
pinMode(m1pwm1, OUTPUT);
pinMode(m1pwm2, OUTPUT);
pinMode(m1pwm1, INPUT);
pinMode(m1pwm2, INPUT);
}
void loop() {
SoftPWMSet(m1enA, 50);
digitalWrite(m1enB, LOW);
digitalWrite(m1pwm1, HIGH);
digitalWrite(m1pwm2, LOW);
delay(500);
SoftPWMSet(m1enA, 255);
digitalWrite(m1enA, HIGH);
digitalWrite(m1enB, LOW);
digitalWrite(m1pwm1, LOW);
digitalWrite(m1pwm2, HIGH);
delay(500);
}
|
