Algorithms: Add geometry library