Hardware working

Tested Serial, LEDs, and Servo with buspirate