Work from team 2

Including new code for a* search