package org.frc4931.zach.drive;

import edu.wpi.first.wpilibj.DigitalInput;

public class SingleLimitMotor extends Motor{
	public final DigitalInput limit;
	public int currentPosition = -1;
	public int moveDirection = 0;
	public boolean waitingForSwitch=false;
	
	public SingleLimitMotor(int channel, int type, int limit){
		super(channel, type);
		this.limit = new DigitalInput(limit);
	}
	
	public void toggle(){
		if(!limit.get()){
			System.out.println("Motor is lost, assuming motor is at "+currentPosition);
		}
		System.out.println("Motor is at "+currentPosition);
		moveDirection = currentPosition*-1;
	}
	
	public boolean update(double speed){
		if(moveDirection!=0){
			if(limit.get()){
				waitingForSwitch = true;
			}
			if(waitingForSwitch&&limit.get()){
				currentPosition = moveDirection;
				moveDirection = 0;
				waitingForSwitch = false;
				return true;
			}else{
				controller.set(speed*moveDirection);
				return false;
			}
		}
		return false;
	}
	
	
}

@@ -676,16 +676,17 @@
 %7B%0A%09%09%09if(
+!
 limit.ge

Revert "Modified SingleLimitMotor to use a normally open switch."