Add servo support, although with a freq of 125 instead of 50.