Added A*

Pretty much works