Astar working!!

Now the enhancements needs to be implemented