Simple A* pathfinding algorithm implementation, for 2D points and 3D point clouds.
Provide an input array of shape (N,2) or a point cloud (N,3). See the test file attached for more information.
Optimize implementation for bigger maps:
- speed-up neighbor search
- avoid sorting each time the open list entries
- use smarter heuristics
A* pseudo-code from wikipedia was used as inspiration for the 2D python implementation, the credits go there. Another great source for learning about pathfinding.
/Enjoy.