Got integration between fiducials and mapping starting to work.