Refactor factor apriltag to devel

Factor is general enough to be included to core lib in order to be used in other plugins.