-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathmotor.c
51 lines (41 loc) · 1.66 KB
/
motor.c
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
#include "pwm.h"
int motor_init(void)
{
run_cmd("echo 334 > /sys/class/gpio/unexport", NULL, 0);
run_cmd("echo 314 > /sys/class/gpio/unexport", NULL, 0);
run_cmd("echo 320 > /sys/class/gpio/unexport", NULL, 0);
run_cmd("echo 334 > /sys/class/gpio/export", NULL, 0);
run_cmd("echo 314 > /sys/class/gpio/export", NULL, 0);
run_cmd("echo 320 > /sys/class/gpio/export", NULL, 0);
run_cmd("echo out > /sys/class/gpio/gpio334/direction", NULL, 0);
run_cmd("echo out > /sys/class/gpio/gpio314/direction", NULL, 0);
run_cmd("echo out > /sys/class/gpio/gpio320/direction", NULL, 0);
return 0;
}
int motor_deinit(void)
{
motor_state(0);
run_cmd("echo 334 > /sys/class/gpio/unexport", NULL, 0);
run_cmd("echo 314 > /sys/class/gpio/unexport", NULL, 0);
run_cmd("echo 320 > /sys/class/gpio/unexport", NULL, 0);
return 0;
}
int motor_state(int state)
{
if (0 == state) { // stop
run_cmd("echo 0 > /sys/class/gpio/gpio334/value", NULL, 0);
run_cmd("echo 0 > /sys/class/gpio/gpio314/value", NULL, 0);
run_cmd("echo 0 > /sys/class/gpio/gpio320/value", NULL, 0);
}
else if (1 == state) { // foreward
run_cmd("echo 0 > /sys/class/gpio/gpio334/value", NULL, 0);
run_cmd("echo 1 > /sys/class/gpio/gpio314/value", NULL, 0);
run_cmd("echo 1 > /sys/class/gpio/gpio320/value", NULL, 0);
}
else if (2 == state) { // backward
run_cmd("echo 1 > /sys/class/gpio/gpio334/value", NULL, 0);
run_cmd("echo 0 > /sys/class/gpio/gpio314/value", NULL, 0);
run_cmd("echo 1 > /sys/class/gpio/gpio320/value", NULL, 0);
}
return 0;
}