Towards Cooperative Visual-Based Localization, Mapping, and Servoing