Level one AI
Working on pathfinding
Pathfinding update is done by agent target rather than waypoint list first element