You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
33 lines
544 B
Python
33 lines
544 B
Python
6 years ago
|
import RPi.GPIO as GPIO
|
||
|
|
import time
|
||
|
|
from AlphaBot2 import AlphaBot2
|
||
|
|
|
||
|
|
Ab = AlphaBot2()
|
||
|
|
|
||
|
|
DR = 16
|
||
|
|
DL = 19
|
||
|
|
|
||
|
|
GPIO.setmode(GPIO.BCM)
|
||
|
|
GPIO.setwarnings(False)
|
||
|
|
GPIO.setup(DR,GPIO.IN,GPIO.PUD_UP)
|
||
|
|
GPIO.setup(DL,GPIO.IN,GPIO.PUD_UP)
|
||
|
|
|
||
|
|
try:
|
||
|
|
while True:
|
||
|
|
DR_status = GPIO.input(DR)
|
||
|
|
DL_status = GPIO.input(DL)
|
||
|
|
# print(DR_status,DL_status)
|
||
|
|
if((DL_status == 0) or (DR_status == 0)):
|
||
|
|
Ab.left()
|
||
|
|
#Ab.right()
|
||
|
|
time.sleep(0.002)
|
||
|
|
Ab.stop()
|
||
|
|
# print("object")
|
||
|
|
else:
|
||
|
|
Ab.forward()
|
||
|
|
# print("forward")
|
||
|
|
|
||
|
|
except KeyboardInterrupt:
|
||
|
|
GPIO.cleanup();
|
||
|
|
|