Add setup packet handle service routine and enable usb device function