comments
added method to return distance from PID goal