Initial A* Commit
A* Fully Implemented except for Obstacle Handling