Skip to content
This repository was archived by the owner on Jan 21, 2021. It is now read-only.

Commit cb093b7

Browse files
authored
Add latest code, from competition
1 parent 4f23ec7 commit cb093b7

File tree

3 files changed

+129
-1
lines changed

3 files changed

+129
-1
lines changed

README.md

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -1,2 +1,2 @@
11
# PiWars
2-
Code for Reading School's Pi Wars robot
2+
code for Reading School piwars bot

Ultrasonic.py

Lines changed: 68 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,68 @@
1+
import RPi.GPIO as GPIO
2+
import time
3+
4+
GPIO.setmode(GPIO.BCM)
5+
6+
#TRIG = 17
7+
#ECHO = 27
8+
9+
#GPIO.setup(TRIG,GPIO.OUT)
10+
#GPIO.setup(ECHO,GPIO.IN)
11+
12+
#GPIO.output(TRIG, True)
13+
#time.sleep(0.00001)
14+
#GPIO.output(TRIG, False)
15+
16+
#while GPIO.input(ECHO) == False:
17+
18+
#while GPIO.input(ECHO) == True:
19+
# end = time.time()
20+
21+
#sig_time = end-start
22+
23+
##CM:
24+
#distance = sig_time / 0.000058
25+
26+
##inches:
27+
##distance = sig_time / 0.000148
28+
29+
#print('Distance: {} centimeters'.format(distance))
30+
31+
#GPIO.cleanup()
32+
33+
34+
TRIG = 17
35+
ECHO = 27
36+
print('Distance Measurement In Progress')
37+
38+
GPIO.setup(TRIG,GPIO.OUT)
39+
GPIO.setup(ECHO,GPIO.IN)
40+
GPIO.output(TRIG, False)
41+
42+
print('Waiting For Sensor To Settle')
43+
44+
time.sleep(2)
45+
46+
GPIO.output(TRIG, True)
47+
48+
time.sleep(0.00001)
49+
50+
GPIO.output(TRIG, False)
51+
52+
while GPIO.input(ECHO)==0:
53+
54+
pulse_start = time.time()
55+
56+
while GPIO.input(ECHO)==1:
57+
58+
pulse_end = time.time()
59+
60+
pulse_duration = pulse_end - pulse_start
61+
62+
#distance = pulse_duration * 171.50
63+
64+
#distance = round(distance, 3)
65+
66+
#print("Distance:",distance,"m")
67+
68+
GPIO.cleanup()

automatic.py

Lines changed: 60 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,60 @@
1+
# import curses and GPIO
2+
import RPi.GPIO as GPIO
3+
from time import sleep
4+
5+
#set GPIO numbering mode and define output pins
6+
7+
rb = 7 #in1 - right forward
8+
rf = 11 #in2 - right backward
9+
lb = 13 #in3 - left forward
10+
lf = 15 #in4 - left backward
11+
12+
enR = 8 #enA - right
13+
enL = 10 #enB - left
14+
15+
GPIO.setmode(GPIO.BOARD)
16+
17+
GPIO.setup(rb,GPIO.OUT)
18+
GPIO.setup(rf,GPIO.OUT)
19+
GPIO.setup(lb,GPIO.OUT)
20+
GPIO.setup(lf,GPIO.OUT)
21+
GPIO.setup(enR,GPIO.OUT)
22+
GPIO.setup(enL,GPIO.OUT)
23+
24+
GPIO.output(rf,False)
25+
GPIO.output(rb,False)
26+
GPIO.output(lf,False)
27+
GPIO.output(lb,False)
28+
29+
spR=GPIO.PWM(enR,1000) #speed - right
30+
spR.start(100)
31+
32+
spL=GPIO.PWM(enL,1000) #speed - left
33+
spL.start(100)
34+
35+
# turn 90 clockwise
36+
# turn 90 anticlockwise
37+
# distance
38+
# 1sec at 80 = 0.4m
39+
try:
40+
while True:
41+
x = input()
42+
43+
if x == 'q':
44+
break
45+
else:
46+
spL.ChangeDutyCycle(80)
47+
spR.ChangeDutyCycle(80)
48+
GPIO.output(rb,False)
49+
GPIO.output(rf,True)
50+
GPIO.output(lb,False)
51+
GPIO.output(lf,True)
52+
sleep(1)
53+
GPIO.output(rf,False)
54+
GPIO.output(lf,False)
55+
finally:
56+
GPIO.cleanup()
57+
58+
59+
60+

0 commit comments

Comments
 (0)