Update msckf_vio.cpp

This commit is contained in:
Raphael Maenle 2019-06-12 09:25:38 +00:00
parent b3df525060
commit 3e480560e8

View File

@ -1293,9 +1293,9 @@ void MsckfVio::PhotometricMeasurementJacobian(
dGpj_XpAj.block<3, 3>(0, 3) = Matrix<double, 3, 3>::Identity();
// Intermediate Jakobians
H_rho = dh_dGpij * dGpj_drhoj; // 1 x 1
H_plj = dh_dXplj; // 1 x 6
H_pAj = dh_dGpij * dGpj_XpAj; // 1 x 6
H_rho = dh_dGpij * dGpj_drhoj; // 2 x 1
H_plj = dh_dXplj; // 2 x 6
H_pAj = dh_dGpij * dGpj_XpAj; // 2 x 6
// calculate residual