covariance

catkin_ws/src/asclinic_pkg/src/Kalman.cpp

@@ -223,9 +223,9 @@ int main(int argc, char **argv) {
     time_now = ros::Time::now();
     
     
-    pose_covariance <<  0.5, 0.5, 0.5,
-                        0.5, 0.5, 0.5,
-                        0.5, 0.5, 0.5;
+    pose_covariance <<  1, 1, 1,
+                        1, 1, 1,
+                        1, 1, 1;
 
     z_cov <<  1, 1, 1,
               1, 1, 1,