From 09edf62e60a6ddbf70f9c1171483e5b793430178 Mon Sep 17 00:00:00 2001
From: Ethan <jiaao@student.unimelb.edu.au>
Date: Tue, 21 May 2024 12:31:08 +0800
Subject: [PATCH] covariance

---
 catkin_ws/src/asclinic_pkg/src/Kalman.cpp | 6 +++---
 1 file changed, 3 insertions(+), 3 deletions(-)

diff --git a/catkin_ws/src/asclinic_pkg/src/Kalman.cpp b/catkin_ws/src/asclinic_pkg/src/Kalman.cpp
index e48102a4..ac56b73d 100644
--- a/catkin_ws/src/asclinic_pkg/src/Kalman.cpp
+++ b/catkin_ws/src/asclinic_pkg/src/Kalman.cpp
@@ -227,9 +227,9 @@ int main(int argc, char **argv) {
                         1, 1, 1,
                         1, 1, 1;
 
-    z_cov <<  1, 1, 1,
-              1, 1, 1,
-              1, 1, 1;
+    z_cov <<  5, 5, 5,
+              5, 5, 5,
+              5, 5, 5;
 
     m_subscriber = nh.subscribe("/asc/encoder_counts", 1, answer);
     image_subscriber = nh.subscribe("/image_estimation", 1, ImageAnswer);
-- 
GitLab