Smart-Trashbox/test.py at master · jarsam/Smart-Trashbox · GitHub

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
import time
import math
import RPi.GPIO as GPIO
GPIO.setmode(GPIO.BOARD)
GPIO.setup(29,GPIO.OUT)
GPIO.setup(31,GPIO.OUT)
GPIO.setup(33,GPIO.OUT)
GPIO.setup(35,GPIO.OUT)
GPIO.setup(32,GPIO.OUT)
GPIO.setup(36,GPIO.OUT)
GPIO.setup(38,GPIO.OUT)
GPIO.setup(40,GPIO.OUT)

def pmw(v1,v2):
		if v1 > 0:
			GPIO.output(29,1)
			GPIO.output(31,0)
			GPIO.output(33,1)
			GPIO.output(35,0)
		else:
			if v1 != 0:
				GPIO.output(29,0)
				GPIO.output(31,1)
				GPIO.output(33,0)
				GPIO.output(35,1)
		if v2 > 0:
			GPIO.output(32,1)
			GPIO.output(36,0)
			GPIO.output(38,1)
			GPIO.output(40,0)
		else:
			if v2 != 0:
				GPIO.output(32,0)
				GPIO.output(36,1)
				GPIO.output(38,0)
				GPIO.output(40,1)
		if v1 <= v2:
			time.sleep(0.05*math.fabs(v1))
			GPIO.output(29,0)
			GPIO.output(31,0)
			GPIO.output(33,0)
			GPIO.output(35,0)
			time.sleep(0.05*math.fabs(math.fabs(v2) - math.fabs(v1)))
			GPIO.output(32,0)
			GPIO.output(36,0)
			GPIO.output(38,0)
			GPIO.output(40,0)
			time.sleep(0.05 - 0.05*math.fabs(v2))
		else:
			#time.sleep(0.05*math.fabs(v2))
			GPIO.output(32,0)
			GPIO.output(36,0)
			GPIO.output(38,0)
			GPIO.output(40,0)
			time.sleep(0.05*v1)
			GPIO.output(29,0)
			GPIO.output(31,0)
			GPIO.output(33,0)
			GPIO.output(35,0)
			time.sleep(0.05 - 0.05*v1)

for i in range(50):
	#input = raw_input()
	#if input == 'stop':
	#	break
	#up_point = input.find('up')
	#koron_point = input.find(':')
	#yoko_point = ipput.find('yoko')
	#up = float(input[up_point+2,koron_point])
	#yoko = float(input[koron_point+1,len(input)])
	GPIO.output(29,1)
	GPIO.output(31,0)
	GPIO.output(33,1)
	GPIO.output(35,0)
GPIO.output(29,0)
GPIO.output(31,0)
GPIO.output(33,0)
GPIO.output(35,0)

GPIO.cleanup()