import easyiceconfig as EasyIce
from MyAlgorithm import MyAlgorithm
from PyQt5.QtWidgets import QApplication
if __name__ == "__main__":
cfg = config.load(sys.argv[1])
#starting comm
jdrc = comm.init(cfg, 'FollowLineF1')
cameraL = jdrc.getCameraClient("FollowLineF1.CameraLeft")
cameraR = jdrc.getCameraClient("FollowLineF1.CameraRight")
motors = jdrc.getMotorsClient("FollowLineF1.Motors")
pose_client = jdrc.getPose3dClient("FollowLineF1.Pose")
algorithm = MyAlgorithm(cameraL, cameraR, motors, pose_client)
app = QApplication(sys.argv)
myGUI = MainWindow()
myGUI.setCameraL(cameraL)
myGUI.setPose(pose_client)
myGUI.setCameraR(cameraR)
myGUI.setMotors(motors)
myGUI.setAlgorithm(algorithm)
myGUI.show()
t2 = ThreadGUI(myGUI)
t2.daemon = True
t2.start()
sys.exit(app.exec_())
