Still things wrong with the path finding but there is a bug with  the smart entities dont know there are obstacles added after they were added, they need to have the path to the obstacles, not just a copy of the obstacles when they were instansiated
Almost done a*, doesnt work on large map for some reasons, treating the goal as an obstacle?