-
Notifications
You must be signed in to change notification settings - Fork 7
/
Motors.ino
72 lines (64 loc) · 1.34 KB
/
Motors.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
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
/* This example drives each motor connected to the A-Star
32U4 Robot Controller forward, then backward. The yellow
user LED is on when a motor is set to a positive speed and
off when a motor is set to a negative speed. */
#include <AStar32U4.h>
AStar32U4Motors motors;
void setup()
{
// Uncomment to flip a motor's direction:
//motors.flipM1(true);
//motors.flipM2(true);
}
void loop()
{
// Run motor 1 forward.
ledYellow(1);
for (int speed = 0; speed <= 400; speed++)
{
motors.setM1Speed(speed);
delay(2);
}
for (int speed = 400; speed >= 0; speed--)
{
motors.setM1Speed(speed);
delay(2);
}
// Run motor 1 backward.
ledYellow(0);
for (int speed = 0; speed >= -400; speed--)
{
motors.setM1Speed(speed);
delay(2);
}
for (int speed = -400; speed <= 0; speed++)
{
motors.setM1Speed(speed);
delay(2);
}
// Run motor 2 forward.
ledYellow(1);
for (int speed = 0; speed <= 400; speed++)
{
motors.setM2Speed(speed);
delay(2);
}
for (int speed = 400; speed >= 0; speed--)
{
motors.setM2Speed(speed);
delay(2);
}
// Run motor 2 backward.
ledYellow(0);
for (int speed = 0; speed >= -400; speed--)
{
motors.setM2Speed(speed);
delay(2);
}
for (int speed = -400; speed <= 0; speed++)
{
motors.setM2Speed(speed);
delay(2);
}
delay(500);
}