12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

bug fix

release/4.3a0
Yong-Dian Jian 2010-12-28 23:07:02 +00:00
parent 97dfe6c034
commit 21d2dba609
1 changed files with 7 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
gtsam/slam/tests/testGeneralSFMFactor.cpp
View File

@ -319,19 +319,19 @@ TEST( GeneralSFMFactor, optimize_varK_FixLandmarks ) {
rot_noise = 1e-5,
trans_noise = 1e-3,
focal_noise = 1,
skew_noise = 1e-5,
distort_noise = 1e-5 ;
skew_noise = 1e-5;
if ( i == 0 ) {
values->insert((int)i, X[i]) ;
}
else {
Vector delta = Vector_(11,
rot_noise, rot_noise, rot_noise, trans_noise, trans_noise, trans_noise,
focal_noise, focal_noise, skew_noise, distort_noise, distort_noise) ;
// pose_noise*getGaussian(), pose_noise*getGaussian(), pose_noise*getGaussian(), // rotation
// pose_noise*getGaussian(), pose_noise*getGaussian(), pose_noise*getGaussian(), // translation
// calib_noise*getGaussian(), calib_noise*getGaussian(), calib_noise*getGaussian(), calib_noise*getGaussian(), calib_noise*getGaussian()); // K)
rot_noise, rot_noise, rot_noise, // rotation
trans_noise, trans_noise, trans_noise, // translation
focal_noise, focal_noise, // f_x, f_y
skew_noise, // s
trans_noise, trans_noise // ux, uy
) ;
values->insert((int)i, X[i].expmap(delta)) ;
}
}