Increase servo state publish frequency