def initialize():
ser.initialize()
wpNav.initialize()
wf.initialize()
odo.initialize(realWidth/2.0, realHeight/2.0)
wpNav.clearWaypoints()
wpNav.deactivate()
CONTROLLER.value = WAYPOINT
basicFor.value = basicAng.value = 0.0
stopCommand.value = 0
inWait.value = 1
p = mp.Process(target=controlLoop)
p.start()
def initialize():
ser.initialize(encPort = '/dev/arduino_encoders',motPort = '/dev/arduino_control', myBaud = 1000000)
#waypointNav.initialize()
ser.sendCommand(mot.getMotorCommandBytes(0,0))
