Vision code for Humanoid Robot