fixed a bug with visual servoing