removed some groundtruth measurement processings
This commit is contained in:
		@@ -430,7 +430,7 @@ void MsckfVio::imageCallback(
 | 
				
			|||||||
  
 | 
					  
 | 
				
			||||||
  //if(ErrState)
 | 
					  //if(ErrState)
 | 
				
			||||||
  //{
 | 
					  //{
 | 
				
			||||||
    batchTruthProcessing(feature_msg->header.stamp.toSec());
 | 
					  //batchTruthProcessing(feature_msg->header.stamp.toSec());
 | 
				
			||||||
    
 | 
					    
 | 
				
			||||||
    if(GROUNDTRUTH)
 | 
					    if(GROUNDTRUTH)
 | 
				
			||||||
    {
 | 
					    {
 | 
				
			||||||
@@ -1270,7 +1270,7 @@ void MsckfVio::PhotometricMeasurementJacobian(
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
  dCpij_dGpij = quaternionToRotation(cam_state.orientation);
 | 
					  dCpij_dGpij = quaternionToRotation(cam_state.orientation);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
  //orientation takes camera frame to world frame, we wa
 | 
					  //orientation takes camera frame to world frame
 | 
				
			||||||
  dh_dGpij = dh_dCpij * dCpij_dGpij;
 | 
					  dh_dGpij = dh_dCpij * dCpij_dGpij;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
  //dh / d X_{pl}
 | 
					  //dh / d X_{pl}
 | 
				
			||||||
 
 | 
				
			|||||||
		Reference in New Issue
	
	Block a user