servo control added