Fixes visual servo issues