Make sure spline point is flagged reached,

even when the UAV is flying very off from the waypoint;
waypoint always start from time 0.0f