Distance formula added to vision

Distance formula added to vision (Do we really need this? I'm guessing that we are going to swivel and tilt in order to achieve the desired X and Y coordinates).