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))