Changed line of sight to take robot radius into account