-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathTurn.ino
51 lines (42 loc) · 1.08 KB
/
Turn.ino
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
39
40
41
42
43
44
45
46
47
48
49
50
void turnLeft()
{
//Motor A forward @ turn speed
digitalWrite(DIR_A, LOW);
digitalWrite(BRAKE_A, LOW);
analogWrite(PWM_A, TURN_SPEED);
//Motor B backward @ turn speed
digitalWrite(DIR_B, HIGH);
digitalWrite(BRAKE_B, LOW);
analogWrite(PWM_B, TURN_SPEED);
delay(500);
digitalWrite(BRAKE_A, HIGH);
digitalWrite(BRAKE_B, HIGH);
}
void turnRight()
{
//Motor A backward @ turn speed
digitalWrite(DIR_A, HIGH);
digitalWrite(BRAKE_A, LOW);
analogWrite(PWM_A, TURN_SPEED);
//Motor B forward @ turn speed
digitalWrite(DIR_B, LOW);
digitalWrite(BRAKE_B, LOW);
analogWrite(PWM_B,TURN_SPEED);
delay(500);
digitalWrite(BRAKE_A, HIGH);
digitalWrite(BRAKE_B, HIGH);
}
void turn()
{
//Motor A backward @ calulated speed
digitalWrite(DIR_A, HIGH);
digitalWrite(BRAKE_A, LOW);
analogWrite(PWM_A, TURN_SPEED);
//Motor B backward @ calulated speed
digitalWrite(DIR_B, LOW);
digitalWrite(BRAKE_B, LOW);
analogWrite(PWM_B, TURN_SPEED);
delay(1500);
digitalWrite(BRAKE_A, HIGH);
digitalWrite(BRAKE_B, HIGH);
}