Add some more comments. Decouple drawing of path trail to a seperate helper function
Add comments to A* function
Fixed everything.