added pathfolling by using waypoints (Array with Vectors)