- System.out.println(
- "PID Vals: " + driveController.getP() + " " + driveController.getI()
- + " " + driveController.getD());
+ // SmartDashboard.putNumber("x", xVal);
+ // SmartDashboard.putNumber("y", yVal);
+ //
+ // SmartDashboard.putNumber("left", driveTrain.getLeftEncoderDistance());
+ // SmartDashboard.putNumber("right", driveTrain.getRightEncoderDistance());
+ //
+ // System.out.printf("x: %.2f\t", xVal);
+ // System.out.printf("y: %.2f\t", yVal);
+ //
+ // System.out.printf("dist: %.2f\n", driveTrain.getAvgEncoderDistance());