Calculating location of ball and distance realative to robot