import math
import wpilib
import sys
import JoystickLib.joystickLib
from HolonomicDrive.HolonomicDrive import HolonomicDrive
from Shooter import ShootController
from JoystickLib.Gamepad import Gamepad
import Vision
import networktables
from networktables import NetworkTable
from TheNewArm import NewArm
from Lifter import Lifter
#import globalListener
NetworkTable.setServerMode()
num_array = networktables.NumberArray()
# noinspection PyInterpreter,PyInterpreter
class MainRobot (wpilib.IterativeRobot):
def robotInit(self):
#!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
self.BELT_BROKEN = False
#!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
self.Lift = Lifter.Lifter()
self.Vision = Vision.Vision()
self.usinggamepad = True
self.FL = wpilib.CANTalon(2)
