Why are you calculating a new path every frame. It makes no sense to do this so frequently and is the most likely cause of your problem. You are never going to reach the first waypoint in a single frame, never mind the rest of the waypoints generated.