/** Runs drive code */
  private void joyDrive() {
    double[] rTheta = robotCore.joy.getRTheta();
    drive.move(rTheta[0], rTheta[1]);

    if (robotCore.joy.getDpadUp()) {
      drive.setReverseMode(true);
    }

    if (robotCore.joy.getDpadDown()) {
      drive.setReverseMode(false);
    }
    //		System.out.println(rTheta[0] + "\t" + (rTheta[1] * 180/Math.PI));
  }