-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathstepper_mover.py
101 lines (79 loc) · 1.96 KB
/
stepper_mover.py
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
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
# without gpiofrom flask import Flask, render_template, Response
import time
# rpi
import RPi.GPIO as GPIO
GPIO.setmode(GPIO.BOARD)
GPIO.setwarnings(False)
# *************** rpi motor movement code start ****************
A = 3
B = 5
C = 7
D = 11
GPIO.setup(A, GPIO.OUT)
GPIO.setup(B, GPIO.OUT)
GPIO.setup(C, GPIO.OUT)
GPIO.setup(D, GPIO.OUT)
def GPIO_setup(a, b, c, d):
GPIO.output(A, a)
GPIO.output(B, b)
GPIO.output(C, c)
GPIO.output(D, d)
time.sleep(0.002)
def RIGHT_TURN(deg):
#full_circle = 200.0
#degree = full_circle / 360 * deg
degree = (deg)
print(degree)
while degree > 0:
GPIO_setup(1, 0, 0, 0)
GPIO_setup(1, 1, 0, 0)
GPIO_setup(0, 1, 0, 0)
GPIO_setup(0, 1, 1, 0)
GPIO_setup(0, 0, 1, 0)
GPIO_setup(0, 0, 1, 1)
GPIO_setup(0, 0, 0, 1)
GPIO_setup(1, 0, 0, 1)
degree -= 1
if degree == 0:
break
def LEFT_TURN(deg):
#full_circle = 200.0
# degree = full_circle / 360 * deg
degree = (deg)
print(degree)
# while True :
while degree > 0:
GPIO_setup(1, 0, 0, 1)
GPIO_setup(0, 0, 0, 1)
GPIO_setup(0, 0, 1, 1)
GPIO_setup(0, 0, 1, 0)
GPIO_setup(0, 1, 1, 0)
GPIO_setup(0, 1, 0, 0)
GPIO_setup(1, 1, 0, 0)
GPIO_setup(1, 0, 0, 0)
degree -= 1
if degree == 0:
break
# break
# degree -=1
def NO_TURN(deg):
GPIO_setup(0, 0, 0, 0)
def move_stepper(section):
if section == "A":
# arduino.write(notmatch)
RIGHT_TURN(5)
GPIO_setup(0, 0, 0, 0)
if section == "B":
# arduino.write(matching)
RIGHT_TURN(3)
GPIO_setup(0, 0, 0, 0)
if section == "D":
# arduino.write(notmatch)
LEFT_TURN(3)
GPIO_setup(0, 0, 0, 0)
elif section == "E":
LEFT_TURN(5)
GPIO_setup(0, 0, 0, 0)
else:
NO_TURN(0)
GPIO_setup(0, 0, 0, 0)