Searched refs:ipz2fy (Results 1 – 2 of 2) sorted by relevance
/dports/math/g2o/g2o-20201223_git/g2o/types/sba/ |
H A D | types_sba.cpp | 224 number_t ipz2fy = ipz2*cam.Kcam(1,1); // Fy in linearizeOplus() local 233 _jacobianOplusXj(1,3) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 238 _jacobianOplusXj(1,4) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 243 _jacobianOplusXj(1,5) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 249 _jacobianOplusXj(1,0) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 253 _jacobianOplusXj(1,1) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 257 _jacobianOplusXj(1,2) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 264 _jacobianOplusXi(1,0) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 268 _jacobianOplusXi(1,1) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 272 _jacobianOplusXi(1,2) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() [all …]
|
/dports/math/g2o/g2o-20201223_git/g2o/types/icp/ |
H A D | types_icp.cpp | 269 number_t ipz2fy = ipz2*vc->Kcam(1,1); // Fy in linearizeOplus() local 280 _jacobianOplusXj(1,3) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 285 _jacobianOplusXj(1,4) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 290 _jacobianOplusXj(1,5) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 296 _jacobianOplusXj(1,0) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 300 _jacobianOplusXj(1,1) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 304 _jacobianOplusXj(1,2) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 311 _jacobianOplusXi(1,0) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 315 _jacobianOplusXi(1,1) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus() 319 _jacobianOplusXi(1,2) = (pz*dp(1) - py*dp(2))*ipz2fy; in linearizeOplus()
|