Update code still need to be change some things but read out the usb is working.