/** 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)); }