Add servo (working)