get 7 dof Astar working