Test code for the Pi-Duino-Teensy board, servo control