removed some groundtruth measurement processings
This commit is contained in:
		@@ -430,7 +430,7 @@ void MsckfVio::imageCallback(
 | 
			
		||||
  
 | 
			
		||||
  //if(ErrState)
 | 
			
		||||
  //{
 | 
			
		||||
    batchTruthProcessing(feature_msg->header.stamp.toSec());
 | 
			
		||||
  //batchTruthProcessing(feature_msg->header.stamp.toSec());
 | 
			
		||||
    
 | 
			
		||||
    if(GROUNDTRUTH)
 | 
			
		||||
    {
 | 
			
		||||
@@ -1270,7 +1270,7 @@ void MsckfVio::PhotometricMeasurementJacobian(
 | 
			
		||||
 | 
			
		||||
  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 / d X_{pl}
 | 
			
		||||
 
 | 
			
		||||
		Reference in New Issue
	
	Block a user