from RTCJoystick import Joystick
from Control import Control
from config import *
import time
import GstCV
import cv2
import pyzbar.pyzbar as pyzbar

# cv2.aruco

joystick = Joystick()
joystick.connect("/dev/input/js0")
joystick.info()

control = Control()
control.setJoystick(joystick)
control.robot.connect(IP, PORT)

joystick.start()
control.start()
camera = GstCV.CVGstreamer(IP, 5000, 5001, 5005, toAVS=False, codec="JPEG")
camera.start()

#WIDTH, HEIGHT = 320, 240
WIDTH, HEIGHT = 640, 480

#Для автономных  полей
SENSIVITY = 80  # чувствительность автономки
# Для наклонной
#SENSIVITY = 75