Everything put together.
Finished Astar
Finished moving from one node to another
Finished using convergent particle to move to dest.
Need to fix small bug with buildGraph - misses out few connections.