def systemInit():
#glo.MODE_SELECT select the workmodel
#1: TrackTest 2: BallTest 3: TogetherRun
if glo.MODE_SELECT == 1:
glo.TheKobuki = Kobuki(glo.KOBUKI_COM)
#glo.TheDobot = Dobot(glo.DOBOT_COM)
glo.TheDirection = glo.PID(P=glo.TRACK_P, D=glo.TRACK_D)
glo.TheThreadLock = threading.Lock()
glo.TheTrackThread = TrackThread(1, "Track", 1)
glo.TheTrackThread.start()
elif glo.MODE_SELECT == 2:
glo.TheKobuki = Kobuki(glo.KOBUKI_COM)
glo.TheThreadLock = threading.Lock()
glo.TheBallThread = BallThread(2, "Ball", 2)
glo.TheBallThread.start()
else:
time.sleep(3)
glo.TheKobuki = Kobuki(glo.KOBUKI_COM)
glo.TheDobot = Dobot(glo.DOBOT_COM)
glo.TheDirection = glo.PID(P=glo.TRACK_P, D=glo.TRACK_D)
glo.TheThreadLock = threading.Lock()
glo.TheTrackThread = TrackThread(1, "Track", 1)
glo.TheTrackThread.start()
glo.TheBallThread = BallThread(2, "Ball", 2)
glo.TheBallThread.start()
time.sleep(0.5)
def systemInit():
glo.TheKobuki = Kobuki(glo.KOBUKI_COM)
#glo.TheDobot = Dobot(glo.DOBOT_COM)
glo.TheDirection = glo.PID(P=glo.TRACK_P, D=glo.TRACK_D)
glo.TheThreadLock = threading.Lock()
glo.TheTrackThread = TrackThread(1, "Track", 1)
glo.TheTrackThread.start()
def systemInit():
#glo.MODE_SELECT select the workmodel
#1: TrackTest 2: BallTest 3: TogetherRun
if glo.MODE_SELECT == 1:
glo.TheKobuki = Kobuki(glo.KOBUKI_COM)
#glo.TheDobot = Dobot(glo.DOBOT_COM)
glo.TheDirection = glo.PID(P=glo.TRACK_P, D=glo.TRACK_D)
glo.TheThreadLock = threading.Lock()
glo.TheTrackThread = TrackThread(1, "Track", 1)
glo.TheTrackThread.start()
glo.TheStrategyThread = StrategyThread(3, "Strategy", 3)
glo.TheStrategyThread.start()
elif glo.MODE_SELECT == 2:
pass
else:
pass