adding servo controller logic