#auto motor test
#input correct gpio (25, 24, 4, 18)
from motorClass import motor
from time import sleep
TRIALS = 100
INCREMENT = 0.2
REST = 0.01
#Input the 4 GPIOS in the correct order
m1 = motor(int(raw_input('motor 1 GPIO: ')))
m2 = motor(int(raw_input('motor 2 GPIO: ')))
m3 = motor(int(raw_input('motor 3 GPIO: ')))
m4 = motor(int(raw_input('motor 4 GPIO: ')))
motors = [m1, m2, m3, m4]
raw_input('Make sure motors are unplugged')
for i in range(0, 4):
motors[i].start()
motors[i].setPower(100)
raw_input('Plug in, and then hit enter')
for i in range(0, 4):
motors[i].PWM.add_channel_pulse(1,motors[i].pin, 0, 1000)
sleep(1.5)
motors[i].setPower(0)
for j in range(0,4):
#auto motor test
from motorClass import motor
from time import sleep
#we use 25, 24, 4, 18
GPIO = 18
RANGE = 500
increment = .2
rest = .01
m1 = motor(GPIO)
m1.start()
raw_input('press enter')
m1.setPower(100)
raw_input('plug in, then hit enter')
m1.PWM.add_channel_pulse(1,GPIO,0,1000)
raw_input('enter when ready to go')
m1.setPower(0)
for i in range(RANGE):
m1.addPower(increment)
print(str(m1.getPower())+'% ^')
sleep(rest)
sleep(1)
for i in range(RANGE + 1):
m1.addPower(-increment)
print(str(m1.getPower())+'% v')
#motor testor
#requires Python 1 or Python 2
from motorClass import motor
print('Enter BCM number: ')
pin = int(raw_input())
m1 = motor(pin)
print('Ensure ESC power is NOT connected.')
print('Press ENTER to start.')
input = raw_input()
m1.start()
#m1.setPower(100)
m1.PWM.add_channel_pulse(1, m1.pin, 0, 2999)
print('Wait for beepbeep.')
print('Then press ENTER.')
input = raw_input()
#m1.setPower(0)
m1.PWM.add_channel_pulse(1, m1.pin, 0, 1000)
print('Wait for 3 beeps, beeeeeep.')
print('Press ENTER to start.')
input = raw_input()
print('Increase: a Decrease: s Set Power: [percentage] Exit: x')
runMotor = True
try:
nums = set(['0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '.'])
#4 motor test
#requires Python 1 or Python 2
from motorClass import motor
from time import sleep
#using 25,24,4,18 (in order)
# get info for motor 1
print('Enter BCM number for motor 1: ')
pin = int(raw_input())
m1 = motor(pin)
# get info for motor 2
print('Enter BCM number for motor 2: ')
pin = int(raw_input())
m2 = motor(pin)
# get info for motor 3
print('Enter BCM number for motor 3: ')
pin = int(raw_input())
m3 = motor(pin)
# get info for motor 4
print('Enter BCM number for motor 4: ')
pin = int(raw_input())
m4 = motor(pin)
# array of all four motors
#motor testor
#requires Python 1 or Python 2
from motorClass import motor
print('Enter BCM number: ')
pin = int(raw_input())
m1 = motor(pin)
print('Ensure ESC power is NOT connected.')
print('Press ENTER to start.')
input = raw_input()
m1.start()
#m1.setPower(100)
m1.PWM.add_channel_pulse(1,m1.pin,0,2999)
print('Wait for beepbeep.')
print('Then press ENTER.')
input = raw_input()
#m1.setPower(0)
m1.PWM.add_channel_pulse(1,m1.pin,0,1000)
print('Wait for 3 beeps, beeeeeep.')
print('Press ENTER to start.')
input = raw_input()
print('Increase: a Decrease: s Set Power: [percentage] Exit: x')
#4 motor test
#requires Python 1 or Python 2
from motorClass import motor
from time import sleep
#using 25,24,4,18 (in order)
# get info for motor 1
print('Enter BCM number for motor 1: ')
pin = int(raw_input())
m1 = motor(pin)
# get info for motor 2
print('Enter BCM number for motor 2: ')
pin = int(raw_input())
m2 = motor(pin)
# get info for motor 3
print('Enter BCM number for motor 3: ')
pin = int(raw_input())
m3 = motor(pin)
# get info for motor 4
print('Enter BCM number for motor 4: ')
pin = int(raw_input())
m4 = motor(pin)
# array of all four motors
motors = [m1, m2, m3, m4]
