diff --git a/include/gnss_utils/gnss_utils.h b/include/gnss_utils/gnss_utils.h
index 716a8fbd26dd38330afb64e0a99d42e4d9226557..646dd912149c8c523bba954dd4bd8e435ac0b8a8 100644
--- a/include/gnss_utils/gnss_utils.h
+++ b/include/gnss_utils/gnss_utils.h
@@ -38,9 +38,9 @@ namespace GNSSUtils
   };
 
   GNSSUtils::ComputePosOutput computePos(const Observations & _observations,
-                                    const Navigation & _navigation,
+                                    Navigation & _navigation,
                                     const prcopt_t & _prcopt);
-
+  
   Eigen::Vector3d ecefToLatLon(const Eigen::Vector3d & _ecef);
 }
 #endif
diff --git a/src/gnss_utils.cpp b/src/gnss_utils.cpp
index b5414ed431b8462667553c1b0a6ded4be45cb3fa..439e81bbea321ae2c5c07f51f334e2e09898f77a 100644
--- a/src/gnss_utils.cpp
+++ b/src/gnss_utils.cpp
@@ -4,11 +4,11 @@
 namespace GNSSUtils
 {
   GNSSUtils::ComputePosOutput computePos(const GNSSUtils::Observations & _observations,
-                                    const GNSSUtils::Navigation & _navigation,
+                                    GNSSUtils::Navigation & _navigation,
                                     const prcopt_t & _prcopt)
   {
     // Remove duplicated satellites
-    // uniqnav(&(_navigation.getNavigation()));
+    uniqnav(&(_navigation.getNavigation()));
 
     std::cout << "Number of navigation satellites: " << _navigation.getNavigation().n << "\n";
     std::cout << "Number of observations: " << _observations.getObservations().size() << "\n";
@@ -73,8 +73,6 @@ namespace GNSSUtils
     double pos[3];
     ecef2pos(&_ecef(0), pos);
 
-    return Eigen::Map<Eigen::Vector3d>(pos);
+    return Eigen::Vector3d(pos);
   }
-
-
 }