Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2007-2008 Atheros Communications Inc. |
| 3 | * |
| 4 | * Permission to use, copy, modify, and/or distribute this software for any |
| 5 | * purpose with or without fee is hereby granted, provided that the above |
| 6 | * copyright notice and this permission notice appear in all copies. |
| 7 | * |
| 8 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
| 9 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
| 10 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
| 11 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
| 12 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
| 13 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
| 14 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| 15 | */ |
| 16 | /* */ |
| 17 | /* Module Name : wrap_usb.c */ |
| 18 | /* */ |
| 19 | /* Abstract */ |
| 20 | /* This module contains wrapper functions for USB management */ |
| 21 | /* */ |
| 22 | /* NOTES */ |
| 23 | /* Platform dependent. */ |
| 24 | /* */ |
| 25 | /************************************************************************/ |
| 26 | |
| 27 | #include "oal_dt.h" |
| 28 | #include "usbdrv.h" |
| 29 | |
| 30 | #include <linux/netlink.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame^] | 31 | #include <linux/slab.h> |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 32 | #include <net/iw_handler.h> |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 33 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 34 | extern void zfLnxInitUsbTxQ(zdev_t *dev); |
| 35 | extern void zfLnxInitUsbRxQ(zdev_t *dev); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 36 | extern u32_t zfLnxSubmitRegInUrb(zdev_t *dev); |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 37 | u32_t zfLnxUsbOut(zdev_t *dev, u8_t *hdr, u16_t hdrlen, u8_t *snap, |
| 38 | u16_t snapLen, u8_t *tail, u16_t tailLen, zbuf_t *buf, |
| 39 | u16_t offset); |
| 40 | u32_t zfLnxUsbWriteReg(zdev_t *dev, u32_t *cmd, u16_t cmdLen); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 41 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 42 | void zfwUsbRegisterCallBack(zdev_t *dev, struct zfCbUsbFuncTbl *zfUsbFunc) |
| 43 | { |
| 44 | struct usbdrv_private *macp = dev->ml_priv; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 45 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 46 | macp->usbCbFunctions.zfcbUsbRecv = zfUsbFunc->zfcbUsbRecv; |
| 47 | macp->usbCbFunctions.zfcbUsbRegIn = zfUsbFunc->zfcbUsbRegIn; |
| 48 | macp->usbCbFunctions.zfcbUsbOutComplete = zfUsbFunc->zfcbUsbOutComplete; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 49 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 50 | return; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 51 | } |
| 52 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 53 | u32_t zfwUsbGetFreeTxQSize(zdev_t *dev) |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 54 | { |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 55 | struct usbdrv_private *macp = dev->ml_priv; |
| 56 | u32_t freeTxQSize; |
| 57 | unsigned long irqFlag; |
| 58 | /* zmw_declare_for_critical_section(); */ |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 59 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 60 | /* zmw_enter_critical_section(dev); */ |
| 61 | spin_lock_irqsave(&macp->cs_lock, irqFlag); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 62 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 63 | freeTxQSize = ZM_MAX_TX_BUF_NUM - macp->TxBufCnt; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 64 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 65 | /* zmw_leave_critical_section(dev); */ |
| 66 | spin_unlock_irqrestore(&macp->cs_lock, irqFlag); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 67 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 68 | return freeTxQSize; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 69 | } |
| 70 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 71 | u32_t zfwUsbGetMaxTxQSize(zdev_t *dev) |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 72 | { |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 73 | return ZM_MAX_TX_BUF_NUM; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 74 | } |
| 75 | |
| 76 | u32_t zfwUsbEnableIntEpt(zdev_t *dev, u8_t endpt) |
| 77 | { |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 78 | /* Initialize USB TxQ */ |
| 79 | zfLnxInitUsbTxQ(dev); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 80 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 81 | /* Initialize USB RxQ */ |
| 82 | zfLnxInitUsbRxQ(dev); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 83 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 84 | /* Initialize USB Register In URB */ |
| 85 | /* zfwUsbSubmitRegIn(dev); */ |
| 86 | /* Initialize USB Register In URB */ |
| 87 | zfLnxSubmitRegInUrb(dev); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 88 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 89 | return 0; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 90 | } |
| 91 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 92 | int zfwUsbEnableRxEpt(zdev_t *dev, u8_t endpt) |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 93 | { |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 94 | return 0; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 95 | } |
| 96 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 97 | u32_t zfwUsbSubmitControl(zdev_t *dev, u8_t req, u16_t value, u16_t index, |
| 98 | void *data, u32_t size) |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 99 | { |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 100 | int result = 0; |
| 101 | u32_t ret = 0; |
| 102 | struct usbdrv_private *macp = dev->ml_priv; |
| 103 | u8_t *buf; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 104 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 105 | if (size > 0) { |
| 106 | buf = kmalloc(size, GFP_KERNEL); |
| 107 | memcpy(buf, (u8_t *)data, size); |
| 108 | } else |
| 109 | buf = NULL; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 110 | |
| 111 | #if 0 |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 112 | printk(KERN_ERR "req = 0x%02x\n", req); |
| 113 | printk(KERN_ERR "value = 0x%04x\n", value); |
| 114 | printk(KERN_ERR "index = 0x%04x\n", index); |
| 115 | printk(KERN_ERR "data = 0x%lx\n", (u32_t) data); |
| 116 | printk(KERN_ERR "size = %ld\n", size); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 117 | #endif |
| 118 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 119 | result = usb_control_msg(macp->udev, usb_sndctrlpipe(macp->udev, 0), |
| 120 | req, USB_DIR_OUT | 0x40, value, index, buf, size, HZ); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 121 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 122 | if (result < 0) { |
| 123 | printk(KERN_ERR "zfwUsbSubmitControl() failed, result = 0x%x\n", |
| 124 | result); |
| 125 | ret = 1; |
| 126 | } |
| 127 | kfree(buf); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 128 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 129 | return ret; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 130 | } |
| 131 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 132 | void zfwUsbCmd(zdev_t *dev, u8_t endpt, u32_t *cmd, u16_t cmdLen) |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 133 | { |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 134 | struct usbdrv_private *macp = dev->ml_priv; |
| 135 | u32_t ret; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 136 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 137 | /* MPUsbCommand(dev, endpt, cmd, cmdLen); */ |
| 138 | ret = zfLnxUsbWriteReg(dev, cmd, cmdLen); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 139 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 140 | /* |
| 141 | * if zfLnxUsbWriteReg() return error, free and allocate urb, |
| 142 | * resend again |
| 143 | */ |
| 144 | if (ret != 0) { |
| 145 | usb_free_urb(macp->RegOutUrb); |
| 146 | macp->RegOutUrb = usb_alloc_urb(0, GFP_ATOMIC); |
| 147 | ret = zfLnxUsbWriteReg(dev, cmd, cmdLen); |
| 148 | } |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 149 | } |
| 150 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 151 | u32_t zfwUsbSend(zdev_t *dev, u8_t endpt, u8_t *hdr, u16_t hdrlen, u8_t *snap, |
| 152 | u16_t snapLen, u8_t *tail, u16_t tailLen, |
| 153 | zbuf_t *buf, u16_t offset) |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 154 | { |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 155 | u32_t status; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 156 | |
| 157 | #ifdef ZM_CONFIG_BIG_ENDIAN |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 158 | u32_t ii = 0; |
| 159 | u16_t *pc = NULL; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 160 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 161 | pc = (u16_t *)hdr; |
| 162 | for (ii = 0; ii < (hdrlen >> 1); ii++) |
| 163 | pc[ii] = cpu_to_le16(pc[ii]); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 164 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 165 | pc = (u16_t *)snap; |
| 166 | for (ii = 0; ii < (snapLen >> 1); ii++) |
| 167 | pc[ii] = cpu_to_le16(pc[ii]); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 168 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 169 | pc = (u16_t *)tail; |
| 170 | for (ii = 0; ii < (tailLen>>1); ii++) |
| 171 | pc[ii] = cpu_to_le16(pc[ii]); |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 172 | #endif |
| 173 | |
Mithlesh Thukral | 2bef7a0 | 2009-10-26 21:22:55 -0700 | [diff] [blame] | 174 | status = zfLnxUsbOut(dev, hdr, hdrlen, snap, snapLen, tail, tailLen, |
| 175 | buf, offset); |
| 176 | if (status == 0) |
| 177 | return 0; |
| 178 | else |
| 179 | return 1; |
Luis R. Rodriguez | 4bd43f5 | 2008-10-27 22:44:22 -0700 | [diff] [blame] | 180 | } |
| 181 | |
| 182 | /* Leave an empty line below to remove warning message on some compiler */ |