Finished up A* and started integrating