174 lines
5.2 KiB
Python
174 lines
5.2 KiB
Python
import time
|
|
try:
|
|
from Led import *
|
|
led=Led()
|
|
def test_Led():
|
|
try:
|
|
led.ledIndex(0,255,0,0) #Red
|
|
led.ledIndex(1,255,125,0) #orange
|
|
led.ledIndex(2,255,255,0) #yellow
|
|
led.ledIndex(3,0,255,0) #green
|
|
led.ledIndex(4,0,255,255) #cyan-blue
|
|
led.ledIndex(5,0,0,255) #blue
|
|
led.ledIndex(6,128,0,128) #purple
|
|
led.ledIndex(7,255,255,255) #white
|
|
print "The LED has been lit, the color is red orange yellow green cyan-blue blue white"
|
|
time.sleep(3) #wait 10s
|
|
led.colorWipe(led.strip, Color(0,0,0)) #turn off the light
|
|
print "\nEnd of program"
|
|
except KeyboardInterrupt:
|
|
led.colorWipe(led.strip, Color(0,0,0)) #turn off the light
|
|
print "\nEnd of program"
|
|
except:
|
|
pass
|
|
|
|
|
|
from Motor import *
|
|
PWM=Motor()
|
|
def test_Motor():
|
|
try:
|
|
PWM.setMotorModel(1000,1000,1000,1000) #Forward
|
|
print "The car is moving forward"
|
|
time.sleep(1)
|
|
PWM.setMotorModel(-1000,-1000,-1000,-1000) #Back
|
|
print "The car is going backwards"
|
|
time.sleep(1)
|
|
PWM.setMotorModel(-1500,-1500,2000,2000) #Left
|
|
print "The car is turning left"
|
|
time.sleep(1)
|
|
PWM.setMotorModel(2000,2000,-1500,-1500) #Right
|
|
print "The car is turning right"
|
|
time.sleep(1)
|
|
PWM.setMotorModel(0,0,0,0) #Stop
|
|
print "\nEnd of program"
|
|
except KeyboardInterrupt:
|
|
PWM.setMotorModel(0,0,0,0)
|
|
print "\nEnd of program"
|
|
|
|
|
|
from Ultrasonic import *
|
|
ultrasonic=Ultrasonic()
|
|
def test_Ultrasonic():
|
|
try:
|
|
while True:
|
|
data=ultrasonic.get_distance() #Get the value
|
|
print ("Obstacle distance is "+str(data)+"CM")
|
|
time.sleep(1)
|
|
except KeyboardInterrupt:
|
|
print "\nEnd of program"
|
|
|
|
|
|
from Infrared_Obstacle_Avoidance import *
|
|
def test_Infrared():
|
|
try:
|
|
while True:
|
|
if GPIO.input(IR01)!=True and GPIO.input(IR02)==True and GPIO.input(IR03)!=True:
|
|
print 'Middle'
|
|
elif GPIO.input(IR01)!=True and GPIO.input(IR02)!=True and GPIO.input(IR03)==True:
|
|
print 'Right'
|
|
elif GPIO.input(IR01)==True and GPIO.input(IR02)!=True and GPIO.input(IR03)!=True:
|
|
print 'Left'
|
|
except KeyboardInterrupt:
|
|
print "\nEnd of program"
|
|
|
|
|
|
from servo import *
|
|
pwm=Servo()
|
|
def test_Servo():
|
|
try:
|
|
while True:
|
|
for i in range(50,110,1):
|
|
pwm.setServoPwm(1,0,i,0)
|
|
time.sleep(0.01)
|
|
for i in range(110,50,-1):
|
|
pwm.setServoPwm(1,0,i,0)
|
|
time.sleep(0.01)
|
|
for i in range(20,80,1):
|
|
pwm.setServoPwm(0,1,0,i)
|
|
time.sleep(0.01)
|
|
for i in range(80,20,-1):
|
|
pwm.setServoPwm(0,1,0,i)
|
|
time.sleep(0.01)
|
|
except KeyboardInterrupt:
|
|
pwm.setServoPwm(1,1,90,20)
|
|
print "\nEnd of program"
|
|
|
|
|
|
from ADC import *
|
|
adc=Adc()
|
|
def test_Adc():
|
|
try:
|
|
while True:
|
|
Left_IDR=adc.recvADC(0)
|
|
print ("The photoresistor voltage on the left is "+str(Left_IDR)+"V")
|
|
Right_IDR=adc.recvADC(1)
|
|
print ("The photoresistor voltage on the right is "+str(Right_IDR)+"V")
|
|
Power=adc.recvADC(2)
|
|
print ("The battery voltage is "+str(Power*3)+"V")
|
|
time.sleep(1)
|
|
print '\n'
|
|
except KeyboardInterrupt:
|
|
print "\nEnd of program"
|
|
|
|
from Buzzer import *
|
|
buzzer=Buzzer()
|
|
def test_Buzzer():
|
|
try:
|
|
buzzer.run(cmd.CMD_START)
|
|
time.sleep(1)
|
|
print "1S"
|
|
time.sleep(1)
|
|
print "2S"
|
|
time.sleep(1)
|
|
print "3S"
|
|
buzzer.run(cmd.CMD_STOP)
|
|
print "\nEnd of program"
|
|
except KeyboardInterrupt:
|
|
buzzer.run(cmd.CMD_STOP)
|
|
print "\nEnd of program"
|
|
|
|
import cv2
|
|
def test_Camera():
|
|
try:
|
|
print "\nOpen camera"
|
|
capturing_Flag = True
|
|
cap = cv2.VideoCapture(0)
|
|
while(capturing_Flag):
|
|
ret, frame = cap.read()
|
|
cv2.imshow("Capture", frame)
|
|
cv2.waitKey(5)
|
|
cv2.destroyAllWindows()
|
|
except KeyboardInterrupt:
|
|
print "\nClose camera"
|
|
capturing_Flag = False
|
|
|
|
# Main program logic follows:
|
|
if __name__ == '__main__':
|
|
|
|
print ('Program is starting ... ')
|
|
import sys
|
|
if len(sys.argv)<2:
|
|
print "Parameter error: Please assign the device"
|
|
exit()
|
|
if sys.argv[1] == 'Led':
|
|
test_Led()
|
|
elif sys.argv[1] == 'Motor':
|
|
test_Motor()
|
|
elif sys.argv[1] == 'Ultrasonic':
|
|
test_Ultrasonic()
|
|
elif sys.argv[1] == 'Infrared':
|
|
test_Infrared()
|
|
elif sys.argv[1] == 'Servo':
|
|
test_Servo()
|
|
elif sys.argv[1] == 'ADC':
|
|
test_Adc()
|
|
elif sys.argv[1] == 'Buzzer':
|
|
test_Buzzer()
|
|
elif sys.argv[1] == 'Camera':
|
|
test_Camera()
|
|
|
|
|
|
|
|
|
|
|