W Autonomous IR finding fixes

Now able to stop right where we want it to rather than endlessly run it
down. Also is able to go to the first basket.