Add Firmata servo support