Follow core:477 anisotropic noise in SensorPose

test/gtest_imu_mocap_fusion.cpp

@@ -117,8 +117,12 @@ class ImuMocapFusion_Test : public testing::Test
 
         // pose sensor and proc (to get extrinsics in the prb)
         auto intr_sp = std::make_shared<ParamsSensorPose>();
-        intr_sp->std_p = 0.001;
-        intr_sp->std_o = 0.001;
+        intr_sp->std_px = 0.001;
+        intr_sp->std_py = 0.001;
+        intr_sp->std_pz = 0.001;
+        intr_sp->std_ox = 0.001;
+        intr_sp->std_oy = 0.001;
+        intr_sp->std_oz = 0.001;
         Vector7d extr; extr << 0,0,0, 0,0,0,1;
         sensor_pose_ = problem_->installSensor("SensorPose", "pose", extr, intr_sp);
         auto params_proc = std::make_shared<ParamsProcessorPose>();