Ejemplo n.º 1
0
class TankController():
    """ タンクコントローラー """
    def __init__(self):
        self.mc = MotorController()
        self.gt = getTargetThread()
        self.excutor = concurrent.futures.ThreadPoolExecutor(max_workers=1)
        self.excutor.submit(self.turret_move)
        self.lock = threading.Lock()
        #
        # 以下戦車の動作
        #
    def tank_go_forward(self):
        # 前進
        print("exec: ", sys._getframe().f_code.co_name)
        self.mc.forwardMotor1A(50)
        self.mc.forwardMotor1B(50)

    def tank_go_backward(self):
        # 後退
        print("exec: ", sys._getframe().f_code.co_name)
        self.mc.reverseMotor1A(50)
        self.mc.reverseMotor1B(50)

    def tank_stop(self):
        # 停止
        print("exec: ", sys._getframe().f_code.co_name)
        self.mc.breakMotor1A()
        self.mc.breakMotor1B()

    def tank_turn_right(self):
        # 右旋回
        print("exec: ", sys._getframe().f_code.co_name)
        self.mc.reverseMotor1A(50)
        self.mc.forwardMotor1B(50)

    def tank_turn_left(self):
        # 左旋回
        print("exec: ", sys._getframe().f_code.co_name)
        self.mc.forwardMotor1A(50)
        self.mc.reverseMotor1B(50)

        #
        # 以下砲台
        #
    def turret_follow(self):
        # 標的追尾開始
        print("exec: ", sys._getframe().f_code.co_name)
        self.gt.FollowStart()

    def turret_unfollow(self):
        # 標的追尾停止
        print("exec: ", sys._getframe().f_code.co_name)
        self.gt.FollowStop()

    def turret_shoot(self):
        # BB弾発射
        print("exec: ", sys._getframe().f_code.co_name)
        self.mc.forwardMotor2A(100)
        time.sleep(5)
        self.mc.breakMotor2A()

    def turret_move(self):
        # 砲台の旋回
        # getTargetThreadから標的の位置情報をもらって砲台を旋回させる。
        while True:
            TurretLeft = 0
            TurretRight = 0
            TurretLeft = self.gt.GetInfoTurretTurnLeft()
            TurretRight = self.gt.GetInfoTurretTurnRight()
            # print('turret left %1.2f right %1.2f' %(TurretLeft,TurretRight))
            # 時間計測開始
            start = time.time()
            print('tank_ctrl:logtime1 start')

            if TurretLeft != 0:
                self.lock.acquire()
                self.mc.forwardMotor2B(40)
                # print("turret:turnning left")
                time.sleep(TurretLeft)
                self.mc.breakMotor2B()
                self.gt.ClearInfoTurretTurnLeft()
                self.lock.release()
            elif TurretRight != 0:
                self.lock.acquire()
                self.mc.reverseMotor2B(40)
                # print("turret:turnning Right")
                time.sleep(TurretRight)
                self.mc.breakMotor2B()
                self.gt.ClearInfoTurretTurnRight()
                self.lock.release()
            else:
                # print("turret:No Action")
                time.sleep(0.5)

            time2 = time.time() - start
            print('tank_ctrl:logtime2 %1.2f sec' % (time2))