Merge pull request #1667 from BOB4Drone/ros2

fix bof
mavlink · Dec 3, 2021 · 7d357ff · 7d357ff
2 parents 90552cc + 4c94dd0
commit 7d357ff
Showing 1 changed file with 5 additions and 1 deletion.
diff --git a/mavros_extras/src/plugins/trajectory.cpp b/mavros_extras/src/plugins/trajectory.cpp
@@ -392,7 +392,11 @@ class TrajectoryPlugin : public plugin::Plugin
       };
 
     tr_desired.header = uas->synchronized_header("local_origin", trajectory.time_usec);
-
+
+    if (trajectory.valid_points > tr_desired.point_valid.size()) {
+      return ;
+    }
+
     for (int i = 0; i < trajectory.valid_points; ++i) {
       tr_desired.point_valid[i] = true;
     }