Fixed minor waypoint angle issue