commented visu parts cleanly

This commit is contained in:
2019-04-19 13:32:16 +02:00
parent 1949e4c43d
commit 8defb20c8e
2 changed files with 11 additions and 11 deletions

View File

@ -977,7 +977,7 @@ void MsckfVio::PhotometricMeasurementJacobian(
r = z - Vector4d(p_c0(0)/p_c0(2), p_c0(1)/p_c0(2),
p_c1(0)/p_c1(2), p_c1(1)/p_c1(2));
// visu
// visu -residual
//printf("-----\n");
//estimate photometric measurement
@ -989,7 +989,7 @@ void MsckfVio::PhotometricMeasurementJacobian(
for(int i = 0; i < photo_z.size(); i++)
photo_r.push_back(photo_z[i] - estimate_photo_z[i]);
// visu
// visu- residual
//for(int i = 0; i < photo_z.size(); i++)
// printf("%.4f = %.4f - %.4f\n",photo_r[i], photo_z[i], estimate_photo_z[i]);
@ -1024,11 +1024,11 @@ void MsckfVio::PhotometricFeatureJacobian(
int stack_cntr = 0;
// visu
/*
printf("_____FEATURE:_____\n");
cam0.featureVisu.release();
*/
// visu - residual
//printf("_____FEATURE:_____\n");
// visu - feature
//cam0.featureVisu.release();
for (const auto& cam_id : valid_cam_state_ids) {
Matrix<double, 4, 6> H_xi = Matrix<double, 4, 6>::Zero();
@ -1046,7 +1046,7 @@ void MsckfVio::PhotometricFeatureJacobian(
r_j.segment<4>(stack_cntr) = r_i;
stack_cntr += 4;
}
// visu
// visu - feature
/*
if(!cam0.featureVisu.empty() && cam0.featureVisu.size().width > 3000)
imshow("feature", cam0.featureVisu);