public double getRightEncoderDistance() { return rightEncoder.get() / 256.0 * 3.5 * Math.PI; }
public double getLeftEncoderDistance() { return leftEncoder.get() / 256.0 * 3.5 * Math.PI; }