SpinToPort Overshoots

[chmorroni]

Let's add some interpolation or something so we don't overshoot the port. This could potentially be solved by running the vision processing in the RoboRIO.

FRC2020/src/main/java/frc/robot/commands/auto/SpinToPort.java

Lines 100 to 103 in c4b8933

	if(coords[0]<165 && coords[0]>155){
	System.out.println("DONE DONE DONE");
	isFinished = true;
	}