Finish calcDistToPoint