making waypoint system
Working version of Pathfinding system Not perfect yet but usable for testing and developing the game