Moved focus finding functions to focus.utils. Added distance functions to Point.