From 4d3cd73e91835cd2ae8d7b77940e442b5cef84ac Mon Sep 17 00:00:00 2001
From: Jeremie Deray <todo@stuff.com>
Date: Sat, 12 Aug 2017 18:14:13 +0200
Subject: [PATCH] test general case first

---
 src/CLaserOdometry2DNode.cpp | 12 ++++++------
 1 file changed, 6 insertions(+), 6 deletions(-)

diff --git a/src/CLaserOdometry2DNode.cpp b/src/CLaserOdometry2DNode.cpp
index 678ba81..1310a8e 100644
--- a/src/CLaserOdometry2DNode.cpp
+++ b/src/CLaserOdometry2DNode.cpp
@@ -185,18 +185,18 @@ void CLaserOdometry2DNode::LaserCallBack(const sensor_msgs::LaserScan::ConstPtr&
         current_scan_time = last_scan.header.stamp;
 
         //Initialize module on first scan
-        if (first_laser_scan)
-        {
-            Init(last_scan, initial_robot_pose.pose.pose);
-            first_laser_scan = false;
-        }
-        else
+        if (!first_laser_scan)
         {
             //copy laser scan to internal variable
             for (unsigned int i = 0; i<width; i++)
                 range_wf(i) = new_scan->ranges[i];
             new_scan_available = true;
         }
+        else
+        {
+          Init(last_scan, initial_robot_pose.pose.pose);
+          first_laser_scan = false;
+        }
     }
 }