diff --git a/src/sensor_odom_3D.cpp b/src/sensor_odom_3D.cpp
index a2c6a7cfe6ede71a00c4076b604804522b2d55fc..e65d2eb907feb4c07801152a76ee2998b98ee4e3 100644
--- a/src/sensor_odom_3D.cpp
+++ b/src/sensor_odom_3D.cpp
@@ -20,7 +20,7 @@ SensorOdom3D::SensorOdom3D(StateBlockPtr _p_ptr, StateQuaternionPtr _o_ptr, Intr
         min_disp_var_(params->min_disp_var),
         min_rot_var_(params->min_rot_var)
 {
-    //
+    noise_cov_ = (Eigen::Vector6s() << min_disp_var_, min_disp_var_, min_disp_var_, min_rot_var_, min_rot_var_, min_rot_var_).finished().asDiagonal();
 }
 
 SensorOdom3D::~SensorOdom3D()