USB init working

Still compile with debug statements but is able to init the USB driver
by calling usbStart in the shell