11146ee4aSGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0 261e12104SWon Kang /* 361e12104SWon Kang * Copyright (c) 2012 GCT Semiconductor, Inc. All rights reserved. 461e12104SWon Kang * 561e12104SWon Kang * This software is licensed under the terms of the GNU General Public 661e12104SWon Kang * License version 2, as published by the Free Software Foundation, and 761e12104SWon Kang * may be copied, distributed, and modified under those terms. 861e12104SWon Kang * 961e12104SWon Kang * This program is distributed in the hope that it will be useful, 1061e12104SWon Kang * but WITHOUT ANY WARRANTY; without even the implied warranty of 1161e12104SWon Kang * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1261e12104SWon Kang * GNU General Public License for more details. 1361e12104SWon Kang */ 1461e12104SWon Kang 150ec473b5SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 160ec473b5SJoe Perches 1761e12104SWon Kang #include <linux/module.h> 1861e12104SWon Kang #include <linux/kernel.h> 1961e12104SWon Kang #include <linux/usb.h> 2061e12104SWon Kang #include <linux/sched.h> 2161e12104SWon Kang #include <linux/kthread.h> 2261e12104SWon Kang #include <linux/usb/cdc.h> 2361e12104SWon Kang #include <linux/wait.h> 2461e12104SWon Kang #include <linux/if_ether.h> 2561e12104SWon Kang #include <linux/pm_runtime.h> 2661e12104SWon Kang 2761e12104SWon Kang #include "gdm_usb.h" 2861e12104SWon Kang #include "gdm_lte.h" 2961e12104SWon Kang #include "hci.h" 3061e12104SWon Kang #include "hci_packet.h" 3161e12104SWon Kang #include "gdm_endian.h" 3261e12104SWon Kang 3361e12104SWon Kang #define USB_DEVICE_CDC_DATA(vid, pid) \ 3435db0350SAybuke Ozdemir .match_flags = USB_DEVICE_ID_MATCH_DEVICE | \ 3535db0350SAybuke Ozdemir USB_DEVICE_ID_MATCH_INT_CLASS | \ 3635db0350SAybuke Ozdemir USB_DEVICE_ID_MATCH_INT_SUBCLASS,\ 3761e12104SWon Kang .idVendor = vid,\ 3861e12104SWon Kang .idProduct = pid,\ 3961e12104SWon Kang .bInterfaceClass = USB_CLASS_COMM,\ 4061e12104SWon Kang .bInterfaceSubClass = USB_CDC_SUBCLASS_ETHERNET 4161e12104SWon Kang 4261e12104SWon Kang #define USB_DEVICE_MASS_DATA(vid, pid) \ 4335db0350SAybuke Ozdemir .match_flags = USB_DEVICE_ID_MATCH_DEVICE | \ 4435db0350SAybuke Ozdemir USB_DEVICE_ID_MATCH_INT_INFO,\ 4561e12104SWon Kang .idVendor = vid,\ 4661e12104SWon Kang .idProduct = pid,\ 4761e12104SWon Kang .bInterfaceSubClass = USB_SC_SCSI, \ 4861e12104SWon Kang .bInterfaceClass = USB_CLASS_MASS_STORAGE,\ 4961e12104SWon Kang .bInterfaceProtocol = USB_PR_BULK 5061e12104SWon Kang 5161e12104SWon Kang static const struct usb_device_id id_table[] = { 5261e12104SWon Kang { USB_DEVICE_CDC_DATA(VID_GCT, PID_GDM7240) }, /* GCT GDM7240 */ 5361e12104SWon Kang { USB_DEVICE_CDC_DATA(VID_GCT, PID_GDM7243) }, /* GCT GDM7243 */ 5461e12104SWon Kang { } 5561e12104SWon Kang }; 5661e12104SWon Kang 5761e12104SWon Kang MODULE_DEVICE_TABLE(usb, id_table); 5861e12104SWon Kang 5961e12104SWon Kang static void do_tx(struct work_struct *work); 6061e12104SWon Kang static void do_rx(struct work_struct *work); 6161e12104SWon Kang 6261e12104SWon Kang static int gdm_usb_recv(void *priv_dev, 6335db0350SAybuke Ozdemir int (*cb)(void *cb_data, 6435db0350SAybuke Ozdemir void *data, int len, int context), 6561e12104SWon Kang void *cb_data, 6661e12104SWon Kang int context); 6761e12104SWon Kang 6861e12104SWon Kang static int request_mac_address(struct lte_udev *udev) 6961e12104SWon Kang { 7061e12104SWon Kang u8 buf[16] = {0,}; 7161e12104SWon Kang struct hci_packet *hci = (struct hci_packet *)buf; 7261e12104SWon Kang struct usb_device *usbdev = udev->usbdev; 7361e12104SWon Kang int actual; 7461e12104SWon Kang int ret = -1; 7561e12104SWon Kang 761b5e56ecSQuytelda Kahja hci->cmd_evt = gdm_cpu_to_dev16(udev->gdm_ed, LTE_GET_INFORMATION); 771b5e56ecSQuytelda Kahja hci->len = gdm_cpu_to_dev16(udev->gdm_ed, 1); 7861e12104SWon Kang hci->data[0] = MAC_ADDRESS; 7961e12104SWon Kang 8061e12104SWon Kang ret = usb_bulk_msg(usbdev, usb_sndbulkpipe(usbdev, 2), buf, 5, 8161e12104SWon Kang &actual, 1000); 8261e12104SWon Kang 8361e12104SWon Kang udev->request_mac_addr = 1; 8461e12104SWon Kang 8561e12104SWon Kang return ret; 8661e12104SWon Kang } 8761e12104SWon Kang 8861e12104SWon Kang static struct usb_tx *alloc_tx_struct(int len) 8961e12104SWon Kang { 9061e12104SWon Kang struct usb_tx *t = NULL; 9161e12104SWon Kang int ret = 0; 9261e12104SWon Kang 937b7df122SIoana Ciornei t = kzalloc(sizeof(*t), GFP_ATOMIC); 9461e12104SWon Kang if (!t) { 9561e12104SWon Kang ret = -ENOMEM; 9661e12104SWon Kang goto out; 9761e12104SWon Kang } 9861e12104SWon Kang 9961e12104SWon Kang t->urb = usb_alloc_urb(0, GFP_ATOMIC); 10061e12104SWon Kang if (!(len % 512)) 10161e12104SWon Kang len++; 10261e12104SWon Kang 10361e12104SWon Kang t->buf = kmalloc(len, GFP_ATOMIC); 10461e12104SWon Kang if (!t->urb || !t->buf) { 10561e12104SWon Kang ret = -ENOMEM; 10661e12104SWon Kang goto out; 10761e12104SWon Kang } 10861e12104SWon Kang 10961e12104SWon Kang out: 11061e12104SWon Kang if (ret < 0) { 11161e12104SWon Kang if (t) { 11261e12104SWon Kang usb_free_urb(t->urb); 11361e12104SWon Kang kfree(t->buf); 11461e12104SWon Kang kfree(t); 11561e12104SWon Kang } 11661e12104SWon Kang return NULL; 11761e12104SWon Kang } 11861e12104SWon Kang 11961e12104SWon Kang return t; 12061e12104SWon Kang } 12161e12104SWon Kang 12261e12104SWon Kang static struct usb_tx_sdu *alloc_tx_sdu_struct(void) 12361e12104SWon Kang { 12475bc5fadSDan Carpenter struct usb_tx_sdu *t_sdu; 12561e12104SWon Kang 1267b7df122SIoana Ciornei t_sdu = kzalloc(sizeof(*t_sdu), GFP_KERNEL); 12775bc5fadSDan Carpenter if (!t_sdu) 12875bc5fadSDan Carpenter return NULL; 12961e12104SWon Kang 13022505b25SAlexey Khoroshilov t_sdu->buf = kmalloc(SDU_BUF_SIZE, GFP_KERNEL); 13161e12104SWon Kang if (!t_sdu->buf) { 13261e12104SWon Kang kfree(t_sdu); 13361e12104SWon Kang return NULL; 13461e12104SWon Kang } 13561e12104SWon Kang 13661e12104SWon Kang return t_sdu; 13761e12104SWon Kang } 13861e12104SWon Kang 13961e12104SWon Kang static void free_tx_struct(struct usb_tx *t) 14061e12104SWon Kang { 14161e12104SWon Kang if (t) { 14261e12104SWon Kang usb_free_urb(t->urb); 14361e12104SWon Kang kfree(t->buf); 14461e12104SWon Kang kfree(t); 14561e12104SWon Kang } 14661e12104SWon Kang } 14761e12104SWon Kang 14861e12104SWon Kang static void free_tx_sdu_struct(struct usb_tx_sdu *t_sdu) 14961e12104SWon Kang { 15061e12104SWon Kang if (t_sdu) { 15161e12104SWon Kang kfree(t_sdu->buf); 15261e12104SWon Kang kfree(t_sdu); 15361e12104SWon Kang } 15461e12104SWon Kang } 15561e12104SWon Kang 15661e12104SWon Kang static struct usb_tx_sdu *get_tx_sdu_struct(struct tx_cxt *tx, int *no_spc) 15761e12104SWon Kang { 15861e12104SWon Kang struct usb_tx_sdu *t_sdu; 15961e12104SWon Kang 16061e12104SWon Kang if (list_empty(&tx->free_list)) 16161e12104SWon Kang return NULL; 16261e12104SWon Kang 16361e12104SWon Kang t_sdu = list_entry(tx->free_list.next, struct usb_tx_sdu, list); 16461e12104SWon Kang list_del(&t_sdu->list); 16561e12104SWon Kang 16661e12104SWon Kang tx->avail_count--; 16761e12104SWon Kang 16861e12104SWon Kang *no_spc = list_empty(&tx->free_list) ? 1 : 0; 16961e12104SWon Kang 17061e12104SWon Kang return t_sdu; 17161e12104SWon Kang } 17261e12104SWon Kang 17361e12104SWon Kang static void put_tx_struct(struct tx_cxt *tx, struct usb_tx_sdu *t_sdu) 17461e12104SWon Kang { 17561e12104SWon Kang list_add_tail(&t_sdu->list, &tx->free_list); 17661e12104SWon Kang tx->avail_count++; 17761e12104SWon Kang } 17861e12104SWon Kang 17961e12104SWon Kang static struct usb_rx *alloc_rx_struct(void) 18061e12104SWon Kang { 18161e12104SWon Kang struct usb_rx *r = NULL; 18261e12104SWon Kang int ret = 0; 18361e12104SWon Kang 1847b7df122SIoana Ciornei r = kmalloc(sizeof(*r), GFP_KERNEL); 18561e12104SWon Kang if (!r) { 18661e12104SWon Kang ret = -ENOMEM; 18761e12104SWon Kang goto out; 18861e12104SWon Kang } 18961e12104SWon Kang 19022505b25SAlexey Khoroshilov r->urb = usb_alloc_urb(0, GFP_KERNEL); 19122505b25SAlexey Khoroshilov r->buf = kmalloc(RX_BUF_SIZE, GFP_KERNEL); 19261e12104SWon Kang if (!r->urb || !r->buf) { 19361e12104SWon Kang ret = -ENOMEM; 19461e12104SWon Kang goto out; 19561e12104SWon Kang } 19661e12104SWon Kang out: 19761e12104SWon Kang 19861e12104SWon Kang if (ret < 0) { 19961e12104SWon Kang if (r) { 20061e12104SWon Kang usb_free_urb(r->urb); 20161e12104SWon Kang kfree(r->buf); 20261e12104SWon Kang kfree(r); 20361e12104SWon Kang } 20461e12104SWon Kang return NULL; 20561e12104SWon Kang } 20661e12104SWon Kang 20761e12104SWon Kang return r; 20861e12104SWon Kang } 20961e12104SWon Kang 21061e12104SWon Kang static void free_rx_struct(struct usb_rx *r) 21161e12104SWon Kang { 21261e12104SWon Kang if (r) { 21361e12104SWon Kang usb_free_urb(r->urb); 21461e12104SWon Kang kfree(r->buf); 21561e12104SWon Kang kfree(r); 21661e12104SWon Kang } 21761e12104SWon Kang } 21861e12104SWon Kang 21961e12104SWon Kang static struct usb_rx *get_rx_struct(struct rx_cxt *rx, int *no_spc) 22061e12104SWon Kang { 22161e12104SWon Kang struct usb_rx *r; 22261e12104SWon Kang unsigned long flags; 22361e12104SWon Kang 22461e12104SWon Kang spin_lock_irqsave(&rx->rx_lock, flags); 22561e12104SWon Kang 22661e12104SWon Kang if (list_empty(&rx->free_list)) { 22761e12104SWon Kang spin_unlock_irqrestore(&rx->rx_lock, flags); 22861e12104SWon Kang return NULL; 22961e12104SWon Kang } 23061e12104SWon Kang 23161e12104SWon Kang r = list_entry(rx->free_list.next, struct usb_rx, free_list); 23261e12104SWon Kang list_del(&r->free_list); 23361e12104SWon Kang 23461e12104SWon Kang rx->avail_count--; 23561e12104SWon Kang 23661e12104SWon Kang *no_spc = list_empty(&rx->free_list) ? 1 : 0; 23761e12104SWon Kang 23861e12104SWon Kang spin_unlock_irqrestore(&rx->rx_lock, flags); 23961e12104SWon Kang 24061e12104SWon Kang return r; 24161e12104SWon Kang } 24261e12104SWon Kang 24361e12104SWon Kang static void put_rx_struct(struct rx_cxt *rx, struct usb_rx *r) 24461e12104SWon Kang { 24561e12104SWon Kang unsigned long flags; 24661e12104SWon Kang 24761e12104SWon Kang spin_lock_irqsave(&rx->rx_lock, flags); 24861e12104SWon Kang 24961e12104SWon Kang list_add_tail(&r->free_list, &rx->free_list); 25061e12104SWon Kang rx->avail_count++; 25161e12104SWon Kang 25261e12104SWon Kang spin_unlock_irqrestore(&rx->rx_lock, flags); 25361e12104SWon Kang } 25461e12104SWon Kang 25561e12104SWon Kang static void release_usb(struct lte_udev *udev) 25661e12104SWon Kang { 25761e12104SWon Kang struct rx_cxt *rx = &udev->rx; 25861e12104SWon Kang struct tx_cxt *tx = &udev->tx; 25961e12104SWon Kang struct usb_tx *t, *t_next; 26061e12104SWon Kang struct usb_rx *r, *r_next; 26161e12104SWon Kang struct usb_tx_sdu *t_sdu, *t_sdu_next; 26261e12104SWon Kang unsigned long flags; 26361e12104SWon Kang 26461e12104SWon Kang spin_lock_irqsave(&tx->lock, flags); 265e010a2a0SCihangir Akturk list_for_each_entry_safe(t_sdu, t_sdu_next, &tx->sdu_list, list) { 26661e12104SWon Kang list_del(&t_sdu->list); 26761e12104SWon Kang free_tx_sdu_struct(t_sdu); 26861e12104SWon Kang } 26961e12104SWon Kang 270e010a2a0SCihangir Akturk list_for_each_entry_safe(t, t_next, &tx->hci_list, list) { 27161e12104SWon Kang list_del(&t->list); 27261e12104SWon Kang free_tx_struct(t); 27361e12104SWon Kang } 27461e12104SWon Kang 275e010a2a0SCihangir Akturk list_for_each_entry_safe(t_sdu, t_sdu_next, &tx->free_list, list) { 27661e12104SWon Kang list_del(&t_sdu->list); 27761e12104SWon Kang free_tx_sdu_struct(t_sdu); 27861e12104SWon Kang } 27961e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 28061e12104SWon Kang 28161e12104SWon Kang spin_lock_irqsave(&rx->submit_lock, flags); 282e010a2a0SCihangir Akturk list_for_each_entry_safe(r, r_next, &rx->rx_submit_list, 283e010a2a0SCihangir Akturk rx_submit_list) { 28461e12104SWon Kang spin_unlock_irqrestore(&rx->submit_lock, flags); 28561e12104SWon Kang usb_kill_urb(r->urb); 28661e12104SWon Kang spin_lock_irqsave(&rx->submit_lock, flags); 28761e12104SWon Kang } 28861e12104SWon Kang spin_unlock_irqrestore(&rx->submit_lock, flags); 28961e12104SWon Kang 29061e12104SWon Kang spin_lock_irqsave(&rx->rx_lock, flags); 291e010a2a0SCihangir Akturk list_for_each_entry_safe(r, r_next, &rx->free_list, free_list) { 29261e12104SWon Kang list_del(&r->free_list); 29361e12104SWon Kang free_rx_struct(r); 29461e12104SWon Kang } 29561e12104SWon Kang spin_unlock_irqrestore(&rx->rx_lock, flags); 29661e12104SWon Kang 29761e12104SWon Kang spin_lock_irqsave(&rx->to_host_lock, flags); 298e010a2a0SCihangir Akturk list_for_each_entry_safe(r, r_next, &rx->to_host_list, to_host_list) { 29961e12104SWon Kang if (r->index == (void *)udev) { 30061e12104SWon Kang list_del(&r->to_host_list); 30161e12104SWon Kang free_rx_struct(r); 30261e12104SWon Kang } 30361e12104SWon Kang } 30461e12104SWon Kang spin_unlock_irqrestore(&rx->to_host_lock, flags); 30561e12104SWon Kang } 30661e12104SWon Kang 30761e12104SWon Kang static int init_usb(struct lte_udev *udev) 30861e12104SWon Kang { 30961e12104SWon Kang int ret = 0; 31061e12104SWon Kang int i; 31161e12104SWon Kang struct tx_cxt *tx = &udev->tx; 31261e12104SWon Kang struct rx_cxt *rx = &udev->rx; 31361e12104SWon Kang struct usb_tx_sdu *t_sdu = NULL; 31461e12104SWon Kang struct usb_rx *r = NULL; 31561e12104SWon Kang 31661e12104SWon Kang udev->send_complete = 1; 31761e12104SWon Kang udev->tx_stop = 0; 31861e12104SWon Kang udev->request_mac_addr = 0; 31961e12104SWon Kang udev->usb_state = PM_NORMAL; 32061e12104SWon Kang 32161e12104SWon Kang INIT_LIST_HEAD(&tx->sdu_list); 32261e12104SWon Kang INIT_LIST_HEAD(&tx->hci_list); 32361e12104SWon Kang INIT_LIST_HEAD(&tx->free_list); 32461e12104SWon Kang INIT_LIST_HEAD(&rx->rx_submit_list); 32561e12104SWon Kang INIT_LIST_HEAD(&rx->free_list); 32661e12104SWon Kang INIT_LIST_HEAD(&rx->to_host_list); 32761e12104SWon Kang spin_lock_init(&tx->lock); 32861e12104SWon Kang spin_lock_init(&rx->rx_lock); 32961e12104SWon Kang spin_lock_init(&rx->submit_lock); 33061e12104SWon Kang spin_lock_init(&rx->to_host_lock); 33161e12104SWon Kang 33261e12104SWon Kang tx->avail_count = 0; 33361e12104SWon Kang rx->avail_count = 0; 33461e12104SWon Kang 33561e12104SWon Kang udev->rx_cb = NULL; 33661e12104SWon Kang 33761e12104SWon Kang for (i = 0; i < MAX_NUM_SDU_BUF; i++) { 33861e12104SWon Kang t_sdu = alloc_tx_sdu_struct(); 339b6f6fd8aSIoana Ciornei if (!t_sdu) { 34061e12104SWon Kang ret = -ENOMEM; 34161e12104SWon Kang goto fail; 34261e12104SWon Kang } 34361e12104SWon Kang 34461e12104SWon Kang list_add(&t_sdu->list, &tx->free_list); 34561e12104SWon Kang tx->avail_count++; 34661e12104SWon Kang } 34761e12104SWon Kang 34861e12104SWon Kang for (i = 0; i < MAX_RX_SUBMIT_COUNT * 2; i++) { 34961e12104SWon Kang r = alloc_rx_struct(); 350b6f6fd8aSIoana Ciornei if (!r) { 35161e12104SWon Kang ret = -ENOMEM; 35261e12104SWon Kang goto fail; 35361e12104SWon Kang } 35461e12104SWon Kang 35561e12104SWon Kang list_add(&r->free_list, &rx->free_list); 35661e12104SWon Kang rx->avail_count++; 35761e12104SWon Kang } 35861e12104SWon Kang INIT_DELAYED_WORK(&udev->work_tx, do_tx); 35961e12104SWon Kang INIT_DELAYED_WORK(&udev->work_rx, do_rx); 36061e12104SWon Kang return 0; 36161e12104SWon Kang fail: 36222505b25SAlexey Khoroshilov release_usb(udev); 36361e12104SWon Kang return ret; 36461e12104SWon Kang } 36561e12104SWon Kang 36661e12104SWon Kang static int set_mac_address(u8 *data, void *arg) 36761e12104SWon Kang { 3682594ca30SShraddha Barke struct phy_dev *phy_dev = arg; 36961e12104SWon Kang struct lte_udev *udev = phy_dev->priv_dev; 37061e12104SWon Kang struct tlv *tlv = (struct tlv *)data; 37161e12104SWon Kang u8 mac_address[ETH_ALEN] = {0, }; 37261e12104SWon Kang 37361e12104SWon Kang if (tlv->type == MAC_ADDRESS && udev->request_mac_addr) { 37461e12104SWon Kang memcpy(mac_address, tlv->data, tlv->len); 37561e12104SWon Kang 37635db0350SAybuke Ozdemir if (register_lte_device(phy_dev, 37735db0350SAybuke Ozdemir &udev->intf->dev, mac_address) < 0) 3780ec473b5SJoe Perches pr_err("register lte device failed\n"); 37961e12104SWon Kang 38061e12104SWon Kang udev->request_mac_addr = 0; 38161e12104SWon Kang 38261e12104SWon Kang return 1; 38361e12104SWon Kang } 38461e12104SWon Kang 38561e12104SWon Kang return 0; 38661e12104SWon Kang } 38761e12104SWon Kang 38861e12104SWon Kang static void do_rx(struct work_struct *work) 38961e12104SWon Kang { 39035db0350SAybuke Ozdemir struct lte_udev *udev = 39135db0350SAybuke Ozdemir container_of(work, struct lte_udev, work_rx.work); 39261e12104SWon Kang struct rx_cxt *rx = &udev->rx; 39361e12104SWon Kang struct usb_rx *r; 39461e12104SWon Kang struct hci_packet *hci; 39561e12104SWon Kang struct phy_dev *phy_dev; 39661e12104SWon Kang u16 cmd_evt; 39761e12104SWon Kang int ret; 39861e12104SWon Kang unsigned long flags; 39961e12104SWon Kang 40061e12104SWon Kang while (1) { 40161e12104SWon Kang spin_lock_irqsave(&rx->to_host_lock, flags); 40261e12104SWon Kang if (list_empty(&rx->to_host_list)) { 40361e12104SWon Kang spin_unlock_irqrestore(&rx->to_host_lock, flags); 40461e12104SWon Kang break; 40561e12104SWon Kang } 40635db0350SAybuke Ozdemir r = list_entry(rx->to_host_list.next, 40735db0350SAybuke Ozdemir struct usb_rx, to_host_list); 40861e12104SWon Kang list_del(&r->to_host_list); 40961e12104SWon Kang spin_unlock_irqrestore(&rx->to_host_lock, flags); 41061e12104SWon Kang 4112594ca30SShraddha Barke phy_dev = r->cb_data; 4122594ca30SShraddha Barke udev = phy_dev->priv_dev; 41361e12104SWon Kang hci = (struct hci_packet *)r->buf; 4141b5e56ecSQuytelda Kahja cmd_evt = gdm_dev16_to_cpu(udev->gdm_ed, hci->cmd_evt); 41561e12104SWon Kang 41661e12104SWon Kang switch (cmd_evt) { 41761e12104SWon Kang case LTE_GET_INFORMATION_RESULT: 41861e12104SWon Kang if (set_mac_address(hci->data, r->cb_data) == 0) { 41949bb9af0SLuis de Bethencourt r->callback(r->cb_data, 42061e12104SWon Kang r->buf, 42161e12104SWon Kang r->urb->actual_length, 42261e12104SWon Kang KERNEL_THREAD); 42361e12104SWon Kang } 42461e12104SWon Kang break; 42561e12104SWon Kang 42661e12104SWon Kang default: 42761e12104SWon Kang if (r->callback) { 42861e12104SWon Kang ret = r->callback(r->cb_data, 42961e12104SWon Kang r->buf, 43061e12104SWon Kang r->urb->actual_length, 43161e12104SWon Kang KERNEL_THREAD); 43261e12104SWon Kang 43361e12104SWon Kang if (ret == -EAGAIN) 4340ec473b5SJoe Perches pr_err("failed to send received data\n"); 43561e12104SWon Kang } 43661e12104SWon Kang break; 43761e12104SWon Kang } 43861e12104SWon Kang 43961e12104SWon Kang put_rx_struct(rx, r); 44061e12104SWon Kang 44161e12104SWon Kang gdm_usb_recv(udev, 44261e12104SWon Kang r->callback, 44361e12104SWon Kang r->cb_data, 44461e12104SWon Kang USB_COMPLETE); 44561e12104SWon Kang } 44661e12104SWon Kang } 44761e12104SWon Kang 44861e12104SWon Kang static void remove_rx_submit_list(struct usb_rx *r, struct rx_cxt *rx) 44961e12104SWon Kang { 45061e12104SWon Kang unsigned long flags; 45161e12104SWon Kang struct usb_rx *r_remove, *r_remove_next; 45261e12104SWon Kang 45361e12104SWon Kang spin_lock_irqsave(&rx->submit_lock, flags); 454e010a2a0SCihangir Akturk list_for_each_entry_safe(r_remove, r_remove_next, 455e010a2a0SCihangir Akturk &rx->rx_submit_list, rx_submit_list) { 45661e12104SWon Kang if (r == r_remove) { 45761e12104SWon Kang list_del(&r->rx_submit_list); 45861e12104SWon Kang break; 45961e12104SWon Kang } 46061e12104SWon Kang } 46161e12104SWon Kang spin_unlock_irqrestore(&rx->submit_lock, flags); 46261e12104SWon Kang } 46361e12104SWon Kang 46461e12104SWon Kang static void gdm_usb_rcv_complete(struct urb *urb) 46561e12104SWon Kang { 46661e12104SWon Kang struct usb_rx *r = urb->context; 46761e12104SWon Kang struct rx_cxt *rx = r->rx; 46861e12104SWon Kang unsigned long flags; 46961e12104SWon Kang struct lte_udev *udev = container_of(r->rx, struct lte_udev, rx); 47061e12104SWon Kang struct usb_device *usbdev = udev->usbdev; 47161e12104SWon Kang 47261e12104SWon Kang remove_rx_submit_list(r, rx); 47361e12104SWon Kang 47461e12104SWon Kang if (!urb->status && r->callback) { 47561e12104SWon Kang spin_lock_irqsave(&rx->to_host_lock, flags); 47661e12104SWon Kang list_add_tail(&r->to_host_list, &rx->to_host_list); 477bd743442SAmitoj Kaur Chawla schedule_work(&udev->work_rx.work); 47861e12104SWon Kang spin_unlock_irqrestore(&rx->to_host_lock, flags); 47961e12104SWon Kang } else { 48061e12104SWon Kang if (urb->status && udev->usb_state == PM_NORMAL) 4813d719423SHaneen Mohammed dev_err(&urb->dev->dev, "%s: urb status error %d\n", 4820ec473b5SJoe Perches __func__, urb->status); 48361e12104SWon Kang 48461e12104SWon Kang put_rx_struct(rx, r); 48561e12104SWon Kang } 48661e12104SWon Kang 48761e12104SWon Kang usb_mark_last_busy(usbdev); 48861e12104SWon Kang } 48961e12104SWon Kang 49061e12104SWon Kang static int gdm_usb_recv(void *priv_dev, 49135db0350SAybuke Ozdemir int (*cb)(void *cb_data, 49235db0350SAybuke Ozdemir void *data, int len, int context), 49361e12104SWon Kang void *cb_data, 49461e12104SWon Kang int context) 49561e12104SWon Kang { 49661e12104SWon Kang struct lte_udev *udev = priv_dev; 49761e12104SWon Kang struct usb_device *usbdev = udev->usbdev; 49861e12104SWon Kang struct rx_cxt *rx = &udev->rx; 49961e12104SWon Kang struct usb_rx *r; 50061e12104SWon Kang int no_spc; 50161e12104SWon Kang int ret; 50261e12104SWon Kang unsigned long flags; 50361e12104SWon Kang 50461e12104SWon Kang if (!udev->usbdev) { 5050ec473b5SJoe Perches pr_err("invalid device\n"); 50661e12104SWon Kang return -ENODEV; 50761e12104SWon Kang } 50861e12104SWon Kang 50961e12104SWon Kang r = get_rx_struct(rx, &no_spc); 51061e12104SWon Kang if (!r) { 5110ec473b5SJoe Perches pr_err("Out of Memory\n"); 51261e12104SWon Kang return -ENOMEM; 51361e12104SWon Kang } 51461e12104SWon Kang 51561e12104SWon Kang udev->rx_cb = cb; 51661e12104SWon Kang r->callback = cb; 51761e12104SWon Kang r->cb_data = cb_data; 51861e12104SWon Kang r->index = (void *)udev; 51961e12104SWon Kang r->rx = rx; 52061e12104SWon Kang 52161e12104SWon Kang usb_fill_bulk_urb(r->urb, 52261e12104SWon Kang usbdev, 52361e12104SWon Kang usb_rcvbulkpipe(usbdev, 0x83), 52461e12104SWon Kang r->buf, 52561e12104SWon Kang RX_BUF_SIZE, 52661e12104SWon Kang gdm_usb_rcv_complete, 52761e12104SWon Kang r); 52861e12104SWon Kang 52961e12104SWon Kang spin_lock_irqsave(&rx->submit_lock, flags); 53061e12104SWon Kang list_add_tail(&r->rx_submit_list, &rx->rx_submit_list); 53161e12104SWon Kang spin_unlock_irqrestore(&rx->submit_lock, flags); 53261e12104SWon Kang 53361e12104SWon Kang if (context == KERNEL_THREAD) 53461e12104SWon Kang ret = usb_submit_urb(r->urb, GFP_KERNEL); 53561e12104SWon Kang else 53661e12104SWon Kang ret = usb_submit_urb(r->urb, GFP_ATOMIC); 53761e12104SWon Kang 53861e12104SWon Kang if (ret) { 53961e12104SWon Kang spin_lock_irqsave(&rx->submit_lock, flags); 54061e12104SWon Kang list_del(&r->rx_submit_list); 54161e12104SWon Kang spin_unlock_irqrestore(&rx->submit_lock, flags); 54261e12104SWon Kang 5430ec473b5SJoe Perches pr_err("usb_submit_urb failed (%p)\n", r); 54461e12104SWon Kang put_rx_struct(rx, r); 54561e12104SWon Kang } 54661e12104SWon Kang 54761e12104SWon Kang return ret; 54861e12104SWon Kang } 54961e12104SWon Kang 55061e12104SWon Kang static void gdm_usb_send_complete(struct urb *urb) 55161e12104SWon Kang { 55261e12104SWon Kang struct usb_tx *t = urb->context; 55361e12104SWon Kang struct tx_cxt *tx = t->tx; 55461e12104SWon Kang struct lte_udev *udev = container_of(tx, struct lte_udev, tx); 55561e12104SWon Kang unsigned long flags; 55661e12104SWon Kang 55761e12104SWon Kang if (urb->status == -ECONNRESET) { 5583d719423SHaneen Mohammed dev_info(&urb->dev->dev, "CONNRESET\n"); 55961e12104SWon Kang return; 56061e12104SWon Kang } 56161e12104SWon Kang 56261e12104SWon Kang if (t->callback) 56361e12104SWon Kang t->callback(t->cb_data); 56461e12104SWon Kang 56561e12104SWon Kang free_tx_struct(t); 56661e12104SWon Kang 56761e12104SWon Kang spin_lock_irqsave(&tx->lock, flags); 56861e12104SWon Kang udev->send_complete = 1; 569bd743442SAmitoj Kaur Chawla schedule_work(&udev->work_tx.work); 57061e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 57161e12104SWon Kang } 57261e12104SWon Kang 57361e12104SWon Kang static int send_tx_packet(struct usb_device *usbdev, struct usb_tx *t, u32 len) 57461e12104SWon Kang { 57561e12104SWon Kang int ret = 0; 57661e12104SWon Kang 57761e12104SWon Kang if (!(len % 512)) 57861e12104SWon Kang len++; 57961e12104SWon Kang 58061e12104SWon Kang usb_fill_bulk_urb(t->urb, 58161e12104SWon Kang usbdev, 58261e12104SWon Kang usb_sndbulkpipe(usbdev, 2), 58361e12104SWon Kang t->buf, 58461e12104SWon Kang len, 58561e12104SWon Kang gdm_usb_send_complete, 58661e12104SWon Kang t); 58761e12104SWon Kang 58861e12104SWon Kang ret = usb_submit_urb(t->urb, GFP_ATOMIC); 58961e12104SWon Kang 59061e12104SWon Kang if (ret) 5913d719423SHaneen Mohammed dev_err(&usbdev->dev, "usb_submit_urb failed: %d\n", 5923d719423SHaneen Mohammed ret); 59361e12104SWon Kang 59461e12104SWon Kang usb_mark_last_busy(usbdev); 59561e12104SWon Kang 59661e12104SWon Kang return ret; 59761e12104SWon Kang } 59861e12104SWon Kang 59961e12104SWon Kang static u32 packet_aggregation(struct lte_udev *udev, u8 *send_buf) 60061e12104SWon Kang { 60161e12104SWon Kang struct tx_cxt *tx = &udev->tx; 60261e12104SWon Kang struct usb_tx_sdu *t_sdu = NULL; 60361e12104SWon Kang struct multi_sdu *multi_sdu = (struct multi_sdu *)send_buf; 60461e12104SWon Kang u16 send_len = 0; 60561e12104SWon Kang u16 num_packet = 0; 60661e12104SWon Kang unsigned long flags; 60761e12104SWon Kang 6081b5e56ecSQuytelda Kahja multi_sdu->cmd_evt = gdm_cpu_to_dev16(udev->gdm_ed, LTE_TX_MULTI_SDU); 60961e12104SWon Kang 61061e12104SWon Kang while (num_packet < MAX_PACKET_IN_MULTI_SDU) { 61161e12104SWon Kang spin_lock_irqsave(&tx->lock, flags); 61261e12104SWon Kang if (list_empty(&tx->sdu_list)) { 61361e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 61461e12104SWon Kang break; 61561e12104SWon Kang } 61661e12104SWon Kang 61761e12104SWon Kang t_sdu = list_entry(tx->sdu_list.next, struct usb_tx_sdu, list); 61861e12104SWon Kang if (send_len + t_sdu->len > MAX_SDU_SIZE) { 61961e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 62061e12104SWon Kang break; 62161e12104SWon Kang } 62261e12104SWon Kang 62361e12104SWon Kang list_del(&t_sdu->list); 62461e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 62561e12104SWon Kang 62661e12104SWon Kang memcpy(multi_sdu->data + send_len, t_sdu->buf, t_sdu->len); 62761e12104SWon Kang 62861e12104SWon Kang send_len += (t_sdu->len + 3) & 0xfffc; 62961e12104SWon Kang num_packet++; 63061e12104SWon Kang 63161e12104SWon Kang if (tx->avail_count > 10) 63261e12104SWon Kang t_sdu->callback(t_sdu->cb_data); 63361e12104SWon Kang 63461e12104SWon Kang spin_lock_irqsave(&tx->lock, flags); 63561e12104SWon Kang put_tx_struct(tx, t_sdu); 63661e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 63761e12104SWon Kang } 63861e12104SWon Kang 6391b5e56ecSQuytelda Kahja multi_sdu->len = gdm_cpu_to_dev16(udev->gdm_ed, send_len); 6401b5e56ecSQuytelda Kahja multi_sdu->num_packet = gdm_cpu_to_dev16(udev->gdm_ed, num_packet); 64161e12104SWon Kang 64261e12104SWon Kang return send_len + offsetof(struct multi_sdu, data); 64361e12104SWon Kang } 64461e12104SWon Kang 64561e12104SWon Kang static void do_tx(struct work_struct *work) 64661e12104SWon Kang { 64735db0350SAybuke Ozdemir struct lte_udev *udev = 64835db0350SAybuke Ozdemir container_of(work, struct lte_udev, work_tx.work); 64961e12104SWon Kang struct usb_device *usbdev = udev->usbdev; 65061e12104SWon Kang struct tx_cxt *tx = &udev->tx; 65161e12104SWon Kang struct usb_tx *t = NULL; 65261e12104SWon Kang int is_send = 0; 65361e12104SWon Kang u32 len = 0; 65461e12104SWon Kang unsigned long flags; 65561e12104SWon Kang 65661e12104SWon Kang if (!usb_autopm_get_interface(udev->intf)) 65761e12104SWon Kang usb_autopm_put_interface(udev->intf); 65861e12104SWon Kang 65961e12104SWon Kang if (udev->usb_state == PM_SUSPEND) 66061e12104SWon Kang return; 66161e12104SWon Kang 66261e12104SWon Kang spin_lock_irqsave(&tx->lock, flags); 66361e12104SWon Kang if (!udev->send_complete) { 66461e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 66561e12104SWon Kang return; 66661e12104SWon Kang } 667d1fed028SGulsah Kose udev->send_complete = 0; 66861e12104SWon Kang 66961e12104SWon Kang if (!list_empty(&tx->hci_list)) { 67061e12104SWon Kang t = list_entry(tx->hci_list.next, struct usb_tx, list); 67161e12104SWon Kang list_del(&t->list); 67261e12104SWon Kang len = t->len; 67361e12104SWon Kang t->is_sdu = 0; 67461e12104SWon Kang is_send = 1; 67561e12104SWon Kang } else if (!list_empty(&tx->sdu_list)) { 67661e12104SWon Kang if (udev->tx_stop) { 67761e12104SWon Kang udev->send_complete = 1; 67861e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 67961e12104SWon Kang return; 68061e12104SWon Kang } 68161e12104SWon Kang 68261e12104SWon Kang t = alloc_tx_struct(TX_BUF_SIZE); 683b6f6fd8aSIoana Ciornei if (!t) { 684a600f458SAbel Moyo spin_unlock_irqrestore(&tx->lock, flags); 685a600f458SAbel Moyo return; 686a600f458SAbel Moyo } 68761e12104SWon Kang t->callback = NULL; 68861e12104SWon Kang t->tx = tx; 68961e12104SWon Kang t->is_sdu = 1; 69061e12104SWon Kang is_send = 1; 69161e12104SWon Kang } 69261e12104SWon Kang 69361e12104SWon Kang if (!is_send) { 69461e12104SWon Kang udev->send_complete = 1; 69561e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 69661e12104SWon Kang return; 69761e12104SWon Kang } 69861e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 69961e12104SWon Kang 70061e12104SWon Kang if (t->is_sdu) 70161e12104SWon Kang len = packet_aggregation(udev, t->buf); 70261e12104SWon Kang 70361e12104SWon Kang if (send_tx_packet(usbdev, t, len)) { 7040ec473b5SJoe Perches pr_err("send_tx_packet failed\n"); 70561e12104SWon Kang t->callback = NULL; 70661e12104SWon Kang gdm_usb_send_complete(t->urb); 70761e12104SWon Kang } 70861e12104SWon Kang } 70961e12104SWon Kang 71061e12104SWon Kang #define SDU_PARAM_LEN 12 71161e12104SWon Kang static int gdm_usb_sdu_send(void *priv_dev, void *data, int len, 7123cbe6a1cSBruno Carvalho unsigned int dft_eps_ID, unsigned int eps_ID, 71361e12104SWon Kang void (*cb)(void *data), void *cb_data, 71461e12104SWon Kang int dev_idx, int nic_type) 71561e12104SWon Kang { 71661e12104SWon Kang struct lte_udev *udev = priv_dev; 71761e12104SWon Kang struct tx_cxt *tx = &udev->tx; 71861e12104SWon Kang struct usb_tx_sdu *t_sdu; 71961e12104SWon Kang struct sdu *sdu = NULL; 72061e12104SWon Kang unsigned long flags; 72161e12104SWon Kang int no_spc = 0; 72261e12104SWon Kang u16 send_len; 72361e12104SWon Kang 72461e12104SWon Kang if (!udev->usbdev) { 7250ec473b5SJoe Perches pr_err("sdu send - invalid device\n"); 72661e12104SWon Kang return TX_NO_DEV; 72761e12104SWon Kang } 72861e12104SWon Kang 72961e12104SWon Kang spin_lock_irqsave(&tx->lock, flags); 73061e12104SWon Kang t_sdu = get_tx_sdu_struct(tx, &no_spc); 73161e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 73261e12104SWon Kang 733b6f6fd8aSIoana Ciornei if (!t_sdu) { 7340ec473b5SJoe Perches pr_err("sdu send - free list empty\n"); 73561e12104SWon Kang return TX_NO_SPC; 73661e12104SWon Kang } 73761e12104SWon Kang 73861e12104SWon Kang sdu = (struct sdu *)t_sdu->buf; 7391b5e56ecSQuytelda Kahja sdu->cmd_evt = gdm_cpu_to_dev16(udev->gdm_ed, LTE_TX_SDU); 74061e12104SWon Kang if (nic_type == NIC_TYPE_ARP) { 74161e12104SWon Kang send_len = len + SDU_PARAM_LEN; 74261e12104SWon Kang memcpy(sdu->data, data, len); 74361e12104SWon Kang } else { 74461e12104SWon Kang send_len = len - ETH_HLEN; 74561e12104SWon Kang send_len += SDU_PARAM_LEN; 74661e12104SWon Kang memcpy(sdu->data, data + ETH_HLEN, len - ETH_HLEN); 74761e12104SWon Kang } 74861e12104SWon Kang 7491b5e56ecSQuytelda Kahja sdu->len = gdm_cpu_to_dev16(udev->gdm_ed, send_len); 7501b5e56ecSQuytelda Kahja sdu->dft_eps_ID = gdm_cpu_to_dev32(udev->gdm_ed, dft_eps_ID); 7511b5e56ecSQuytelda Kahja sdu->bearer_ID = gdm_cpu_to_dev32(udev->gdm_ed, eps_ID); 7521b5e56ecSQuytelda Kahja sdu->nic_type = gdm_cpu_to_dev32(udev->gdm_ed, nic_type); 75361e12104SWon Kang 75461e12104SWon Kang t_sdu->len = send_len + HCI_HEADER_SIZE; 75561e12104SWon Kang t_sdu->callback = cb; 75661e12104SWon Kang t_sdu->cb_data = cb_data; 75761e12104SWon Kang 75861e12104SWon Kang spin_lock_irqsave(&tx->lock, flags); 75961e12104SWon Kang list_add_tail(&t_sdu->list, &tx->sdu_list); 760bd743442SAmitoj Kaur Chawla schedule_work(&udev->work_tx.work); 76161e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 76261e12104SWon Kang 76361e12104SWon Kang if (no_spc) 76461e12104SWon Kang return TX_NO_BUFFER; 76561e12104SWon Kang 76661e12104SWon Kang return 0; 76761e12104SWon Kang } 76861e12104SWon Kang 76961e12104SWon Kang static int gdm_usb_hci_send(void *priv_dev, void *data, int len, 77061e12104SWon Kang void (*cb)(void *data), void *cb_data) 77161e12104SWon Kang { 77261e12104SWon Kang struct lte_udev *udev = priv_dev; 77361e12104SWon Kang struct tx_cxt *tx = &udev->tx; 77461e12104SWon Kang struct usb_tx *t; 77561e12104SWon Kang unsigned long flags; 77661e12104SWon Kang 77761e12104SWon Kang if (!udev->usbdev) { 7780ec473b5SJoe Perches pr_err("hci send - invalid device\n"); 77961e12104SWon Kang return -ENODEV; 78061e12104SWon Kang } 78161e12104SWon Kang 78261e12104SWon Kang t = alloc_tx_struct(len); 783b6f6fd8aSIoana Ciornei if (!t) { 7840ec473b5SJoe Perches pr_err("hci_send - out of memory\n"); 78561e12104SWon Kang return -ENOMEM; 78661e12104SWon Kang } 78761e12104SWon Kang 78861e12104SWon Kang memcpy(t->buf, data, len); 78961e12104SWon Kang t->callback = cb; 79061e12104SWon Kang t->cb_data = cb_data; 79161e12104SWon Kang t->len = len; 79261e12104SWon Kang t->tx = tx; 79361e12104SWon Kang t->is_sdu = 0; 79461e12104SWon Kang 79561e12104SWon Kang spin_lock_irqsave(&tx->lock, flags); 79661e12104SWon Kang list_add_tail(&t->list, &tx->hci_list); 797bd743442SAmitoj Kaur Chawla schedule_work(&udev->work_tx.work); 79861e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 79961e12104SWon Kang 80061e12104SWon Kang return 0; 80161e12104SWon Kang } 80261e12104SWon Kang 8031b5e56ecSQuytelda Kahja static u8 gdm_usb_get_endian(void *priv_dev) 80461e12104SWon Kang { 80561e12104SWon Kang struct lte_udev *udev = priv_dev; 80661e12104SWon Kang 8071b5e56ecSQuytelda Kahja return udev->gdm_ed; 80861e12104SWon Kang } 80961e12104SWon Kang 81035db0350SAybuke Ozdemir static int gdm_usb_probe(struct usb_interface *intf, 81135db0350SAybuke Ozdemir const struct usb_device_id *id) 81261e12104SWon Kang { 81361e12104SWon Kang int ret = 0; 81461e12104SWon Kang struct phy_dev *phy_dev = NULL; 81561e12104SWon Kang struct lte_udev *udev = NULL; 81661e12104SWon Kang u16 idVendor, idProduct; 81761e12104SWon Kang int bInterfaceNumber; 81861e12104SWon Kang struct usb_device *usbdev = interface_to_usbdev(intf); 81961e12104SWon Kang 82061e12104SWon Kang bInterfaceNumber = intf->cur_altsetting->desc.bInterfaceNumber; 82161e12104SWon Kang idVendor = __le16_to_cpu(usbdev->descriptor.idVendor); 82261e12104SWon Kang idProduct = __le16_to_cpu(usbdev->descriptor.idProduct); 82361e12104SWon Kang 8240ec473b5SJoe Perches pr_info("net vid = 0x%04x pid = 0x%04x\n", idVendor, idProduct); 82561e12104SWon Kang 82661e12104SWon Kang if (bInterfaceNumber > NETWORK_INTERFACE) { 8270ec473b5SJoe Perches pr_info("not a network device\n"); 828a34c72b3SAlexey Khoroshilov return -ENODEV; 82961e12104SWon Kang } 83061e12104SWon Kang 8317b7df122SIoana Ciornei phy_dev = kzalloc(sizeof(*phy_dev), GFP_KERNEL); 832a34c72b3SAlexey Khoroshilov if (!phy_dev) 833a34c72b3SAlexey Khoroshilov return -ENOMEM; 83461e12104SWon Kang 8357b7df122SIoana Ciornei udev = kzalloc(sizeof(*udev), GFP_KERNEL); 83661e12104SWon Kang if (!udev) { 83761e12104SWon Kang ret = -ENOMEM; 838a34c72b3SAlexey Khoroshilov goto err_udev; 83961e12104SWon Kang } 84061e12104SWon Kang 84161e12104SWon Kang phy_dev->priv_dev = (void *)udev; 84261e12104SWon Kang phy_dev->send_hci_func = gdm_usb_hci_send; 84361e12104SWon Kang phy_dev->send_sdu_func = gdm_usb_sdu_send; 84461e12104SWon Kang phy_dev->rcv_func = gdm_usb_recv; 84561e12104SWon Kang phy_dev->get_endian = gdm_usb_get_endian; 84661e12104SWon Kang 84761e12104SWon Kang udev->usbdev = usbdev; 84861e12104SWon Kang ret = init_usb(udev); 84961e12104SWon Kang if (ret < 0) { 850df02b50aSHaneen Mohammed dev_err(intf->usb_dev, "init_usb func failed\n"); 851a34c72b3SAlexey Khoroshilov goto err_init_usb; 85261e12104SWon Kang } 85361e12104SWon Kang udev->intf = intf; 85461e12104SWon Kang 85561e12104SWon Kang intf->needs_remote_wakeup = 1; 85661e12104SWon Kang usb_enable_autosuspend(usbdev); 85761e12104SWon Kang pm_runtime_set_autosuspend_delay(&usbdev->dev, AUTO_SUSPEND_TIMER); 85861e12104SWon Kang 85935db0350SAybuke Ozdemir /* List up hosts with big endians, otherwise, 86035db0350SAybuke Ozdemir * defaults to little endian 86135db0350SAybuke Ozdemir */ 86261e12104SWon Kang if (idProduct == PID_GDM7243) 8631b5e56ecSQuytelda Kahja udev->gdm_ed = ENDIANNESS_BIG; 86461e12104SWon Kang else 8651b5e56ecSQuytelda Kahja udev->gdm_ed = ENDIANNESS_LITTLE; 86661e12104SWon Kang 86761e12104SWon Kang ret = request_mac_address(udev); 86861e12104SWon Kang if (ret < 0) { 869df02b50aSHaneen Mohammed dev_err(intf->usb_dev, "request Mac address failed\n"); 870a34c72b3SAlexey Khoroshilov goto err_mac_address; 87161e12104SWon Kang } 87261e12104SWon Kang 87361e12104SWon Kang start_rx_proc(phy_dev); 87461e12104SWon Kang usb_get_dev(usbdev); 87561e12104SWon Kang usb_set_intfdata(intf, phy_dev); 87661e12104SWon Kang 877a34c72b3SAlexey Khoroshilov return 0; 878a34c72b3SAlexey Khoroshilov 879a34c72b3SAlexey Khoroshilov err_mac_address: 880a34c72b3SAlexey Khoroshilov release_usb(udev); 881a34c72b3SAlexey Khoroshilov err_init_usb: 882a34c72b3SAlexey Khoroshilov kfree(udev); 883a34c72b3SAlexey Khoroshilov err_udev: 884a34c72b3SAlexey Khoroshilov kfree(phy_dev); 885a34c72b3SAlexey Khoroshilov 88661e12104SWon Kang return ret; 88761e12104SWon Kang } 88861e12104SWon Kang 88961e12104SWon Kang static void gdm_usb_disconnect(struct usb_interface *intf) 89061e12104SWon Kang { 89161e12104SWon Kang struct phy_dev *phy_dev; 89261e12104SWon Kang struct lte_udev *udev; 89361e12104SWon Kang u16 idVendor, idProduct; 89461e12104SWon Kang struct usb_device *usbdev; 895aa920159SKiran Padwal 89661e12104SWon Kang usbdev = interface_to_usbdev(intf); 89761e12104SWon Kang 89861e12104SWon Kang idVendor = __le16_to_cpu(usbdev->descriptor.idVendor); 89961e12104SWon Kang idProduct = __le16_to_cpu(usbdev->descriptor.idProduct); 90061e12104SWon Kang 90161e12104SWon Kang phy_dev = usb_get_intfdata(intf); 90261e12104SWon Kang 90361e12104SWon Kang udev = phy_dev->priv_dev; 90461e12104SWon Kang unregister_lte_device(phy_dev); 90561e12104SWon Kang 90661e12104SWon Kang release_usb(udev); 90761e12104SWon Kang 90861e12104SWon Kang kfree(udev); 90961e12104SWon Kang udev = NULL; 91061e12104SWon Kang 91161e12104SWon Kang kfree(phy_dev); 91261e12104SWon Kang phy_dev = NULL; 91361e12104SWon Kang 91461e12104SWon Kang usb_put_dev(usbdev); 91561e12104SWon Kang } 91661e12104SWon Kang 91761e12104SWon Kang static int gdm_usb_suspend(struct usb_interface *intf, pm_message_t pm_msg) 91861e12104SWon Kang { 91961e12104SWon Kang struct phy_dev *phy_dev; 92061e12104SWon Kang struct lte_udev *udev; 92161e12104SWon Kang struct rx_cxt *rx; 92261e12104SWon Kang struct usb_rx *r; 92361e12104SWon Kang struct usb_rx *r_next; 92461e12104SWon Kang unsigned long flags; 92561e12104SWon Kang 92661e12104SWon Kang phy_dev = usb_get_intfdata(intf); 92761e12104SWon Kang udev = phy_dev->priv_dev; 92861e12104SWon Kang rx = &udev->rx; 92961e12104SWon Kang if (udev->usb_state != PM_NORMAL) { 930df02b50aSHaneen Mohammed dev_err(intf->usb_dev, "usb suspend - invalid state\n"); 93161e12104SWon Kang return -1; 93261e12104SWon Kang } 93361e12104SWon Kang 93461e12104SWon Kang udev->usb_state = PM_SUSPEND; 93561e12104SWon Kang 93661e12104SWon Kang spin_lock_irqsave(&rx->submit_lock, flags); 937e010a2a0SCihangir Akturk list_for_each_entry_safe(r, r_next, &rx->rx_submit_list, 938e010a2a0SCihangir Akturk rx_submit_list) { 93961e12104SWon Kang spin_unlock_irqrestore(&rx->submit_lock, flags); 94061e12104SWon Kang usb_kill_urb(r->urb); 94161e12104SWon Kang spin_lock_irqsave(&rx->submit_lock, flags); 94261e12104SWon Kang } 94361e12104SWon Kang spin_unlock_irqrestore(&rx->submit_lock, flags); 94461e12104SWon Kang 945bd743442SAmitoj Kaur Chawla cancel_work_sync(&udev->work_tx.work); 946bd743442SAmitoj Kaur Chawla cancel_work_sync(&udev->work_rx.work); 947bd743442SAmitoj Kaur Chawla 94861e12104SWon Kang return 0; 94961e12104SWon Kang } 95061e12104SWon Kang 95161e12104SWon Kang static int gdm_usb_resume(struct usb_interface *intf) 95261e12104SWon Kang { 95361e12104SWon Kang struct phy_dev *phy_dev; 95461e12104SWon Kang struct lte_udev *udev; 95561e12104SWon Kang struct tx_cxt *tx; 95661e12104SWon Kang struct rx_cxt *rx; 95761e12104SWon Kang unsigned long flags; 95861e12104SWon Kang int issue_count; 95961e12104SWon Kang int i; 96061e12104SWon Kang 96161e12104SWon Kang phy_dev = usb_get_intfdata(intf); 96261e12104SWon Kang udev = phy_dev->priv_dev; 96361e12104SWon Kang rx = &udev->rx; 96461e12104SWon Kang 96561e12104SWon Kang if (udev->usb_state != PM_SUSPEND) { 966df02b50aSHaneen Mohammed dev_err(intf->usb_dev, "usb resume - invalid state\n"); 96761e12104SWon Kang return -1; 96861e12104SWon Kang } 96961e12104SWon Kang udev->usb_state = PM_NORMAL; 97061e12104SWon Kang 97161e12104SWon Kang spin_lock_irqsave(&rx->rx_lock, flags); 97261e12104SWon Kang issue_count = rx->avail_count - MAX_RX_SUBMIT_COUNT; 97361e12104SWon Kang spin_unlock_irqrestore(&rx->rx_lock, flags); 97461e12104SWon Kang 97561e12104SWon Kang if (issue_count >= 0) { 97661e12104SWon Kang for (i = 0; i < issue_count; i++) 97761e12104SWon Kang gdm_usb_recv(phy_dev->priv_dev, 97861e12104SWon Kang udev->rx_cb, 97961e12104SWon Kang phy_dev, 98061e12104SWon Kang USB_COMPLETE); 98161e12104SWon Kang } 98261e12104SWon Kang 98361e12104SWon Kang tx = &udev->tx; 98461e12104SWon Kang spin_lock_irqsave(&tx->lock, flags); 985bd743442SAmitoj Kaur Chawla schedule_work(&udev->work_tx.work); 98661e12104SWon Kang spin_unlock_irqrestore(&tx->lock, flags); 98761e12104SWon Kang 98861e12104SWon Kang return 0; 98961e12104SWon Kang } 99061e12104SWon Kang 99161e12104SWon Kang static struct usb_driver gdm_usb_lte_driver = { 99261e12104SWon Kang .name = "gdm_lte", 99361e12104SWon Kang .probe = gdm_usb_probe, 99461e12104SWon Kang .disconnect = gdm_usb_disconnect, 99561e12104SWon Kang .id_table = id_table, 99661e12104SWon Kang .supports_autosuspend = 1, 99761e12104SWon Kang .suspend = gdm_usb_suspend, 99861e12104SWon Kang .resume = gdm_usb_resume, 99961e12104SWon Kang .reset_resume = gdm_usb_resume, 100061e12104SWon Kang }; 100161e12104SWon Kang 100261e12104SWon Kang static int __init gdm_usb_lte_init(void) 100361e12104SWon Kang { 100461e12104SWon Kang if (gdm_lte_event_init() < 0) { 10050ec473b5SJoe Perches pr_err("error creating event\n"); 100661e12104SWon Kang return -1; 100761e12104SWon Kang } 100861e12104SWon Kang 100961e12104SWon Kang return usb_register(&gdm_usb_lte_driver); 101061e12104SWon Kang } 101161e12104SWon Kang 101261e12104SWon Kang static void __exit gdm_usb_lte_exit(void) 101361e12104SWon Kang { 101461e12104SWon Kang gdm_lte_event_exit(); 101561e12104SWon Kang 101661e12104SWon Kang usb_deregister(&gdm_usb_lte_driver); 101761e12104SWon Kang } 101861e12104SWon Kang 101961e12104SWon Kang module_init(gdm_usb_lte_init); 102061e12104SWon Kang module_exit(gdm_usb_lte_exit); 102161e12104SWon Kang 102261e12104SWon Kang MODULE_VERSION(DRIVER_VERSION); 102361e12104SWon Kang MODULE_DESCRIPTION("GCT LTE USB Device Driver"); 102461e12104SWon Kang MODULE_LICENSE("GPL"); 1025