Add onewire support, servo config