Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- from BrickPi import *
- BrickPiSetup()
- BrickPi.MotorEnable[PORT_A] = 1
- BrickPi.MotorEnable[PORT_B] = 1
- BrickPi.MotorEnable[PORT_C] = 1
- BrickPi.MotorEnable[PORT_D] = 1
- while True:
- c = raw_input ("Enter Direction")
- if c == "8": #Foward
- BrickPi.MotorSpeed[PORT_A] = -230
- BrickPi.MotorSpeed[PORT_D] = -230
- BrickPiUpdateValues()
- ot = time.time()
- while(time.time() - ot < .7):
- BrickPiUpdateValues()
- time.sleep(.1)
- elif c == "2": #Reverse
- BrickPi.MotorSpeed[PORT_A] = 230
- BrickPi.MotorSpeed[PORT_D] = 230
- BrickPiUpdateValues()
- ot = time.time()
- while(time.time() - ot < .7):
- BrickPiUpdateValues()
- time.sleep(.1)
- elif c == "4": #Left
- BrickPi.MotorSpeed[PORT_A] = 230
- BrickPi.MotorSpeed[PORT_D] = -230
- BrickPiUpdateValues()
- ot = time.time()
- while(time.time() - ot < .5):
- BrickPiUpdateValues()
- time.sleep(.1)
- elif c == "6": #Right
- BrickPi.MotorSpeed[PORT_A] = -230
- BrickPi.MotorSpeed[PORT_D] = 230
- BrickPiUpdateValues()
- ot = time.time()
- while(time.time() - ot < .5):
- BrickPiUpdateValues()
- time.sleep(.1)
- elif c == "7": #Arm Up
- BrickPi.MotorSpeed[PORT_B] = 100
- BrickPiUpdateValues()
- ot = time.time()
- while(time.time() - ot < .2):
- BrickPiUpdateValues()
- time.sleep(.1)
- elif c == "9": #Arm Down
- BrickPi.MotorSpeed[PORT_B] = -100
- BrickPiUpdateValues()
- ot = time.time()
- while(time.time() - ot < .2):
- BrickPiUpdateValues()
- time.sleep(.1)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement