Trust vision more in the localizer
Change-Id: Ia5dfa194c6fed344be889e7fda0fc6782446b45a
Signed-off-by: Austin Schuh <austin.linux@gmail.com>
diff --git a/y2022/localizer/localizer.cc b/y2022/localizer/localizer.cc
index 3f8e13d..783d368 100644
--- a/y2022/localizer/localizer.cc
+++ b/y2022/localizer/localizer.cc
@@ -642,7 +642,7 @@
H_model(1, kY) = 1.0;
H_accel(0, kX) = 1.0;
H_accel(1, kY) = 1.0;
- R.diagonal() << 1e-0, 1e-0;
+ R.diagonal() << 1e-2, 1e-2;
const Eigen::Matrix<double, kNModelStates, 2> K_model =
P_model_ * H_model.transpose() *