1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * NXP Wireless LAN device driver: USB specific handling
- *
- * Copyright 2011-2020 NXP
- */
- #include "main.h"
- #include "usb.h"
- #define USB_VERSION "1.0"
- static struct mwifiex_if_ops usb_ops;
- static const struct usb_device_id mwifiex_usb_table[] = {
- /* 8766 */
- {USB_DEVICE(USB8XXX_VID, USB8766_PID_1)},
- {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8766_PID_2,
- USB_CLASS_VENDOR_SPEC,
- USB_SUBCLASS_VENDOR_SPEC, 0xff)},
- /* 8797 */
- {USB_DEVICE(USB8XXX_VID, USB8797_PID_1)},
- {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8797_PID_2,
- USB_CLASS_VENDOR_SPEC,
- USB_SUBCLASS_VENDOR_SPEC, 0xff)},
- /* 8801 */
- {USB_DEVICE(USB8XXX_VID, USB8801_PID_1)},
- {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8801_PID_2,
- USB_CLASS_VENDOR_SPEC,
- USB_SUBCLASS_VENDOR_SPEC, 0xff)},
- /* 8997 */
- {USB_DEVICE(USB8XXX_VID, USB8997_PID_1)},
- {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8997_PID_2,
- USB_CLASS_VENDOR_SPEC,
- USB_SUBCLASS_VENDOR_SPEC, 0xff)},
- { } /* Terminating entry */
- };
- MODULE_DEVICE_TABLE(usb, mwifiex_usb_table);
- static int mwifiex_usb_submit_rx_urb(struct urb_context *ctx, int size);
- /* This function handles received packet. Necessary action is taken based on
- * cmd/event/data.
- */
- static int mwifiex_usb_recv(struct mwifiex_adapter *adapter,
- struct sk_buff *skb, u8 ep)
- {
- u32 recv_type;
- __le32 tmp;
- int ret;
- if (adapter->hs_activated)
- mwifiex_process_hs_config(adapter);
- if (skb->len < INTF_HEADER_LEN) {
- mwifiex_dbg(adapter, ERROR,
- "%s: invalid skb->len\n", __func__);
- return -1;
- }
- switch (ep) {
- case MWIFIEX_USB_EP_CMD_EVENT:
- mwifiex_dbg(adapter, EVENT,
- "%s: EP_CMD_EVENT\n", __func__);
- skb_copy_from_linear_data(skb, &tmp, INTF_HEADER_LEN);
- recv_type = le32_to_cpu(tmp);
- skb_pull(skb, INTF_HEADER_LEN);
- switch (recv_type) {
- case MWIFIEX_USB_TYPE_CMD:
- if (skb->len > MWIFIEX_SIZE_OF_CMD_BUFFER) {
- mwifiex_dbg(adapter, ERROR,
- "CMD: skb->len too large\n");
- ret = -1;
- goto exit_restore_skb;
- } else if (!adapter->curr_cmd) {
- mwifiex_dbg(adapter, WARN, "CMD: no curr_cmd\n");
- if (adapter->ps_state == PS_STATE_SLEEP_CFM) {
- mwifiex_process_sleep_confirm_resp(
- adapter, skb->data,
- skb->len);
- ret = 0;
- goto exit_restore_skb;
- }
- ret = -1;
- goto exit_restore_skb;
- }
- adapter->curr_cmd->resp_skb = skb;
- adapter->cmd_resp_received = true;
- break;
- case MWIFIEX_USB_TYPE_EVENT:
- if (skb->len < sizeof(u32)) {
- mwifiex_dbg(adapter, ERROR,
- "EVENT: skb->len too small\n");
- ret = -1;
- goto exit_restore_skb;
- }
- skb_copy_from_linear_data(skb, &tmp, sizeof(u32));
- adapter->event_cause = le32_to_cpu(tmp);
- mwifiex_dbg(adapter, EVENT,
- "event_cause %#x\n", adapter->event_cause);
- if (skb->len > MAX_EVENT_SIZE) {
- mwifiex_dbg(adapter, ERROR,
- "EVENT: event body too large\n");
- ret = -1;
- goto exit_restore_skb;
- }
- memcpy(adapter->event_body, skb->data +
- MWIFIEX_EVENT_HEADER_LEN, skb->len);
- adapter->event_received = true;
- adapter->event_skb = skb;
- break;
- default:
- mwifiex_dbg(adapter, ERROR,
- "unknown recv_type %#x\n", recv_type);
- ret = -1;
- goto exit_restore_skb;
- }
- break;
- case MWIFIEX_USB_EP_DATA:
- mwifiex_dbg(adapter, DATA, "%s: EP_DATA\n", __func__);
- if (skb->len > MWIFIEX_RX_DATA_BUF_SIZE) {
- mwifiex_dbg(adapter, ERROR,
- "DATA: skb->len too large\n");
- return -1;
- }
- skb_queue_tail(&adapter->rx_data_q, skb);
- adapter->data_received = true;
- atomic_inc(&adapter->rx_pending);
- break;
- default:
- mwifiex_dbg(adapter, ERROR,
- "%s: unknown endport %#x\n", __func__, ep);
- return -1;
- }
- return -EINPROGRESS;
- exit_restore_skb:
- /* The buffer will be reused for further cmds/events */
- skb_push(skb, INTF_HEADER_LEN);
- return ret;
- }
- static void mwifiex_usb_rx_complete(struct urb *urb)
- {
- struct urb_context *context = (struct urb_context *)urb->context;
- struct mwifiex_adapter *adapter = context->adapter;
- struct sk_buff *skb = context->skb;
- struct usb_card_rec *card;
- int recv_length = urb->actual_length;
- int size, status;
- if (!adapter || !adapter->card) {
- pr_err("mwifiex adapter or card structure is not valid\n");
- return;
- }
- card = (struct usb_card_rec *)adapter->card;
- if (card->rx_cmd_ep == context->ep)
- atomic_dec(&card->rx_cmd_urb_pending);
- else
- atomic_dec(&card->rx_data_urb_pending);
- if (recv_length) {
- if (urb->status ||
- test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags)) {
- mwifiex_dbg(adapter, ERROR,
- "URB status is failed: %d\n", urb->status);
- /* Do not free skb in case of command ep */
- if (card->rx_cmd_ep != context->ep)
- dev_kfree_skb_any(skb);
- goto setup_for_next;
- }
- if (skb->len > recv_length)
- skb_trim(skb, recv_length);
- else
- skb_put(skb, recv_length - skb->len);
- status = mwifiex_usb_recv(adapter, skb, context->ep);
- mwifiex_dbg(adapter, INFO,
- "info: recv_length=%d, status=%d\n",
- recv_length, status);
- if (status == -EINPROGRESS) {
- mwifiex_queue_main_work(adapter);
- /* urb for data_ep is re-submitted now;
- * urb for cmd_ep will be re-submitted in callback
- * mwifiex_usb_recv_complete
- */
- if (card->rx_cmd_ep == context->ep)
- return;
- } else {
- if (status == -1)
- mwifiex_dbg(adapter, ERROR,
- "received data processing failed!\n");
- /* Do not free skb in case of command ep */
- if (card->rx_cmd_ep != context->ep)
- dev_kfree_skb_any(skb);
- }
- } else if (urb->status) {
- if (!test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)) {
- mwifiex_dbg(adapter, FATAL,
- "Card is removed: %d\n", urb->status);
- set_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags);
- }
- dev_kfree_skb_any(skb);
- return;
- } else {
- /* Do not free skb in case of command ep */
- if (card->rx_cmd_ep != context->ep)
- dev_kfree_skb_any(skb);
- /* fall through setup_for_next */
- }
- setup_for_next:
- if (card->rx_cmd_ep == context->ep)
- size = MWIFIEX_RX_CMD_BUF_SIZE;
- else
- size = MWIFIEX_RX_DATA_BUF_SIZE;
- if (card->rx_cmd_ep == context->ep) {
- mwifiex_usb_submit_rx_urb(context, size);
- } else {
- if (atomic_read(&adapter->rx_pending) <= HIGH_RX_PENDING) {
- mwifiex_usb_submit_rx_urb(context, size);
- } else {
- context->skb = NULL;
- }
- }
- return;
- }
- static void mwifiex_usb_tx_complete(struct urb *urb)
- {
- struct urb_context *context = (struct urb_context *)(urb->context);
- struct mwifiex_adapter *adapter = context->adapter;
- struct usb_card_rec *card = adapter->card;
- struct usb_tx_data_port *port;
- int i;
- mwifiex_dbg(adapter, INFO,
- "%s: status: %d\n", __func__, urb->status);
- if (context->ep == card->tx_cmd_ep) {
- mwifiex_dbg(adapter, CMD,
- "%s: CMD\n", __func__);
- atomic_dec(&card->tx_cmd_urb_pending);
- adapter->cmd_sent = false;
- } else {
- mwifiex_dbg(adapter, DATA,
- "%s: DATA\n", __func__);
- mwifiex_write_data_complete(adapter, context->skb, 0,
- urb->status ? -1 : 0);
- for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
- port = &card->port[i];
- if (context->ep == port->tx_data_ep) {
- atomic_dec(&port->tx_data_urb_pending);
- port->block_status = false;
- break;
- }
- }
- adapter->data_sent = false;
- }
- if (card->mc_resync_flag)
- mwifiex_multi_chan_resync(adapter);
- mwifiex_queue_main_work(adapter);
- return;
- }
- static int mwifiex_usb_submit_rx_urb(struct urb_context *ctx, int size)
- {
- struct mwifiex_adapter *adapter = ctx->adapter;
- struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
- if (test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)) {
- if (card->rx_cmd_ep == ctx->ep) {
- mwifiex_dbg(adapter, INFO, "%s: free rx_cmd skb\n",
- __func__);
- dev_kfree_skb_any(ctx->skb);
- ctx->skb = NULL;
- }
- mwifiex_dbg(adapter, ERROR,
- "%s: card removed/suspended, EP %d rx_cmd URB submit skipped\n",
- __func__, ctx->ep);
- return -1;
- }
- if (card->rx_cmd_ep != ctx->ep) {
- ctx->skb = dev_alloc_skb(size);
- if (!ctx->skb) {
- mwifiex_dbg(adapter, ERROR,
- "%s: dev_alloc_skb failed\n", __func__);
- return -ENOMEM;
- }
- }
- if (card->rx_cmd_ep == ctx->ep &&
- card->rx_cmd_ep_type == USB_ENDPOINT_XFER_INT)
- usb_fill_int_urb(ctx->urb, card->udev,
- usb_rcvintpipe(card->udev, ctx->ep),
- ctx->skb->data, size, mwifiex_usb_rx_complete,
- (void *)ctx, card->rx_cmd_interval);
- else
- usb_fill_bulk_urb(ctx->urb, card->udev,
- usb_rcvbulkpipe(card->udev, ctx->ep),
- ctx->skb->data, size, mwifiex_usb_rx_complete,
- (void *)ctx);
- if (card->rx_cmd_ep == ctx->ep)
- atomic_inc(&card->rx_cmd_urb_pending);
- else
- atomic_inc(&card->rx_data_urb_pending);
- if (usb_submit_urb(ctx->urb, GFP_ATOMIC)) {
- mwifiex_dbg(adapter, ERROR, "usb_submit_urb failed\n");
- dev_kfree_skb_any(ctx->skb);
- ctx->skb = NULL;
- if (card->rx_cmd_ep == ctx->ep)
- atomic_dec(&card->rx_cmd_urb_pending);
- else
- atomic_dec(&card->rx_data_urb_pending);
- return -1;
- }
- return 0;
- }
- static void mwifiex_usb_free(struct usb_card_rec *card)
- {
- struct usb_tx_data_port *port;
- int i, j;
- if (atomic_read(&card->rx_cmd_urb_pending) && card->rx_cmd.urb)
- usb_kill_urb(card->rx_cmd.urb);
- usb_free_urb(card->rx_cmd.urb);
- card->rx_cmd.urb = NULL;
- if (atomic_read(&card->rx_data_urb_pending))
- for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
- if (card->rx_data_list[i].urb)
- usb_kill_urb(card->rx_data_list[i].urb);
- for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
- usb_free_urb(card->rx_data_list[i].urb);
- card->rx_data_list[i].urb = NULL;
- }
- for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
- port = &card->port[i];
- for (j = 0; j < MWIFIEX_TX_DATA_URB; j++) {
- usb_kill_urb(port->tx_data_list[j].urb);
- usb_free_urb(port->tx_data_list[j].urb);
- port->tx_data_list[j].urb = NULL;
- }
- }
- usb_free_urb(card->tx_cmd.urb);
- card->tx_cmd.urb = NULL;
- return;
- }
- /* This function probes an mwifiex device and registers it. It allocates
- * the card structure, initiates the device registration and initialization
- * procedure by adding a logical interface.
- */
- static int mwifiex_usb_probe(struct usb_interface *intf,
- const struct usb_device_id *id)
- {
- struct usb_device *udev = interface_to_usbdev(intf);
- struct usb_host_interface *iface_desc = intf->cur_altsetting;
- struct usb_endpoint_descriptor *epd;
- int ret, i;
- struct usb_card_rec *card;
- u16 id_vendor, id_product, bcd_device;
- card = devm_kzalloc(&intf->dev, sizeof(*card), GFP_KERNEL);
- if (!card)
- return -ENOMEM;
- init_completion(&card->fw_done);
- id_vendor = le16_to_cpu(udev->descriptor.idVendor);
- id_product = le16_to_cpu(udev->descriptor.idProduct);
- bcd_device = le16_to_cpu(udev->descriptor.bcdDevice);
- pr_debug("info: VID/PID = %X/%X, Boot2 version = %X\n",
- id_vendor, id_product, bcd_device);
- /* PID_1 is used for firmware downloading only */
- switch (id_product) {
- case USB8766_PID_1:
- case USB8797_PID_1:
- case USB8801_PID_1:
- case USB8997_PID_1:
- card->usb_boot_state = USB8XXX_FW_DNLD;
- break;
- case USB8766_PID_2:
- case USB8797_PID_2:
- case USB8801_PID_2:
- case USB8997_PID_2:
- card->usb_boot_state = USB8XXX_FW_READY;
- break;
- default:
- pr_warn("unknown id_product %#x\n", id_product);
- card->usb_boot_state = USB8XXX_FW_DNLD;
- break;
- }
- card->udev = udev;
- card->intf = intf;
- pr_debug("info: bcdUSB=%#x Device Class=%#x SubClass=%#x Protocol=%#x\n",
- le16_to_cpu(udev->descriptor.bcdUSB),
- udev->descriptor.bDeviceClass,
- udev->descriptor.bDeviceSubClass,
- udev->descriptor.bDeviceProtocol);
- for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
- epd = &iface_desc->endpoint[i].desc;
- if (usb_endpoint_dir_in(epd) &&
- usb_endpoint_num(epd) == MWIFIEX_USB_EP_CMD_EVENT &&
- (usb_endpoint_xfer_bulk(epd) ||
- usb_endpoint_xfer_int(epd))) {
- card->rx_cmd_ep_type = usb_endpoint_type(epd);
- card->rx_cmd_interval = epd->bInterval;
- pr_debug("info: Rx CMD/EVT:: max pkt size: %d, addr: %d, ep_type: %d\n",
- le16_to_cpu(epd->wMaxPacketSize),
- epd->bEndpointAddress, card->rx_cmd_ep_type);
- card->rx_cmd_ep = usb_endpoint_num(epd);
- atomic_set(&card->rx_cmd_urb_pending, 0);
- }
- if (usb_endpoint_dir_in(epd) &&
- usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA &&
- usb_endpoint_xfer_bulk(epd)) {
- pr_debug("info: bulk IN: max pkt size: %d, addr: %d\n",
- le16_to_cpu(epd->wMaxPacketSize),
- epd->bEndpointAddress);
- card->rx_data_ep = usb_endpoint_num(epd);
- atomic_set(&card->rx_data_urb_pending, 0);
- }
- if (usb_endpoint_dir_out(epd) &&
- usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA &&
- usb_endpoint_xfer_bulk(epd)) {
- pr_debug("info: bulk OUT: max pkt size: %d, addr: %d\n",
- le16_to_cpu(epd->wMaxPacketSize),
- epd->bEndpointAddress);
- card->port[0].tx_data_ep = usb_endpoint_num(epd);
- atomic_set(&card->port[0].tx_data_urb_pending, 0);
- }
- if (usb_endpoint_dir_out(epd) &&
- usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA_CH2 &&
- usb_endpoint_xfer_bulk(epd)) {
- pr_debug("info: bulk OUT chan2:\t"
- "max pkt size: %d, addr: %d\n",
- le16_to_cpu(epd->wMaxPacketSize),
- epd->bEndpointAddress);
- card->port[1].tx_data_ep = usb_endpoint_num(epd);
- atomic_set(&card->port[1].tx_data_urb_pending, 0);
- }
- if (usb_endpoint_dir_out(epd) &&
- usb_endpoint_num(epd) == MWIFIEX_USB_EP_CMD_EVENT &&
- (usb_endpoint_xfer_bulk(epd) ||
- usb_endpoint_xfer_int(epd))) {
- card->tx_cmd_ep_type = usb_endpoint_type(epd);
- card->tx_cmd_interval = epd->bInterval;
- pr_debug("info: bulk OUT: max pkt size: %d, addr: %d\n",
- le16_to_cpu(epd->wMaxPacketSize),
- epd->bEndpointAddress);
- pr_debug("info: Tx CMD:: max pkt size: %d, addr: %d, ep_type: %d\n",
- le16_to_cpu(epd->wMaxPacketSize),
- epd->bEndpointAddress, card->tx_cmd_ep_type);
- card->tx_cmd_ep = usb_endpoint_num(epd);
- atomic_set(&card->tx_cmd_urb_pending, 0);
- card->bulk_out_maxpktsize =
- le16_to_cpu(epd->wMaxPacketSize);
- }
- }
- switch (card->usb_boot_state) {
- case USB8XXX_FW_DNLD:
- /* Reject broken descriptors. */
- if (!card->rx_cmd_ep || !card->tx_cmd_ep)
- return -ENODEV;
- if (card->bulk_out_maxpktsize == 0)
- return -ENODEV;
- break;
- case USB8XXX_FW_READY:
- /* Assume the driver can handle missing endpoints for now. */
- break;
- default:
- WARN_ON(1);
- return -ENODEV;
- }
- usb_set_intfdata(intf, card);
- ret = mwifiex_add_card(card, &card->fw_done, &usb_ops,
- MWIFIEX_USB, &card->udev->dev);
- if (ret) {
- pr_err("%s: mwifiex_add_card failed: %d\n", __func__, ret);
- usb_reset_device(udev);
- return ret;
- }
- usb_get_dev(udev);
- return 0;
- }
- /* Kernel needs to suspend all functions separately. Therefore all
- * registered functions must have drivers with suspend and resume
- * methods. Failing that the kernel simply removes the whole card.
- *
- * If already not suspended, this function allocates and sends a
- * 'host sleep activate' request to the firmware and turns off the traffic.
- */
- static int mwifiex_usb_suspend(struct usb_interface *intf, pm_message_t message)
- {
- struct usb_card_rec *card = usb_get_intfdata(intf);
- struct mwifiex_adapter *adapter;
- struct usb_tx_data_port *port;
- int i, j;
- /* Might still be loading firmware */
- wait_for_completion(&card->fw_done);
- adapter = card->adapter;
- if (!adapter) {
- dev_err(&intf->dev, "card is not valid\n");
- return 0;
- }
- if (unlikely(test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)))
- mwifiex_dbg(adapter, WARN,
- "Device already suspended\n");
- /* Enable the Host Sleep */
- if (!mwifiex_enable_hs(adapter)) {
- mwifiex_dbg(adapter, ERROR,
- "cmd: failed to suspend\n");
- clear_bit(MWIFIEX_IS_HS_ENABLING, &adapter->work_flags);
- return -EFAULT;
- }
- /* 'MWIFIEX_IS_SUSPENDED' bit indicates device is suspended.
- * It must be set here before the usb_kill_urb() calls. Reason
- * is in the complete handlers, urb->status(= -ENOENT) and
- * this flag is used in combination to distinguish between a
- * 'suspended' state and a 'disconnect' one.
- */
- set_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags);
- clear_bit(MWIFIEX_IS_HS_ENABLING, &adapter->work_flags);
- if (atomic_read(&card->rx_cmd_urb_pending) && card->rx_cmd.urb)
- usb_kill_urb(card->rx_cmd.urb);
- if (atomic_read(&card->rx_data_urb_pending))
- for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
- if (card->rx_data_list[i].urb)
- usb_kill_urb(card->rx_data_list[i].urb);
- for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
- port = &card->port[i];
- for (j = 0; j < MWIFIEX_TX_DATA_URB; j++) {
- if (port->tx_data_list[j].urb)
- usb_kill_urb(port->tx_data_list[j].urb);
- }
- }
- if (card->tx_cmd.urb)
- usb_kill_urb(card->tx_cmd.urb);
- return 0;
- }
- /* Kernel needs to suspend all functions separately. Therefore all
- * registered functions must have drivers with suspend and resume
- * methods. Failing that the kernel simply removes the whole card.
- *
- * If already not resumed, this function turns on the traffic and
- * sends a 'host sleep cancel' request to the firmware.
- */
- static int mwifiex_usb_resume(struct usb_interface *intf)
- {
- struct usb_card_rec *card = usb_get_intfdata(intf);
- struct mwifiex_adapter *adapter;
- int i;
- if (!card->adapter) {
- dev_err(&intf->dev, "%s: card->adapter is NULL\n",
- __func__);
- return 0;
- }
- adapter = card->adapter;
- if (unlikely(!test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags))) {
- mwifiex_dbg(adapter, WARN,
- "Device already resumed\n");
- return 0;
- }
- /* Indicate device resumed. The netdev queue will be resumed only
- * after the urbs have been re-submitted
- */
- clear_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags);
- if (!atomic_read(&card->rx_data_urb_pending))
- for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
- mwifiex_usb_submit_rx_urb(&card->rx_data_list[i],
- MWIFIEX_RX_DATA_BUF_SIZE);
- if (!atomic_read(&card->rx_cmd_urb_pending)) {
- card->rx_cmd.skb = dev_alloc_skb(MWIFIEX_RX_CMD_BUF_SIZE);
- if (card->rx_cmd.skb)
- mwifiex_usb_submit_rx_urb(&card->rx_cmd,
- MWIFIEX_RX_CMD_BUF_SIZE);
- }
- /* Disable Host Sleep */
- if (adapter->hs_activated)
- mwifiex_cancel_hs(mwifiex_get_priv(adapter,
- MWIFIEX_BSS_ROLE_ANY),
- MWIFIEX_ASYNC_CMD);
- return 0;
- }
- static void mwifiex_usb_disconnect(struct usb_interface *intf)
- {
- struct usb_card_rec *card = usb_get_intfdata(intf);
- struct mwifiex_adapter *adapter;
- wait_for_completion(&card->fw_done);
- adapter = card->adapter;
- if (!adapter || !adapter->priv_num)
- return;
- if (card->udev->state != USB_STATE_NOTATTACHED && !adapter->mfg_mode) {
- mwifiex_deauthenticate_all(adapter);
- mwifiex_init_shutdown_fw(mwifiex_get_priv(adapter,
- MWIFIEX_BSS_ROLE_ANY),
- MWIFIEX_FUNC_SHUTDOWN);
- }
- mwifiex_dbg(adapter, FATAL,
- "%s: removing card\n", __func__);
- mwifiex_remove_card(adapter);
- usb_put_dev(interface_to_usbdev(intf));
- }
- static void mwifiex_usb_coredump(struct device *dev)
- {
- struct usb_interface *intf = to_usb_interface(dev);
- struct usb_card_rec *card = usb_get_intfdata(intf);
- mwifiex_fw_dump_event(mwifiex_get_priv(card->adapter,
- MWIFIEX_BSS_ROLE_ANY));
- }
- static struct usb_driver mwifiex_usb_driver = {
- .name = "mwifiex_usb",
- .probe = mwifiex_usb_probe,
- .disconnect = mwifiex_usb_disconnect,
- .id_table = mwifiex_usb_table,
- .suspend = mwifiex_usb_suspend,
- .resume = mwifiex_usb_resume,
- .soft_unbind = 1,
- .drvwrap.driver = {
- .coredump = mwifiex_usb_coredump,
- },
- };
- static int mwifiex_write_data_sync(struct mwifiex_adapter *adapter, u8 *pbuf,
- u32 *len, u8 ep, u32 timeout)
- {
- struct usb_card_rec *card = adapter->card;
- int actual_length, ret;
- if (!(*len % card->bulk_out_maxpktsize))
- (*len)++;
- /* Send the data block */
- ret = usb_bulk_msg(card->udev, usb_sndbulkpipe(card->udev, ep), pbuf,
- *len, &actual_length, timeout);
- if (ret) {
- mwifiex_dbg(adapter, ERROR,
- "usb_bulk_msg for tx failed: %d\n", ret);
- return ret;
- }
- *len = actual_length;
- return ret;
- }
- static int mwifiex_read_data_sync(struct mwifiex_adapter *adapter, u8 *pbuf,
- u32 *len, u8 ep, u32 timeout)
- {
- struct usb_card_rec *card = adapter->card;
- int actual_length, ret;
- /* Receive the data response */
- ret = usb_bulk_msg(card->udev, usb_rcvbulkpipe(card->udev, ep), pbuf,
- *len, &actual_length, timeout);
- if (ret) {
- mwifiex_dbg(adapter, ERROR,
- "usb_bulk_msg for rx failed: %d\n", ret);
- return ret;
- }
- *len = actual_length;
- return ret;
- }
- static void mwifiex_usb_port_resync(struct mwifiex_adapter *adapter)
- {
- struct usb_card_rec *card = adapter->card;
- u8 active_port = MWIFIEX_USB_EP_DATA;
- struct mwifiex_private *priv = NULL;
- int i;
- if (adapter->usb_mc_status) {
- for (i = 0; i < adapter->priv_num; i++) {
- priv = adapter->priv[i];
- if (!priv)
- continue;
- if ((priv->bss_role == MWIFIEX_BSS_ROLE_UAP &&
- !priv->bss_started) ||
- (priv->bss_role == MWIFIEX_BSS_ROLE_STA &&
- !priv->media_connected))
- priv->usb_port = MWIFIEX_USB_EP_DATA;
- }
- for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++)
- card->port[i].block_status = false;
- } else {
- for (i = 0; i < adapter->priv_num; i++) {
- priv = adapter->priv[i];
- if (!priv)
- continue;
- if ((priv->bss_role == MWIFIEX_BSS_ROLE_UAP &&
- priv->bss_started) ||
- (priv->bss_role == MWIFIEX_BSS_ROLE_STA &&
- priv->media_connected)) {
- active_port = priv->usb_port;
- break;
- }
- }
- for (i = 0; i < adapter->priv_num; i++) {
- priv = adapter->priv[i];
- if (priv)
- priv->usb_port = active_port;
- }
- for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
- if (active_port == card->port[i].tx_data_ep)
- card->port[i].block_status = false;
- else
- card->port[i].block_status = true;
- }
- }
- }
- static bool mwifiex_usb_is_port_ready(struct mwifiex_private *priv)
- {
- struct usb_card_rec *card = priv->adapter->card;
- int idx;
- for (idx = 0; idx < MWIFIEX_TX_DATA_PORT; idx++) {
- if (priv->usb_port == card->port[idx].tx_data_ep)
- return !card->port[idx].block_status;
- }
- return false;
- }
- static inline u8 mwifiex_usb_data_sent(struct mwifiex_adapter *adapter)
- {
- struct usb_card_rec *card = adapter->card;
- int i;
- for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++)
- if (!card->port[i].block_status)
- return false;
- return true;
- }
- static int mwifiex_usb_construct_send_urb(struct mwifiex_adapter *adapter,
- struct usb_tx_data_port *port, u8 ep,
- struct urb_context *context,
- struct sk_buff *skb_send)
- {
- struct usb_card_rec *card = adapter->card;
- int ret = -EINPROGRESS;
- struct urb *tx_urb;
- context->adapter = adapter;
- context->ep = ep;
- context->skb = skb_send;
- tx_urb = context->urb;
- if (ep == card->tx_cmd_ep &&
- card->tx_cmd_ep_type == USB_ENDPOINT_XFER_INT)
- usb_fill_int_urb(tx_urb, card->udev,
- usb_sndintpipe(card->udev, ep), skb_send->data,
- skb_send->len, mwifiex_usb_tx_complete,
- (void *)context, card->tx_cmd_interval);
- else
- usb_fill_bulk_urb(tx_urb, card->udev,
- usb_sndbulkpipe(card->udev, ep),
- skb_send->data, skb_send->len,
- mwifiex_usb_tx_complete, (void *)context);
- tx_urb->transfer_flags |= URB_ZERO_PACKET;
- if (ep == card->tx_cmd_ep)
- atomic_inc(&card->tx_cmd_urb_pending);
- else
- atomic_inc(&port->tx_data_urb_pending);
- if (ep != card->tx_cmd_ep &&
- atomic_read(&port->tx_data_urb_pending) ==
- MWIFIEX_TX_DATA_URB) {
- port->block_status = true;
- adapter->data_sent = mwifiex_usb_data_sent(adapter);
- ret = -ENOSR;
- }
- if (usb_submit_urb(tx_urb, GFP_ATOMIC)) {
- mwifiex_dbg(adapter, ERROR,
- "%s: usb_submit_urb failed\n", __func__);
- if (ep == card->tx_cmd_ep) {
- atomic_dec(&card->tx_cmd_urb_pending);
- } else {
- atomic_dec(&port->tx_data_urb_pending);
- port->block_status = false;
- adapter->data_sent = false;
- if (port->tx_data_ix)
- port->tx_data_ix--;
- else
- port->tx_data_ix = MWIFIEX_TX_DATA_URB;
- }
- ret = -1;
- }
- return ret;
- }
- static int mwifiex_usb_prepare_tx_aggr_skb(struct mwifiex_adapter *adapter,
- struct usb_tx_data_port *port,
- struct sk_buff **skb_send)
- {
- struct sk_buff *skb_aggr, *skb_tmp;
- u8 *payload, pad;
- u16 align = adapter->bus_aggr.tx_aggr_align;
- struct mwifiex_txinfo *tx_info = NULL;
- bool is_txinfo_set = false;
- /* Packets in aggr_list will be send in either skb_aggr or
- * write complete, delete the tx_aggr timer
- */
- if (port->tx_aggr.timer_cnxt.is_hold_timer_set) {
- del_timer(&port->tx_aggr.timer_cnxt.hold_timer);
- port->tx_aggr.timer_cnxt.is_hold_timer_set = false;
- port->tx_aggr.timer_cnxt.hold_tmo_msecs = 0;
- }
- skb_aggr = mwifiex_alloc_dma_align_buf(port->tx_aggr.aggr_len,
- GFP_ATOMIC);
- if (!skb_aggr) {
- mwifiex_dbg(adapter, ERROR,
- "%s: alloc skb_aggr failed\n", __func__);
- while ((skb_tmp = skb_dequeue(&port->tx_aggr.aggr_list)))
- mwifiex_write_data_complete(adapter, skb_tmp, 0, -1);
- port->tx_aggr.aggr_num = 0;
- port->tx_aggr.aggr_len = 0;
- return -EBUSY;
- }
- tx_info = MWIFIEX_SKB_TXCB(skb_aggr);
- memset(tx_info, 0, sizeof(*tx_info));
- while ((skb_tmp = skb_dequeue(&port->tx_aggr.aggr_list))) {
- /* padding for aligning next packet header*/
- pad = (align - (skb_tmp->len & (align - 1))) % align;
- payload = skb_put(skb_aggr, skb_tmp->len + pad);
- memcpy(payload, skb_tmp->data, skb_tmp->len);
- if (skb_queue_empty(&port->tx_aggr.aggr_list)) {
- /* do not padding for last packet*/
- *(__le16 *)payload = cpu_to_le16(skb_tmp->len);
- *(__le16 *)&payload[2] =
- cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2 | 0x80);
- skb_trim(skb_aggr, skb_aggr->len - pad);
- } else {
- /* add aggregation interface header */
- *(__le16 *)payload = cpu_to_le16(skb_tmp->len + pad);
- *(__le16 *)&payload[2] =
- cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2);
- }
- if (!is_txinfo_set) {
- tx_info->bss_num = MWIFIEX_SKB_TXCB(skb_tmp)->bss_num;
- tx_info->bss_type = MWIFIEX_SKB_TXCB(skb_tmp)->bss_type;
- is_txinfo_set = true;
- }
- port->tx_aggr.aggr_num--;
- port->tx_aggr.aggr_len -= (skb_tmp->len + pad);
- mwifiex_write_data_complete(adapter, skb_tmp, 0, 0);
- }
- tx_info->pkt_len = skb_aggr->len -
- (sizeof(struct txpd) + adapter->intf_hdr_len);
- tx_info->flags |= MWIFIEX_BUF_FLAG_AGGR_PKT;
- port->tx_aggr.aggr_num = 0;
- port->tx_aggr.aggr_len = 0;
- *skb_send = skb_aggr;
- return 0;
- }
- /* This function prepare data packet to be send under usb tx aggregation
- * protocol, check current usb aggregation status, link packet to aggrgation
- * list if possible, work flow as below:
- * (1) if only 1 packet available, add usb tx aggregation header and send.
- * (2) if packet is able to aggregated, link it to current aggregation list.
- * (3) if packet is not able to aggregated, aggregate and send exist packets
- * in aggrgation list. Then, link packet in the list if there is more
- * packet in transmit queue, otherwise try to transmit single packet.
- */
- static int mwifiex_usb_aggr_tx_data(struct mwifiex_adapter *adapter, u8 ep,
- struct sk_buff *skb,
- struct mwifiex_tx_param *tx_param,
- struct usb_tx_data_port *port)
- {
- u8 *payload, pad;
- u16 align = adapter->bus_aggr.tx_aggr_align;
- struct sk_buff *skb_send = NULL;
- struct urb_context *context = NULL;
- struct txpd *local_tx_pd =
- (struct txpd *)((u8 *)skb->data + adapter->intf_hdr_len);
- u8 f_send_aggr_buf = 0;
- u8 f_send_cur_buf = 0;
- u8 f_precopy_cur_buf = 0;
- u8 f_postcopy_cur_buf = 0;
- u32 timeout;
- int ret;
- /* padding to ensure each packet alginment */
- pad = (align - (skb->len & (align - 1))) % align;
- if (tx_param && tx_param->next_pkt_len) {
- /* next packet available in tx queue*/
- if (port->tx_aggr.aggr_len + skb->len + pad >
- adapter->bus_aggr.tx_aggr_max_size) {
- f_send_aggr_buf = 1;
- f_postcopy_cur_buf = 1;
- } else {
- /* current packet could be aggregated*/
- f_precopy_cur_buf = 1;
- if (port->tx_aggr.aggr_len + skb->len + pad +
- tx_param->next_pkt_len >
- adapter->bus_aggr.tx_aggr_max_size ||
- port->tx_aggr.aggr_num + 2 >
- adapter->bus_aggr.tx_aggr_max_num) {
- /* next packet could not be aggregated
- * send current aggregation buffer
- */
- f_send_aggr_buf = 1;
- }
- }
- } else {
- /* last packet in tx queue */
- if (port->tx_aggr.aggr_num > 0) {
- /* pending packets in aggregation buffer*/
- if (port->tx_aggr.aggr_len + skb->len + pad >
- adapter->bus_aggr.tx_aggr_max_size) {
- /* current packet not be able to aggregated,
- * send aggr buffer first, then send packet.
- */
- f_send_cur_buf = 1;
- } else {
- /* last packet, Aggregation and send */
- f_precopy_cur_buf = 1;
- }
- f_send_aggr_buf = 1;
- } else {
- /* no pending packets in aggregation buffer,
- * send current packet immediately
- */
- f_send_cur_buf = 1;
- }
- }
- if (local_tx_pd->flags & MWIFIEX_TxPD_POWER_MGMT_NULL_PACKET) {
- /* Send NULL packet immediately*/
- if (f_precopy_cur_buf) {
- if (skb_queue_empty(&port->tx_aggr.aggr_list)) {
- f_precopy_cur_buf = 0;
- f_send_aggr_buf = 0;
- f_send_cur_buf = 1;
- } else {
- f_send_aggr_buf = 1;
- }
- } else if (f_postcopy_cur_buf) {
- f_send_cur_buf = 1;
- f_postcopy_cur_buf = 0;
- }
- }
- if (f_precopy_cur_buf) {
- skb_queue_tail(&port->tx_aggr.aggr_list, skb);
- port->tx_aggr.aggr_len += (skb->len + pad);
- port->tx_aggr.aggr_num++;
- if (f_send_aggr_buf)
- goto send_aggr_buf;
- /* packet will not been send immediately,
- * set a timer to make sure it will be sent under
- * strict time limit. Dynamically fit the timeout
- * value, according to packets number in aggr_list
- */
- if (!port->tx_aggr.timer_cnxt.is_hold_timer_set) {
- port->tx_aggr.timer_cnxt.hold_tmo_msecs =
- MWIFIEX_USB_TX_AGGR_TMO_MIN;
- timeout =
- port->tx_aggr.timer_cnxt.hold_tmo_msecs;
- mod_timer(&port->tx_aggr.timer_cnxt.hold_timer,
- jiffies + msecs_to_jiffies(timeout));
- port->tx_aggr.timer_cnxt.is_hold_timer_set = true;
- } else {
- if (port->tx_aggr.timer_cnxt.hold_tmo_msecs <
- MWIFIEX_USB_TX_AGGR_TMO_MAX) {
- /* Dyanmic fit timeout */
- timeout =
- ++port->tx_aggr.timer_cnxt.hold_tmo_msecs;
- mod_timer(&port->tx_aggr.timer_cnxt.hold_timer,
- jiffies + msecs_to_jiffies(timeout));
- }
- }
- }
- send_aggr_buf:
- if (f_send_aggr_buf) {
- ret = mwifiex_usb_prepare_tx_aggr_skb(adapter, port, &skb_send);
- if (!ret) {
- context = &port->tx_data_list[port->tx_data_ix++];
- ret = mwifiex_usb_construct_send_urb(adapter, port, ep,
- context, skb_send);
- if (ret == -1)
- mwifiex_write_data_complete(adapter, skb_send,
- 0, -1);
- }
- }
- if (f_send_cur_buf) {
- if (f_send_aggr_buf) {
- if (atomic_read(&port->tx_data_urb_pending) >=
- MWIFIEX_TX_DATA_URB) {
- port->block_status = true;
- adapter->data_sent =
- mwifiex_usb_data_sent(adapter);
- /* no available urb, postcopy packet*/
- f_postcopy_cur_buf = 1;
- goto postcopy_cur_buf;
- }
- if (port->tx_data_ix >= MWIFIEX_TX_DATA_URB)
- port->tx_data_ix = 0;
- }
- payload = skb->data;
- *(__le16 *)&payload[2] =
- cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2 | 0x80);
- *(__le16 *)payload = cpu_to_le16(skb->len);
- skb_send = skb;
- context = &port->tx_data_list[port->tx_data_ix++];
- return mwifiex_usb_construct_send_urb(adapter, port, ep,
- context, skb_send);
- }
- postcopy_cur_buf:
- if (f_postcopy_cur_buf) {
- skb_queue_tail(&port->tx_aggr.aggr_list, skb);
- port->tx_aggr.aggr_len += (skb->len + pad);
- port->tx_aggr.aggr_num++;
- /* New aggregation begin, start timer */
- if (!port->tx_aggr.timer_cnxt.is_hold_timer_set) {
- port->tx_aggr.timer_cnxt.hold_tmo_msecs =
- MWIFIEX_USB_TX_AGGR_TMO_MIN;
- timeout = port->tx_aggr.timer_cnxt.hold_tmo_msecs;
- mod_timer(&port->tx_aggr.timer_cnxt.hold_timer,
- jiffies + msecs_to_jiffies(timeout));
- port->tx_aggr.timer_cnxt.is_hold_timer_set = true;
- }
- }
- return -EINPROGRESS;
- }
- static void mwifiex_usb_tx_aggr_tmo(struct timer_list *t)
- {
- struct urb_context *urb_cnxt = NULL;
- struct sk_buff *skb_send = NULL;
- struct tx_aggr_tmr_cnxt *timer_context =
- from_timer(timer_context, t, hold_timer);
- struct mwifiex_adapter *adapter = timer_context->adapter;
- struct usb_tx_data_port *port = timer_context->port;
- int err = 0;
- spin_lock_bh(&port->tx_aggr_lock);
- err = mwifiex_usb_prepare_tx_aggr_skb(adapter, port, &skb_send);
- if (err) {
- mwifiex_dbg(adapter, ERROR,
- "prepare tx aggr skb failed, err=%d\n", err);
- goto unlock;
- }
- if (atomic_read(&port->tx_data_urb_pending) >=
- MWIFIEX_TX_DATA_URB) {
- port->block_status = true;
- adapter->data_sent =
- mwifiex_usb_data_sent(adapter);
- err = -1;
- goto done;
- }
- if (port->tx_data_ix >= MWIFIEX_TX_DATA_URB)
- port->tx_data_ix = 0;
- urb_cnxt = &port->tx_data_list[port->tx_data_ix++];
- err = mwifiex_usb_construct_send_urb(adapter, port, port->tx_data_ep,
- urb_cnxt, skb_send);
- done:
- if (err == -1)
- mwifiex_write_data_complete(adapter, skb_send, 0, -1);
- unlock:
- spin_unlock_bh(&port->tx_aggr_lock);
- }
- /* This function write a command/data packet to card. */
- static int mwifiex_usb_host_to_card(struct mwifiex_adapter *adapter, u8 ep,
- struct sk_buff *skb,
- struct mwifiex_tx_param *tx_param)
- {
- struct usb_card_rec *card = adapter->card;
- struct urb_context *context = NULL;
- struct usb_tx_data_port *port = NULL;
- int idx, ret;
- if (test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)) {
- mwifiex_dbg(adapter, ERROR,
- "%s: not allowed while suspended\n", __func__);
- return -1;
- }
- if (test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags)) {
- mwifiex_dbg(adapter, ERROR, "%s: device removed\n", __func__);
- return -1;
- }
- mwifiex_dbg(adapter, INFO, "%s: ep=%d\n", __func__, ep);
- if (ep == card->tx_cmd_ep) {
- context = &card->tx_cmd;
- } else {
- /* get the data port structure for endpoint */
- for (idx = 0; idx < MWIFIEX_TX_DATA_PORT; idx++) {
- if (ep == card->port[idx].tx_data_ep) {
- port = &card->port[idx];
- if (atomic_read(&port->tx_data_urb_pending)
- >= MWIFIEX_TX_DATA_URB) {
- port->block_status = true;
- adapter->data_sent =
- mwifiex_usb_data_sent(adapter);
- return -EBUSY;
- }
- if (port->tx_data_ix >= MWIFIEX_TX_DATA_URB)
- port->tx_data_ix = 0;
- break;
- }
- }
- if (!port) {
- mwifiex_dbg(adapter, ERROR, "Wrong usb tx data port\n");
- return -1;
- }
- if (adapter->bus_aggr.enable) {
- spin_lock_bh(&port->tx_aggr_lock);
- ret = mwifiex_usb_aggr_tx_data(adapter, ep, skb,
- tx_param, port);
- spin_unlock_bh(&port->tx_aggr_lock);
- return ret;
- }
- context = &port->tx_data_list[port->tx_data_ix++];
- }
- return mwifiex_usb_construct_send_urb(adapter, port, ep, context, skb);
- }
- static int mwifiex_usb_tx_init(struct mwifiex_adapter *adapter)
- {
- struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
- struct usb_tx_data_port *port;
- int i, j;
- card->tx_cmd.adapter = adapter;
- card->tx_cmd.ep = card->tx_cmd_ep;
- card->tx_cmd.urb = usb_alloc_urb(0, GFP_KERNEL);
- if (!card->tx_cmd.urb)
- return -ENOMEM;
- for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
- port = &card->port[i];
- if (!port->tx_data_ep)
- continue;
- port->tx_data_ix = 0;
- skb_queue_head_init(&port->tx_aggr.aggr_list);
- if (port->tx_data_ep == MWIFIEX_USB_EP_DATA)
- port->block_status = false;
- else
- port->block_status = true;
- for (j = 0; j < MWIFIEX_TX_DATA_URB; j++) {
- port->tx_data_list[j].adapter = adapter;
- port->tx_data_list[j].ep = port->tx_data_ep;
- port->tx_data_list[j].urb =
- usb_alloc_urb(0, GFP_KERNEL);
- if (!port->tx_data_list[j].urb)
- return -ENOMEM;
- }
- port->tx_aggr.timer_cnxt.adapter = adapter;
- port->tx_aggr.timer_cnxt.port = port;
- port->tx_aggr.timer_cnxt.is_hold_timer_set = false;
- port->tx_aggr.timer_cnxt.hold_tmo_msecs = 0;
- timer_setup(&port->tx_aggr.timer_cnxt.hold_timer,
- mwifiex_usb_tx_aggr_tmo, 0);
- }
- return 0;
- }
- static int mwifiex_usb_rx_init(struct mwifiex_adapter *adapter)
- {
- struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
- int i;
- card->rx_cmd.adapter = adapter;
- card->rx_cmd.ep = card->rx_cmd_ep;
- card->rx_cmd.urb = usb_alloc_urb(0, GFP_KERNEL);
- if (!card->rx_cmd.urb)
- return -ENOMEM;
- card->rx_cmd.skb = dev_alloc_skb(MWIFIEX_RX_CMD_BUF_SIZE);
- if (!card->rx_cmd.skb)
- return -ENOMEM;
- if (mwifiex_usb_submit_rx_urb(&card->rx_cmd, MWIFIEX_RX_CMD_BUF_SIZE))
- return -1;
- for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
- card->rx_data_list[i].adapter = adapter;
- card->rx_data_list[i].ep = card->rx_data_ep;
- card->rx_data_list[i].urb = usb_alloc_urb(0, GFP_KERNEL);
- if (!card->rx_data_list[i].urb)
- return -1;
- if (mwifiex_usb_submit_rx_urb(&card->rx_data_list[i],
- MWIFIEX_RX_DATA_BUF_SIZE))
- return -1;
- }
- return 0;
- }
- /* This function register usb device and initialize parameter. */
- static int mwifiex_register_dev(struct mwifiex_adapter *adapter)
- {
- struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
- card->adapter = adapter;
- switch (le16_to_cpu(card->udev->descriptor.idProduct)) {
- case USB8997_PID_1:
- case USB8997_PID_2:
- adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_4K;
- strcpy(adapter->fw_name, USB8997_DEFAULT_FW_NAME);
- adapter->ext_scan = true;
- break;
- case USB8766_PID_1:
- case USB8766_PID_2:
- adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
- strcpy(adapter->fw_name, USB8766_DEFAULT_FW_NAME);
- adapter->ext_scan = true;
- break;
- case USB8801_PID_1:
- case USB8801_PID_2:
- adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
- strcpy(adapter->fw_name, USB8801_DEFAULT_FW_NAME);
- adapter->ext_scan = false;
- break;
- case USB8797_PID_1:
- case USB8797_PID_2:
- default:
- adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
- strcpy(adapter->fw_name, USB8797_DEFAULT_FW_NAME);
- break;
- }
- adapter->usb_mc_status = false;
- adapter->usb_mc_setup = false;
- return 0;
- }
- static void mwifiex_usb_cleanup_tx_aggr(struct mwifiex_adapter *adapter)
- {
- struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
- struct usb_tx_data_port *port;
- struct sk_buff *skb_tmp;
- int idx;
- for (idx = 0; idx < MWIFIEX_TX_DATA_PORT; idx++) {
- port = &card->port[idx];
- if (adapter->bus_aggr.enable)
- while ((skb_tmp =
- skb_dequeue(&port->tx_aggr.aggr_list)))
- mwifiex_write_data_complete(adapter, skb_tmp,
- 0, -1);
- if (port->tx_aggr.timer_cnxt.hold_timer.function)
- del_timer_sync(&port->tx_aggr.timer_cnxt.hold_timer);
- port->tx_aggr.timer_cnxt.is_hold_timer_set = false;
- port->tx_aggr.timer_cnxt.hold_tmo_msecs = 0;
- }
- }
- static void mwifiex_unregister_dev(struct mwifiex_adapter *adapter)
- {
- struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
- mwifiex_usb_free(card);
- mwifiex_usb_cleanup_tx_aggr(adapter);
- card->adapter = NULL;
- }
- static int mwifiex_prog_fw_w_helper(struct mwifiex_adapter *adapter,
- struct mwifiex_fw_image *fw)
- {
- int ret = 0;
- u8 *firmware = fw->fw_buf, *recv_buff;
- u32 retries = USB8XXX_FW_MAX_RETRY + 1;
- u32 dlen;
- u32 fw_seqnum = 0, tlen = 0, dnld_cmd = 0;
- struct fw_data *fwdata;
- struct fw_sync_header sync_fw;
- u8 check_winner = 1;
- if (!firmware) {
- mwifiex_dbg(adapter, ERROR,
- "No firmware image found! Terminating download\n");
- ret = -1;
- goto fw_exit;
- }
- /* Allocate memory for transmit */
- fwdata = kzalloc(FW_DNLD_TX_BUF_SIZE, GFP_KERNEL);
- if (!fwdata) {
- ret = -ENOMEM;
- goto fw_exit;
- }
- /* Allocate memory for receive */
- recv_buff = kzalloc(FW_DNLD_RX_BUF_SIZE, GFP_KERNEL);
- if (!recv_buff) {
- ret = -ENOMEM;
- goto cleanup;
- }
- do {
- /* Send pseudo data to check winner status first */
- if (check_winner) {
- memset(&fwdata->fw_hdr, 0, sizeof(struct fw_header));
- dlen = 0;
- } else {
- /* copy the header of the fw_data to get the length */
- memcpy(&fwdata->fw_hdr, &firmware[tlen],
- sizeof(struct fw_header));
- dlen = le32_to_cpu(fwdata->fw_hdr.data_len);
- dnld_cmd = le32_to_cpu(fwdata->fw_hdr.dnld_cmd);
- tlen += sizeof(struct fw_header);
- /* Command 7 doesn't have data length field */
- if (dnld_cmd == FW_CMD_7)
- dlen = 0;
- memcpy(fwdata->data, &firmware[tlen], dlen);
- fwdata->seq_num = cpu_to_le32(fw_seqnum);
- tlen += dlen;
- }
- /* If the send/receive fails or CRC occurs then retry */
- while (--retries) {
- u8 *buf = (u8 *)fwdata;
- u32 len = FW_DATA_XMIT_SIZE;
- /* send the firmware block */
- ret = mwifiex_write_data_sync(adapter, buf, &len,
- MWIFIEX_USB_EP_CMD_EVENT,
- MWIFIEX_USB_TIMEOUT);
- if (ret) {
- mwifiex_dbg(adapter, ERROR,
- "write_data_sync: failed: %d\n",
- ret);
- continue;
- }
- buf = recv_buff;
- len = FW_DNLD_RX_BUF_SIZE;
- /* Receive the firmware block response */
- ret = mwifiex_read_data_sync(adapter, buf, &len,
- MWIFIEX_USB_EP_CMD_EVENT,
- MWIFIEX_USB_TIMEOUT);
- if (ret) {
- mwifiex_dbg(adapter, ERROR,
- "read_data_sync: failed: %d\n",
- ret);
- continue;
- }
- memcpy(&sync_fw, recv_buff,
- sizeof(struct fw_sync_header));
- /* check 1st firmware block resp for highest bit set */
- if (check_winner) {
- if (le32_to_cpu(sync_fw.cmd) & 0x80000000) {
- mwifiex_dbg(adapter, WARN,
- "USB is not the winner %#x\n",
- sync_fw.cmd);
- /* returning success */
- ret = 0;
- goto cleanup;
- }
- mwifiex_dbg(adapter, MSG,
- "start to download FW...\n");
- check_winner = 0;
- break;
- }
- /* check the firmware block response for CRC errors */
- if (sync_fw.cmd) {
- mwifiex_dbg(adapter, ERROR,
- "FW received block with CRC %#x\n",
- sync_fw.cmd);
- ret = -1;
- continue;
- }
- retries = USB8XXX_FW_MAX_RETRY + 1;
- break;
- }
- fw_seqnum++;
- } while ((dnld_cmd != FW_HAS_LAST_BLOCK) && retries);
- cleanup:
- mwifiex_dbg(adapter, MSG,
- "info: FW download over, size %d bytes\n", tlen);
- kfree(recv_buff);
- kfree(fwdata);
- if (retries)
- ret = 0;
- fw_exit:
- return ret;
- }
- static int mwifiex_usb_dnld_fw(struct mwifiex_adapter *adapter,
- struct mwifiex_fw_image *fw)
- {
- int ret;
- struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
- if (card->usb_boot_state == USB8XXX_FW_DNLD) {
- ret = mwifiex_prog_fw_w_helper(adapter, fw);
- if (ret)
- return -1;
- /* Boot state changes after successful firmware download */
- if (card->usb_boot_state == USB8XXX_FW_DNLD)
- return -1;
- }
- ret = mwifiex_usb_rx_init(adapter);
- if (!ret)
- ret = mwifiex_usb_tx_init(adapter);
- return ret;
- }
- static void mwifiex_submit_rx_urb(struct mwifiex_adapter *adapter, u8 ep)
- {
- struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
- skb_push(card->rx_cmd.skb, INTF_HEADER_LEN);
- if ((ep == card->rx_cmd_ep) &&
- (!atomic_read(&card->rx_cmd_urb_pending)))
- mwifiex_usb_submit_rx_urb(&card->rx_cmd,
- MWIFIEX_RX_CMD_BUF_SIZE);
- return;
- }
- static int mwifiex_usb_cmd_event_complete(struct mwifiex_adapter *adapter,
- struct sk_buff *skb)
- {
- mwifiex_submit_rx_urb(adapter, MWIFIEX_USB_EP_CMD_EVENT);
- return 0;
- }
- /* This function wakes up the card. */
- static int mwifiex_pm_wakeup_card(struct mwifiex_adapter *adapter)
- {
- /* Simulation of HS_AWAKE event */
- adapter->pm_wakeup_fw_try = false;
- del_timer(&adapter->wakeup_timer);
- adapter->pm_wakeup_card_req = false;
- adapter->ps_state = PS_STATE_AWAKE;
- return 0;
- }
- static void mwifiex_usb_submit_rem_rx_urbs(struct mwifiex_adapter *adapter)
- {
- struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
- int i;
- struct urb_context *ctx;
- for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
- if (card->rx_data_list[i].skb)
- continue;
- ctx = &card->rx_data_list[i];
- mwifiex_usb_submit_rx_urb(ctx, MWIFIEX_RX_DATA_BUF_SIZE);
- }
- }
- /* This function is called after the card has woken up. */
- static inline int
- mwifiex_pm_wakeup_card_complete(struct mwifiex_adapter *adapter)
- {
- return 0;
- }
- static struct mwifiex_if_ops usb_ops = {
- .register_dev = mwifiex_register_dev,
- .unregister_dev = mwifiex_unregister_dev,
- .wakeup = mwifiex_pm_wakeup_card,
- .wakeup_complete = mwifiex_pm_wakeup_card_complete,
- /* USB specific */
- .dnld_fw = mwifiex_usb_dnld_fw,
- .cmdrsp_complete = mwifiex_usb_cmd_event_complete,
- .event_complete = mwifiex_usb_cmd_event_complete,
- .host_to_card = mwifiex_usb_host_to_card,
- .submit_rem_rx_urbs = mwifiex_usb_submit_rem_rx_urbs,
- .multi_port_resync = mwifiex_usb_port_resync,
- .is_port_ready = mwifiex_usb_is_port_ready,
- };
- module_usb_driver(mwifiex_usb_driver);
- MODULE_AUTHOR("Marvell International Ltd.");
- MODULE_DESCRIPTION("Marvell WiFi-Ex USB Driver version" USB_VERSION);
- MODULE_VERSION(USB_VERSION);
- MODULE_LICENSE("GPL v2");
- MODULE_FIRMWARE(USB8766_DEFAULT_FW_NAME);
- MODULE_FIRMWARE(USB8797_DEFAULT_FW_NAME);
- MODULE_FIRMWARE(USB8801_DEFAULT_FW_NAME);
- MODULE_FIRMWARE(USB8997_DEFAULT_FW_NAME);
|