Moved focus finding functions to focus.utils. Added distance functions to Point. Removed commented code.