Update msckf_vio.cpp
This commit is contained in:
parent
b3df525060
commit
3e480560e8
@ -1293,9 +1293,9 @@ void MsckfVio::PhotometricMeasurementJacobian(
|
|||||||
dGpj_XpAj.block<3, 3>(0, 3) = Matrix<double, 3, 3>::Identity();
|
dGpj_XpAj.block<3, 3>(0, 3) = Matrix<double, 3, 3>::Identity();
|
||||||
|
|
||||||
// Intermediate Jakobians
|
// Intermediate Jakobians
|
||||||
H_rho = dh_dGpij * dGpj_drhoj; // 1 x 1
|
H_rho = dh_dGpij * dGpj_drhoj; // 2 x 1
|
||||||
H_plj = dh_dXplj; // 1 x 6
|
H_plj = dh_dXplj; // 2 x 6
|
||||||
H_pAj = dh_dGpij * dGpj_XpAj; // 1 x 6
|
H_pAj = dh_dGpij * dGpj_XpAj; // 2 x 6
|
||||||
|
|
||||||
// calculate residual
|
// calculate residual
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user