Vision Based SLAM for a Humanoid robot