removed some groundtruth measurement processings

This commit is contained in:
Raphael Maenle 2019-06-11 17:03:05 +02:00
parent a0577dfb9d
commit a8d4580812

View File

@ -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}