Added a basic, primitive algorithim for A*