def do_driver(args):
arg = args.split()
test_passed = False
if len(arg) > 0:
var1 = float(arg[0])
print var1
var2 = float(arg[1])
print var2
var3 = float(arg[2])
print var3
else:
var1 = 0.5
var2 = var1
var3 = var1
try:
import outputs, testing
global test
test = outputs.Driver(1, 2, 3, 4)
print #nothing
print "Doing tankDriveRaw:"
test.tankDriveRaw(var1, var2)
print #nothing
print "Doing holonomicDriveRaw:"
test.holonomicDriveRaw(var1, var2, var3)
print #nothing
print "testing the fancy list-based versions, tankDrive then holonomicDrive"
test.tankDrive([0, var1], [0, var2])
test.holonomicDrive([var1, var2, 0, var3])
print #nothing
print "Don\'t forget to stop the robot"
test.stop()
test_passed = True
except:
print "fail"
if test_passed:
print "The robot is able to move, test passed"
import outputs as outs
import inputs as ins
import util
import arm
#import comm_to_base as base
util.sep()
stick1 = ins.Xbox(1)
util.sep()
gun = outs.relay(2)
outs.initComp()
util.sep()
drive = outs.Driver(1,2,3,4)
#drive = outs.Driver(1,2)
lsg = ins.line_sensor_group(6,7,8)
util.sep()
#def readForDog():
# return util.readFileandSplit("config.ini", 0, "True")
#doggy = readForDog()
doggy = True
util.sep()
def init():
print("Cool stuff done")
base.send("Bah-Dum")
import outputs as outs
import inputs as ins
import util
import autonomous_driver as ad
util.sep()
stick1 = ins.Xbox(1)
#stick2 = ins.Attack3(2)
util.sep()
gun = outs.relay(2)
outs.initComp()
util.sep()
#drive = outs.Driver(1,2,3,4)
drive = outs.Driver(1, 2)
lsg = ins.line_sensor_group(6, 7, 8)
util.sep()
#def readForDog():
# return util.readFileandSplit("config.ini", 0, "True")
#doggy = readForDog()
doggy = True
util.sep()
def init():
print("Cool stuff done")