Check ranges before access (#2540)

Added a check for non-empty laser scan ranges before accessing the elements. Signed-off-by: Ian Chen <ichen@openrobotics.org>
gazebosim · Aug 26, 2024 · a33e246 · a33e246
1 parent bf05593
commit a33e246
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/src/systems/elevator/Elevator.cc b/src/systems/elevator/Elevator.cc
@@ -421,6 +421,9 @@ void ElevatorPrivate::UpdateState(const gz::sim::UpdateInfo &_info,
 void ElevatorPrivate::OnLidarMsg(size_t _floorLevel,
                                  const msgs::LaserScan &_msg)
 {
+  if (_msg.ranges_size() <= 0)
+    return;
+
   bool isDoorwayBlocked = _msg.ranges(0) < _msg.range_max() - 0.005;
   if (isDoorwayBlocked == this->isDoorwayBlockedStates[_floorLevel]) return;
   std::lock_guard<std::recursive_mutex> lock(this->mutex);