[camera plugin] Fix image_index and capture_result not properly filled

Signed-off-by: Beniamino Pozzan <b.pozzan@archangel.im>
mavlink · Nov 14, 2023 · ed17bbf · ed17bbf
1 parent ca50f1a
commit ed17bbf
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/mavros_extras/src/plugins/camera.cpp b/mavros_extras/src/plugins/camera.cpp
@@ -78,6 +78,8 @@ class CameraPlugin : public plugin::Plugin
     ic.geo.altitude = mo.alt / 1E3 + uas->data.geoid_to_ellipsoid_height(&ic.geo);  // in meters
     ic.relative_alt = mo.relative_alt / 1E3;
     ic.orientation = tf2::toMsg(ftf::mavlink_to_quaternion(mo.q));
+    ic.image_index = mo.image_index;
+    ic.capture_result = mo.capture_result;
     ic.file_url = mavlink::to_string(mo.file_url);
 
     camera_image_captured_pub->publish(ic);