Fixed writing USB packets
USB cleanup