Merge branch 'feature/apriltag_factor_optimization' of...

Merge branch 'feature/apriltag_factor_optimization' of https://gitlab.iri.upc.edu/mobile_robotics/wolf_projects/wolf_lib/wolf.git into feature/apriltag_factor_optimization