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