public void setIndexWheels(double target) {
System.out.println("index target is " + target);
indexTarget = target;
error = indexTarget - indexPosition.get();
if (error > 0.04) {
openIndexWheels.set(Relay.Value.kForward);
} else if (error < -0.04) {
openIndexWheels.set(Relay.Value.kReverse);
} else {
openIndexWheels.set(Relay.Value.kOff);
}
}
public double getIndexPosition() {
return indexPosition.get();
}