fix(autonomous_emergency_braking): fix invalid access to imu_ptr

Signed-off-by: Mamoru Sobue <[email protected]>
autowarefoundation · May 30, 2024 · 323ec98 · 323ec98
1 parent 6e5d597
commit 323ec98
Showing 1 changed file with 6 additions and 3 deletions.
diff --git a/control/autonomous_emergency_braking/src/node.cpp b/control/autonomous_emergency_braking/src/node.cpp
@@ -301,10 +301,13 @@ bool AEB::fetchLatestData()
   }
 
   const auto imu_ptr = sub_imu_.takeData();
-  if (use_imu_path_ && !imu_ptr) {
-    return missing("imu message");
+  if (use_imu_path_) {
+    if (!imu_ptr) {
+      return missing("imu message");
+    }
+    // imu_ptr is valid
+    onImu(imu_ptr);
   }
-  onImu(imu_ptr);
   if (use_imu_path_ && !angular_velocity_ptr_) {
     return missing("imu");
   }