Object-based serial class
Move to object-based SPI
DiagLED functions
Move test to inside their respective function files