Control servo in my robot