add servo support(TEMP)