fixed issue where pointSquaredDistance was used instead of actaul distance between poin ts to detect collisions
fixed issue where pointSquaredDistance was used instead of actaul distance between poin ts to detect collisions

rmkeezer/igvc-software,rmkeezer/igvc-software,RoboJackets/igvc-software,rmkeezer/igvc-software,RoboJackets/igvc-software,RoboJackets/igvc-software,RoboJackets/igvc-software