added first A star algorithm which at the moment runs but doesn't succeed