Add servo support