commented visu parts cleanly
This commit is contained in:
@ -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);
|
||||
|
Reference in New Issue
Block a user