The fuse stack provides a general architecture for performing sensor fusion live on a robot. Some possible applications include state estimation, localization, mapping, and calibration.
I added the variables necessary to represent a pinhole camera, along with constraints for fixed landmarks to optimize over the cameras 6-dof position using reprojection error, and optionally optimize for intrinsics. Use cases are represented in the unit tests. We can formalize a marker as a 6-dof pose and turn it into an arbitrary set of points in the marker coordinate frame.
I added the variables necessary to represent a pinhole camera, along with constraints for fixed landmarks to optimize over the cameras 6-dof position using reprojection error, and optionally optimize for intrinsics. Use cases are represented in the unit tests. We can formalize a marker as a 6-dof pose and turn it into an arbitrary set of points in the marker coordinate frame.