Started working on implementing A*