Apriltag: some improvements/changes

This MR has changes in:

• factor_autodiff_apriltag.h: The operator()was rewritten to remove some temporary variables and copies.
• gtest_factor_autodiff_apriltag.cpp: New test with non-zero values for extrinsics and frame pose. Also removed some wrong addConstrainedBy().
• processor_tracker_landmark_apriltag.cpp: After playing with the demo, the only change that remained is not providing features without orientation in detectNewFeatures() to avoid potential wrong frame and landmark initialization in future calls to reestimateLastFrame(). It could be implemented using a bool option in the processor parameters.
• processor_tracker.cpp a small bug fix also contained in !257 (merged).

TO DO: Ensure the proper frame coordinates for the error in FactorAutodiffApriltag::operator() to deal with covariance properly.

@mederic_fourmy, merge the current branch if you consider the contained changes are of your interest.

src/trajectory_base.cpp

@@ -95,14 +95,6 @@ FrameBasePtr TrajectoryBase::closestKeyFrameToTimeStamp(const TimeStamp& _ts)
             else
                 break;
         }
-    if (closest_kf != nullptr)
-    {
-        WOLF_INFO("TrajectoryBase::closestKeyFrameToTimeStamp: returning KF", closest_kf->id(), " with state ", closest_kf->getState().transpose());
-    }
-    else
-    {
-        WOLF_INFO("TrajectoryBase::closestKeyFrameToTimeStamp: returning nullptr");
-    }
     return closest_kf;
 }