Fixed __stdio_write.c to work with stdout
Fixed stdout to usb serial
Add some quick tests to main.c to test printf