leftWheelX = -ROBOT_WIDTH / 2;
rightWheelX = ROBOT_WIDTH / 2;
leftWheelY = rightWheelY = 0;
turnControl = new AsynchronousPIDController(new PIDController(turnP,
turnI, turnD, gyro, this));
leftDriveControl = new AsynchronousPIDController(new PIDController(
driveP, driveI, driveD, encodDT1, this));
rightDriveControl = new AsynchronousPIDController(new PIDController(
driveP, driveI, driveD, encodDT2, this));
pointTurn = true;
leftDriveControl.addPIDListener(this);
rightDriveControl.addPIDListener(this);
turnControl.addPIDListener(this);