Should return the distance to impact

- added method that calculates the distance between two points
#135