Add A* search and Line + Polygon class