Added base locate subroutine

Added a subroutine that should locate the base.
Changed the position code to use locate base

This is a 10x better method than we were using before. Now we light
up all of the IR LEDs until we reach one. Once we reach one we light
them up one by one to see which one we reached. Need to accept input
from the user.