new changes in obviously --> (aplications/astar_test & obvision/planning/Astar) to be checked