rpi, added servo functionality