usb-mtp: refactor the flow of usb_mtp_write_data