Initial test

Tested UART @9600, I2C, SPI, Step-dir
Also tested driver code in full, half, and wave modes, comparator
Code finished, need to test PWM.
Need to add speed input and more serial commands