added state publisher to servo controller