Merge branch 'master' into solver_manager_gtest

src/constraint_GPS_pseudorange_2D.h

@@ -4,8 +4,8 @@
 #define LIGHT_SPEED_ 299792458
 
 //Wolf includes
-#include <sensor_GPS.h>
-#include "feature_gps_pseudorange.h"
+#include "sensor_GPS.h"
+#include "feature_GPS_pseudorange.h"
 #include "constraint_autodiff.h"
 
 //std

src/processor_GPS.cpp

@@ -6,7 +6,7 @@
 #include <feature_GPS_pseudorange.h>
 #include <processor_GPS.h>
 
-#include "capture_gps.h"
+#include "capture_GPS.h"
 
 namespace wolf
 {

src/processor_GPS.h

@@ -7,7 +7,7 @@
 
 // Wolf includes
 #include "processor_base.h"
-#include "capture_gps.h"
+#include "capture_GPS.h"
 
 // Std includes
 

src/solver/solver_manager.cpp

@@ -55,9 +55,7 @@ void SolverManager::update()
       }
       case StateBlock::Notification::STATE_UPDATE:
       {
-        const bool registered = state_blocks_.find(state)!=state_blocks_.end();
-
-        WOLF_DEBUG_COND(!registered,
+        WOLF_DEBUG_COND(state_blocks_.find(state)==state_blocks_.end(),
                         "Updating the state of an unregistered StateBlock !");
 
         // This will throw if StateBlock wasn't registered