Hyon's CVLibs for monoslam2