Path finding implemented (A*)