Hotfix: Correctly publish servo outputs