(Multiagent) Visual Slam for humanoid robot (and possibly ARDrone)