If calculated distance is out of range the published value is -1
Merge pull request #8 from JohanJohansson/master

If calculated distance is out of range the published value is -1
Merge pull request #1 from RoboGroup3/master

Update fork