A* Shortest Path

- A couple of bug fixes in the original code
- Added a handful of useful functions
- Added shortest path algorithm