Code for Astar now written and compiled.

All I have to do now is test it and fix whatever is broken as hell or just plain stupid. PS this is the slowest of the slow, it's pretty much a spastic (my nephew is a spastic so I can be offensive like that don't worry)