diff --git a/catkin_ws/src/asclinic_pkg/src/Kalman.cpp b/catkin_ws/src/asclinic_pkg/src/Kalman.cpp index e48102a4074dc4e1f5282e85182b76b14c8e85c2..ac56b73d2a2199a0951fb86af94b208acad14f1f 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);