Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2010 Broadcom Corporation |
| 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 ANY |
| 11 | * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
| 12 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION |
| 13 | * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN |
| 14 | * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| 15 | */ |
| 16 | |
Joe Perches | 02f7719 | 2012-01-15 00:38:44 -0800 | [diff] [blame] | 17 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| 18 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 19 | #include <linux/init.h> |
| 20 | #include <linux/kernel.h> |
| 21 | #include <linux/kthread.h> |
| 22 | #include <linux/slab.h> |
| 23 | #include <linux/skbuff.h> |
| 24 | #include <linux/netdevice.h> |
| 25 | #include <linux/etherdevice.h> |
| 26 | #include <linux/mmc/sdio_func.h> |
| 27 | #include <linux/random.h> |
| 28 | #include <linux/spinlock.h> |
| 29 | #include <linux/ethtool.h> |
| 30 | #include <linux/fcntl.h> |
| 31 | #include <linux/fs.h> |
| 32 | #include <linux/uaccess.h> |
| 33 | #include <linux/hardirq.h> |
| 34 | #include <linux/mutex.h> |
| 35 | #include <linux/wait.h> |
Stephen Rothwell | b7a57e7 | 2011-10-12 21:35:07 +0200 | [diff] [blame] | 36 | #include <linux/module.h> |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 37 | #include <net/cfg80211.h> |
| 38 | #include <net/rtnetlink.h> |
| 39 | #include <defs.h> |
| 40 | #include <brcmu_utils.h> |
| 41 | #include <brcmu_wifi.h> |
| 42 | |
| 43 | #include "dhd.h" |
| 44 | #include "dhd_bus.h" |
| 45 | #include "dhd_proto.h" |
| 46 | #include "dhd_dbg.h" |
| 47 | #include "wl_cfg80211.h" |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 48 | |
| 49 | MODULE_AUTHOR("Broadcom Corporation"); |
| 50 | MODULE_DESCRIPTION("Broadcom 802.11n wireless LAN fullmac driver."); |
| 51 | MODULE_SUPPORTED_DEVICE("Broadcom 802.11n WLAN fullmac cards"); |
| 52 | MODULE_LICENSE("Dual BSD/GPL"); |
| 53 | |
| 54 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 55 | /* Error bits */ |
Franky Lin | 4f96bf1 | 2011-11-22 17:21:48 -0800 | [diff] [blame] | 56 | int brcmf_msg_level = BRCMF_ERROR_VAL; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 57 | module_param(brcmf_msg_level, int, 0); |
| 58 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 59 | int brcmf_ifname2idx(struct brcmf_pub *drvr, char *name) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 60 | { |
| 61 | int i = BRCMF_MAX_IFS; |
| 62 | struct brcmf_if *ifp; |
| 63 | |
| 64 | if (name == NULL || *name == '\0') |
| 65 | return 0; |
| 66 | |
| 67 | while (--i > 0) { |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 68 | ifp = drvr->iflist[i]; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 69 | if (ifp && !strncmp(ifp->ndev->name, name, IFNAMSIZ)) |
| 70 | break; |
| 71 | } |
| 72 | |
| 73 | brcmf_dbg(TRACE, "return idx %d for \"%s\"\n", i, name); |
| 74 | |
| 75 | return i; /* default - the primary interface */ |
| 76 | } |
| 77 | |
| 78 | char *brcmf_ifname(struct brcmf_pub *drvr, int ifidx) |
| 79 | { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 80 | if (ifidx < 0 || ifidx >= BRCMF_MAX_IFS) { |
| 81 | brcmf_dbg(ERROR, "ifidx %d out of range\n", ifidx); |
| 82 | return "<if_bad>"; |
| 83 | } |
| 84 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 85 | if (drvr->iflist[ifidx] == NULL) { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 86 | brcmf_dbg(ERROR, "null i/f %d\n", ifidx); |
| 87 | return "<if_null>"; |
| 88 | } |
| 89 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 90 | if (drvr->iflist[ifidx]->ndev) |
| 91 | return drvr->iflist[ifidx]->ndev->name; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 92 | |
| 93 | return "<if_none>"; |
| 94 | } |
| 95 | |
| 96 | static void _brcmf_set_multicast_list(struct work_struct *work) |
| 97 | { |
| 98 | struct net_device *ndev; |
| 99 | struct netdev_hw_addr *ha; |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 100 | u32 dcmd_value, cnt; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 101 | __le32 cnt_le; |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 102 | __le32 dcmd_le_value; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 103 | |
| 104 | struct brcmf_dcmd dcmd; |
| 105 | char *buf, *bufp; |
| 106 | uint buflen; |
| 107 | int ret; |
| 108 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 109 | struct brcmf_pub *drvr = container_of(work, struct brcmf_pub, |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 110 | multicast_work); |
| 111 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 112 | ndev = drvr->iflist[0]->ndev; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 113 | cnt = netdev_mc_count(ndev); |
| 114 | |
| 115 | /* Determine initial value of allmulti flag */ |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 116 | dcmd_value = (ndev->flags & IFF_ALLMULTI) ? true : false; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 117 | |
| 118 | /* Send down the multicast list first. */ |
| 119 | |
| 120 | buflen = sizeof("mcast_list") + sizeof(cnt) + (cnt * ETH_ALEN); |
| 121 | bufp = buf = kmalloc(buflen, GFP_ATOMIC); |
| 122 | if (!bufp) |
| 123 | return; |
| 124 | |
| 125 | strcpy(bufp, "mcast_list"); |
| 126 | bufp += strlen("mcast_list") + 1; |
| 127 | |
| 128 | cnt_le = cpu_to_le32(cnt); |
| 129 | memcpy(bufp, &cnt_le, sizeof(cnt)); |
| 130 | bufp += sizeof(cnt_le); |
| 131 | |
| 132 | netdev_for_each_mc_addr(ha, ndev) { |
| 133 | if (!cnt) |
| 134 | break; |
| 135 | memcpy(bufp, ha->addr, ETH_ALEN); |
| 136 | bufp += ETH_ALEN; |
| 137 | cnt--; |
| 138 | } |
| 139 | |
| 140 | memset(&dcmd, 0, sizeof(dcmd)); |
| 141 | dcmd.cmd = BRCMF_C_SET_VAR; |
| 142 | dcmd.buf = buf; |
| 143 | dcmd.len = buflen; |
| 144 | dcmd.set = true; |
| 145 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 146 | ret = brcmf_proto_dcmd(drvr, 0, &dcmd, dcmd.len); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 147 | if (ret < 0) { |
| 148 | brcmf_dbg(ERROR, "%s: set mcast_list failed, cnt %d\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 149 | brcmf_ifname(drvr, 0), cnt); |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 150 | dcmd_value = cnt ? true : dcmd_value; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 151 | } |
| 152 | |
| 153 | kfree(buf); |
| 154 | |
| 155 | /* Now send the allmulti setting. This is based on the setting in the |
| 156 | * net_device flags, but might be modified above to be turned on if we |
| 157 | * were trying to set some addresses and dongle rejected it... |
| 158 | */ |
| 159 | |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 160 | buflen = sizeof("allmulti") + sizeof(dcmd_value); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 161 | buf = kmalloc(buflen, GFP_ATOMIC); |
| 162 | if (!buf) |
| 163 | return; |
| 164 | |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 165 | dcmd_le_value = cpu_to_le32(dcmd_value); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 166 | |
Alwin Beukers | 53a2277 | 2011-10-12 20:51:30 +0200 | [diff] [blame] | 167 | if (!brcmf_c_mkiovar |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 168 | ("allmulti", (void *)&dcmd_le_value, |
| 169 | sizeof(dcmd_le_value), buf, buflen)) { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 170 | brcmf_dbg(ERROR, "%s: mkiovar failed for allmulti, datalen %d buflen %u\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 171 | brcmf_ifname(drvr, 0), |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 172 | (int)sizeof(dcmd_value), buflen); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 173 | kfree(buf); |
| 174 | return; |
| 175 | } |
| 176 | |
| 177 | memset(&dcmd, 0, sizeof(dcmd)); |
| 178 | dcmd.cmd = BRCMF_C_SET_VAR; |
| 179 | dcmd.buf = buf; |
| 180 | dcmd.len = buflen; |
| 181 | dcmd.set = true; |
| 182 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 183 | ret = brcmf_proto_dcmd(drvr, 0, &dcmd, dcmd.len); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 184 | if (ret < 0) { |
| 185 | brcmf_dbg(ERROR, "%s: set allmulti %d failed\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 186 | brcmf_ifname(drvr, 0), |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 187 | le32_to_cpu(dcmd_le_value)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 188 | } |
| 189 | |
| 190 | kfree(buf); |
| 191 | |
| 192 | /* Finally, pick up the PROMISC flag as well, like the NIC |
| 193 | driver does */ |
| 194 | |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 195 | dcmd_value = (ndev->flags & IFF_PROMISC) ? true : false; |
| 196 | dcmd_le_value = cpu_to_le32(dcmd_value); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 197 | |
| 198 | memset(&dcmd, 0, sizeof(dcmd)); |
| 199 | dcmd.cmd = BRCMF_C_SET_PROMISC; |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 200 | dcmd.buf = &dcmd_le_value; |
| 201 | dcmd.len = sizeof(dcmd_le_value); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 202 | dcmd.set = true; |
| 203 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 204 | ret = brcmf_proto_dcmd(drvr, 0, &dcmd, dcmd.len); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 205 | if (ret < 0) { |
| 206 | brcmf_dbg(ERROR, "%s: set promisc %d failed\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 207 | brcmf_ifname(drvr, 0), |
Arend van Spriel | b503624 | 2011-10-12 20:51:17 +0200 | [diff] [blame] | 208 | le32_to_cpu(dcmd_le_value)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 209 | } |
| 210 | } |
| 211 | |
| 212 | static void |
| 213 | _brcmf_set_mac_address(struct work_struct *work) |
| 214 | { |
| 215 | char buf[32]; |
| 216 | struct brcmf_dcmd dcmd; |
| 217 | int ret; |
| 218 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 219 | struct brcmf_pub *drvr = container_of(work, struct brcmf_pub, |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 220 | setmacaddr_work); |
| 221 | |
| 222 | brcmf_dbg(TRACE, "enter\n"); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 223 | if (!brcmf_c_mkiovar("cur_etheraddr", (char *)drvr->macvalue, |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 224 | ETH_ALEN, buf, 32)) { |
| 225 | brcmf_dbg(ERROR, "%s: mkiovar failed for cur_etheraddr\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 226 | brcmf_ifname(drvr, 0)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 227 | return; |
| 228 | } |
| 229 | memset(&dcmd, 0, sizeof(dcmd)); |
| 230 | dcmd.cmd = BRCMF_C_SET_VAR; |
| 231 | dcmd.buf = buf; |
| 232 | dcmd.len = 32; |
| 233 | dcmd.set = true; |
| 234 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 235 | ret = brcmf_proto_dcmd(drvr, 0, &dcmd, dcmd.len); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 236 | if (ret < 0) |
| 237 | brcmf_dbg(ERROR, "%s: set cur_etheraddr failed\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 238 | brcmf_ifname(drvr, 0)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 239 | else |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 240 | memcpy(drvr->iflist[0]->ndev->dev_addr, |
| 241 | drvr->macvalue, ETH_ALEN); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 242 | |
| 243 | return; |
| 244 | } |
| 245 | |
| 246 | static int brcmf_netdev_set_mac_address(struct net_device *ndev, void *addr) |
| 247 | { |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 248 | struct brcmf_if *ifp = netdev_priv(ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 249 | struct brcmf_pub *drvr = ifp->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 250 | struct sockaddr *sa = (struct sockaddr *)addr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 251 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 252 | memcpy(&drvr->macvalue, sa->sa_data, ETH_ALEN); |
| 253 | schedule_work(&drvr->setmacaddr_work); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 254 | return 0; |
| 255 | } |
| 256 | |
| 257 | static void brcmf_netdev_set_multicast_list(struct net_device *ndev) |
| 258 | { |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 259 | struct brcmf_if *ifp = netdev_priv(ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 260 | struct brcmf_pub *drvr = ifp->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 261 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 262 | schedule_work(&drvr->multicast_work); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 263 | } |
| 264 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 265 | static int brcmf_netdev_start_xmit(struct sk_buff *skb, struct net_device *ndev) |
| 266 | { |
| 267 | int ret; |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 268 | struct brcmf_if *ifp = netdev_priv(ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 269 | struct brcmf_pub *drvr = ifp->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 270 | |
| 271 | brcmf_dbg(TRACE, "Enter\n"); |
| 272 | |
| 273 | /* Reject if down */ |
Franky Lin | 3fb1d8d | 2011-12-16 18:37:04 -0800 | [diff] [blame] | 274 | if (!drvr->bus_if->drvr_up || |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 275 | (drvr->bus_if->state == BRCMF_BUS_DOWN)) { |
Franky Lin | 3fb1d8d | 2011-12-16 18:37:04 -0800 | [diff] [blame] | 276 | brcmf_dbg(ERROR, "xmit rejected drvup=%d state=%d\n", |
| 277 | drvr->bus_if->drvr_up, |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 278 | drvr->bus_if->state); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 279 | netif_stop_queue(ndev); |
| 280 | return -ENODEV; |
| 281 | } |
| 282 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 283 | if (!drvr->iflist[ifp->idx]) { |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 284 | brcmf_dbg(ERROR, "bad ifidx %d\n", ifp->idx); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 285 | netif_stop_queue(ndev); |
| 286 | return -ENODEV; |
| 287 | } |
| 288 | |
| 289 | /* Make sure there's enough room for any header */ |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 290 | if (skb_headroom(skb) < drvr->hdrlen) { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 291 | struct sk_buff *skb2; |
| 292 | |
| 293 | brcmf_dbg(INFO, "%s: insufficient headroom\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 294 | brcmf_ifname(drvr, ifp->idx)); |
Franky Lin | 9c1a043 | 2011-12-16 18:37:07 -0800 | [diff] [blame] | 295 | drvr->bus_if->tx_realloc++; |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 296 | skb2 = skb_realloc_headroom(skb, drvr->hdrlen); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 297 | dev_kfree_skb(skb); |
| 298 | skb = skb2; |
| 299 | if (skb == NULL) { |
| 300 | brcmf_dbg(ERROR, "%s: skb_realloc_headroom failed\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 301 | brcmf_ifname(drvr, ifp->idx)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 302 | ret = -ENOMEM; |
| 303 | goto done; |
| 304 | } |
| 305 | } |
| 306 | |
Franky Lin | 8514fd0 | 2012-09-13 21:11:57 +0200 | [diff] [blame] | 307 | /* Update multicast statistic */ |
| 308 | if (skb->len >= ETH_ALEN) { |
| 309 | u8 *pktdata = (u8 *)(skb->data); |
| 310 | struct ethhdr *eh = (struct ethhdr *)pktdata; |
| 311 | |
| 312 | if (is_multicast_ether_addr(eh->h_dest)) |
| 313 | drvr->tx_multicast++; |
| 314 | if (ntohs(eh->h_proto) == ETH_P_PAE) |
| 315 | atomic_inc(&drvr->pend_8021x_cnt); |
| 316 | } |
| 317 | |
| 318 | /* If the protocol uses a data header, apply it */ |
| 319 | brcmf_proto_hdrpush(drvr, ifp->idx, skb); |
| 320 | |
| 321 | /* Use bus module to send data frame */ |
| 322 | ret = drvr->bus_if->brcmf_bus_txdata(drvr->dev, skb); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 323 | |
| 324 | done: |
| 325 | if (ret) |
Franky Lin | 719f273 | 2011-12-16 18:37:06 -0800 | [diff] [blame] | 326 | drvr->bus_if->dstats.tx_dropped++; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 327 | else |
Franky Lin | 719f273 | 2011-12-16 18:37:06 -0800 | [diff] [blame] | 328 | drvr->bus_if->dstats.tx_packets++; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 329 | |
| 330 | /* Return ok: we always eat the packet */ |
| 331 | return 0; |
| 332 | } |
| 333 | |
Hante Meuleman | 90d03ff | 2012-09-11 21:18:46 +0200 | [diff] [blame] | 334 | void brcmf_txflowblock(struct device *dev, bool state) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 335 | { |
| 336 | struct net_device *ndev; |
Franky Lin | 2b45905 | 2011-12-16 18:36:57 -0800 | [diff] [blame] | 337 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
| 338 | struct brcmf_pub *drvr = bus_if->drvr; |
Hante Meuleman | 90d03ff | 2012-09-11 21:18:46 +0200 | [diff] [blame] | 339 | int i; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 340 | |
| 341 | brcmf_dbg(TRACE, "Enter\n"); |
| 342 | |
Hante Meuleman | 90d03ff | 2012-09-11 21:18:46 +0200 | [diff] [blame] | 343 | for (i = 0; i < BRCMF_MAX_IFS; i++) |
| 344 | if (drvr->iflist[i]) { |
| 345 | ndev = drvr->iflist[i]->ndev; |
| 346 | if (state) |
| 347 | netif_stop_queue(ndev); |
| 348 | else |
| 349 | netif_wake_queue(ndev); |
| 350 | } |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 351 | } |
| 352 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 353 | static int brcmf_host_event(struct brcmf_pub *drvr, int *ifidx, |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 354 | void *pktdata, struct brcmf_event_msg *event, |
| 355 | void **data) |
| 356 | { |
| 357 | int bcmerror = 0; |
| 358 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 359 | bcmerror = brcmf_c_host_event(drvr, ifidx, pktdata, event, data); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 360 | if (bcmerror != 0) |
| 361 | return bcmerror; |
| 362 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 363 | if (drvr->iflist[*ifidx]->ndev) |
| 364 | brcmf_cfg80211_event(drvr->iflist[*ifidx]->ndev, |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 365 | event, *data); |
| 366 | |
| 367 | return bcmerror; |
| 368 | } |
| 369 | |
Franky Lin | 228bb43 | 2011-12-16 18:37:00 -0800 | [diff] [blame] | 370 | void brcmf_rx_frame(struct device *dev, int ifidx, |
Arend van Spriel | 0b45bf7 | 2011-11-22 17:21:36 -0800 | [diff] [blame] | 371 | struct sk_buff_head *skb_list) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 372 | { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 373 | unsigned char *eth; |
| 374 | uint len; |
| 375 | void *data; |
Arend van Spriel | 0b45bf7 | 2011-11-22 17:21:36 -0800 | [diff] [blame] | 376 | struct sk_buff *skb, *pnext; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 377 | struct brcmf_if *ifp; |
| 378 | struct brcmf_event_msg event; |
Franky Lin | 228bb43 | 2011-12-16 18:37:00 -0800 | [diff] [blame] | 379 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
| 380 | struct brcmf_pub *drvr = bus_if->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 381 | |
| 382 | brcmf_dbg(TRACE, "Enter\n"); |
| 383 | |
Arend van Spriel | 0b45bf7 | 2011-11-22 17:21:36 -0800 | [diff] [blame] | 384 | skb_queue_walk_safe(skb_list, skb, pnext) { |
| 385 | skb_unlink(skb, skb_list); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 386 | |
| 387 | /* Get the protocol, maintain skb around eth_type_trans() |
| 388 | * The main reason for this hack is for the limitation of |
| 389 | * Linux 2.4 where 'eth_type_trans' uses the |
| 390 | * 'net->hard_header_len' |
| 391 | * to perform skb_pull inside vs ETH_HLEN. Since to avoid |
| 392 | * coping of the packet coming from the network stack to add |
| 393 | * BDC, Hardware header etc, during network interface |
| 394 | * registration |
| 395 | * we set the 'net->hard_header_len' to ETH_HLEN + extra space |
| 396 | * required |
| 397 | * for BDC, Hardware header etc. and not just the ETH_HLEN |
| 398 | */ |
| 399 | eth = skb->data; |
| 400 | len = skb->len; |
| 401 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 402 | ifp = drvr->iflist[ifidx]; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 403 | if (ifp == NULL) |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 404 | ifp = drvr->iflist[0]; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 405 | |
Franky Lin | 0c094c7 | 2011-11-22 17:21:46 -0800 | [diff] [blame] | 406 | if (!ifp || !ifp->ndev || |
| 407 | ifp->ndev->reg_state != NETREG_REGISTERED) { |
| 408 | brcmu_pkt_buf_free_skb(skb); |
| 409 | continue; |
| 410 | } |
| 411 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 412 | skb->dev = ifp->ndev; |
| 413 | skb->protocol = eth_type_trans(skb, skb->dev); |
| 414 | |
| 415 | if (skb->pkt_type == PACKET_MULTICAST) |
Franky Lin | 719f273 | 2011-12-16 18:37:06 -0800 | [diff] [blame] | 416 | bus_if->dstats.multicast++; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 417 | |
| 418 | skb->data = eth; |
| 419 | skb->len = len; |
| 420 | |
| 421 | /* Strip header, count, deliver upward */ |
| 422 | skb_pull(skb, ETH_HLEN); |
| 423 | |
| 424 | /* Process special event packets and then discard them */ |
| 425 | if (ntohs(skb->protocol) == ETH_P_LINK_CTL) |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 426 | brcmf_host_event(drvr, &ifidx, |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 427 | skb_mac_header(skb), |
| 428 | &event, &data); |
| 429 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 430 | if (drvr->iflist[ifidx]) { |
| 431 | ifp = drvr->iflist[ifidx]; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 432 | ifp->ndev->last_rx = jiffies; |
Franky Lin | d1a5b6f | 2011-10-21 16:16:34 +0200 | [diff] [blame] | 433 | } |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 434 | |
Franky Lin | 719f273 | 2011-12-16 18:37:06 -0800 | [diff] [blame] | 435 | bus_if->dstats.rx_bytes += skb->len; |
| 436 | bus_if->dstats.rx_packets++; /* Local count */ |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 437 | |
| 438 | if (in_interrupt()) |
| 439 | netif_rx(skb); |
| 440 | else |
| 441 | /* If the receive is not processed inside an ISR, |
| 442 | * the softirqd must be woken explicitly to service |
| 443 | * the NET_RX_SOFTIRQ. In 2.6 kernels, this is handled |
| 444 | * by netif_rx_ni(), but in earlier kernels, we need |
| 445 | * to do it manually. |
| 446 | */ |
| 447 | netif_rx_ni(skb); |
| 448 | } |
| 449 | } |
| 450 | |
Franky Lin | c995788 | 2011-12-16 18:36:58 -0800 | [diff] [blame] | 451 | void brcmf_txcomplete(struct device *dev, struct sk_buff *txp, bool success) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 452 | { |
| 453 | uint ifidx; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 454 | struct ethhdr *eh; |
| 455 | u16 type; |
Franky Lin | c995788 | 2011-12-16 18:36:58 -0800 | [diff] [blame] | 456 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
| 457 | struct brcmf_pub *drvr = bus_if->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 458 | |
Franky Lin | d5625ee | 2011-12-16 18:37:01 -0800 | [diff] [blame] | 459 | brcmf_proto_hdrpull(dev, &ifidx, txp); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 460 | |
| 461 | eh = (struct ethhdr *)(txp->data); |
| 462 | type = ntohs(eh->h_proto); |
| 463 | |
| 464 | if (type == ETH_P_PAE) |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 465 | atomic_dec(&drvr->pend_8021x_cnt); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 466 | |
| 467 | } |
| 468 | |
| 469 | static struct net_device_stats *brcmf_netdev_get_stats(struct net_device *ndev) |
| 470 | { |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 471 | struct brcmf_if *ifp = netdev_priv(ndev); |
Franky Lin | 719f273 | 2011-12-16 18:37:06 -0800 | [diff] [blame] | 472 | struct brcmf_bus *bus_if = ifp->drvr->bus_if; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 473 | |
| 474 | brcmf_dbg(TRACE, "Enter\n"); |
| 475 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 476 | /* Copy dongle stats to net device stats */ |
Franky Lin | 719f273 | 2011-12-16 18:37:06 -0800 | [diff] [blame] | 477 | ifp->stats.rx_packets = bus_if->dstats.rx_packets; |
| 478 | ifp->stats.tx_packets = bus_if->dstats.tx_packets; |
| 479 | ifp->stats.rx_bytes = bus_if->dstats.rx_bytes; |
| 480 | ifp->stats.tx_bytes = bus_if->dstats.tx_bytes; |
| 481 | ifp->stats.rx_errors = bus_if->dstats.rx_errors; |
| 482 | ifp->stats.tx_errors = bus_if->dstats.tx_errors; |
| 483 | ifp->stats.rx_dropped = bus_if->dstats.rx_dropped; |
| 484 | ifp->stats.tx_dropped = bus_if->dstats.tx_dropped; |
| 485 | ifp->stats.multicast = bus_if->dstats.multicast; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 486 | |
| 487 | return &ifp->stats; |
| 488 | } |
| 489 | |
| 490 | /* Retrieve current toe component enables, which are kept |
| 491 | as a bitmap in toe_ol iovar */ |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 492 | static int brcmf_toe_get(struct brcmf_pub *drvr, int ifidx, u32 *toe_ol) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 493 | { |
| 494 | struct brcmf_dcmd dcmd; |
Arend van Spriel | 1062904 | 2011-10-12 20:51:18 +0200 | [diff] [blame] | 495 | __le32 toe_le; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 496 | char buf[32]; |
| 497 | int ret; |
| 498 | |
| 499 | memset(&dcmd, 0, sizeof(dcmd)); |
| 500 | |
| 501 | dcmd.cmd = BRCMF_C_GET_VAR; |
| 502 | dcmd.buf = buf; |
| 503 | dcmd.len = (uint) sizeof(buf); |
| 504 | dcmd.set = false; |
| 505 | |
| 506 | strcpy(buf, "toe_ol"); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 507 | ret = brcmf_proto_dcmd(drvr, ifidx, &dcmd, dcmd.len); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 508 | if (ret < 0) { |
| 509 | /* Check for older dongle image that doesn't support toe_ol */ |
| 510 | if (ret == -EIO) { |
| 511 | brcmf_dbg(ERROR, "%s: toe not supported by device\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 512 | brcmf_ifname(drvr, ifidx)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 513 | return -EOPNOTSUPP; |
| 514 | } |
| 515 | |
| 516 | brcmf_dbg(INFO, "%s: could not get toe_ol: ret=%d\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 517 | brcmf_ifname(drvr, ifidx), ret); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 518 | return ret; |
| 519 | } |
| 520 | |
Arend van Spriel | 1062904 | 2011-10-12 20:51:18 +0200 | [diff] [blame] | 521 | memcpy(&toe_le, buf, sizeof(u32)); |
| 522 | *toe_ol = le32_to_cpu(toe_le); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 523 | return 0; |
| 524 | } |
| 525 | |
| 526 | /* Set current toe component enables in toe_ol iovar, |
| 527 | and set toe global enable iovar */ |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 528 | static int brcmf_toe_set(struct brcmf_pub *drvr, int ifidx, u32 toe_ol) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 529 | { |
| 530 | struct brcmf_dcmd dcmd; |
| 531 | char buf[32]; |
Arend van Spriel | 1062904 | 2011-10-12 20:51:18 +0200 | [diff] [blame] | 532 | int ret; |
| 533 | __le32 toe_le = cpu_to_le32(toe_ol); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 534 | |
| 535 | memset(&dcmd, 0, sizeof(dcmd)); |
| 536 | |
| 537 | dcmd.cmd = BRCMF_C_SET_VAR; |
| 538 | dcmd.buf = buf; |
| 539 | dcmd.len = (uint) sizeof(buf); |
| 540 | dcmd.set = true; |
| 541 | |
| 542 | /* Set toe_ol as requested */ |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 543 | strcpy(buf, "toe_ol"); |
Arend van Spriel | 1062904 | 2011-10-12 20:51:18 +0200 | [diff] [blame] | 544 | memcpy(&buf[sizeof("toe_ol")], &toe_le, sizeof(u32)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 545 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 546 | ret = brcmf_proto_dcmd(drvr, ifidx, &dcmd, dcmd.len); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 547 | if (ret < 0) { |
| 548 | brcmf_dbg(ERROR, "%s: could not set toe_ol: ret=%d\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 549 | brcmf_ifname(drvr, ifidx), ret); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 550 | return ret; |
| 551 | } |
| 552 | |
| 553 | /* Enable toe globally only if any components are enabled. */ |
Arend van Spriel | 1062904 | 2011-10-12 20:51:18 +0200 | [diff] [blame] | 554 | toe_le = cpu_to_le32(toe_ol != 0); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 555 | |
| 556 | strcpy(buf, "toe"); |
Arend van Spriel | 1062904 | 2011-10-12 20:51:18 +0200 | [diff] [blame] | 557 | memcpy(&buf[sizeof("toe")], &toe_le, sizeof(u32)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 558 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 559 | ret = brcmf_proto_dcmd(drvr, ifidx, &dcmd, dcmd.len); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 560 | if (ret < 0) { |
| 561 | brcmf_dbg(ERROR, "%s: could not set toe: ret=%d\n", |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 562 | brcmf_ifname(drvr, ifidx), ret); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 563 | return ret; |
| 564 | } |
| 565 | |
| 566 | return 0; |
| 567 | } |
| 568 | |
| 569 | static void brcmf_ethtool_get_drvinfo(struct net_device *ndev, |
| 570 | struct ethtool_drvinfo *info) |
| 571 | { |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 572 | struct brcmf_if *ifp = netdev_priv(ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 573 | struct brcmf_pub *drvr = ifp->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 574 | |
| 575 | sprintf(info->driver, KBUILD_MODNAME); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 576 | sprintf(info->version, "%lu", drvr->drv_version); |
| 577 | sprintf(info->bus_info, "%s", dev_name(drvr->dev)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 578 | } |
| 579 | |
Stephen Hemminger | 3eb1fa7 | 2012-01-04 14:52:51 -0800 | [diff] [blame] | 580 | static const struct ethtool_ops brcmf_ethtool_ops = { |
| 581 | .get_drvinfo = brcmf_ethtool_get_drvinfo, |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 582 | }; |
| 583 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 584 | static int brcmf_ethtool(struct brcmf_pub *drvr, void __user *uaddr) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 585 | { |
| 586 | struct ethtool_drvinfo info; |
| 587 | char drvname[sizeof(info.driver)]; |
| 588 | u32 cmd; |
| 589 | struct ethtool_value edata; |
| 590 | u32 toe_cmpnt, csum_dir; |
| 591 | int ret; |
| 592 | |
| 593 | brcmf_dbg(TRACE, "Enter\n"); |
| 594 | |
| 595 | /* all ethtool calls start with a cmd word */ |
| 596 | if (copy_from_user(&cmd, uaddr, sizeof(u32))) |
| 597 | return -EFAULT; |
| 598 | |
| 599 | switch (cmd) { |
| 600 | case ETHTOOL_GDRVINFO: |
| 601 | /* Copy out any request driver name */ |
| 602 | if (copy_from_user(&info, uaddr, sizeof(info))) |
| 603 | return -EFAULT; |
| 604 | strncpy(drvname, info.driver, sizeof(info.driver)); |
| 605 | drvname[sizeof(info.driver) - 1] = '\0'; |
| 606 | |
| 607 | /* clear struct for return */ |
| 608 | memset(&info, 0, sizeof(info)); |
| 609 | info.cmd = cmd; |
| 610 | |
| 611 | /* if requested, identify ourselves */ |
| 612 | if (strcmp(drvname, "?dhd") == 0) { |
| 613 | sprintf(info.driver, "dhd"); |
| 614 | strcpy(info.version, BRCMF_VERSION_STR); |
| 615 | } |
| 616 | |
| 617 | /* otherwise, require dongle to be up */ |
Franky Lin | 3fb1d8d | 2011-12-16 18:37:04 -0800 | [diff] [blame] | 618 | else if (!drvr->bus_if->drvr_up) { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 619 | brcmf_dbg(ERROR, "dongle is not up\n"); |
| 620 | return -ENODEV; |
| 621 | } |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 622 | /* finally, report dongle driver type */ |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 623 | else |
Hante Meuleman | 91917c77 | 2012-10-22 10:36:15 -0700 | [diff] [blame] | 624 | sprintf(info.driver, "wl"); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 625 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 626 | sprintf(info.version, "%lu", drvr->drv_version); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 627 | if (copy_to_user(uaddr, &info, sizeof(info))) |
| 628 | return -EFAULT; |
| 629 | brcmf_dbg(CTL, "given %*s, returning %s\n", |
| 630 | (int)sizeof(drvname), drvname, info.driver); |
| 631 | break; |
| 632 | |
| 633 | /* Get toe offload components from dongle */ |
| 634 | case ETHTOOL_GRXCSUM: |
| 635 | case ETHTOOL_GTXCSUM: |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 636 | ret = brcmf_toe_get(drvr, 0, &toe_cmpnt); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 637 | if (ret < 0) |
| 638 | return ret; |
| 639 | |
| 640 | csum_dir = |
| 641 | (cmd == ETHTOOL_GTXCSUM) ? TOE_TX_CSUM_OL : TOE_RX_CSUM_OL; |
| 642 | |
| 643 | edata.cmd = cmd; |
| 644 | edata.data = (toe_cmpnt & csum_dir) ? 1 : 0; |
| 645 | |
| 646 | if (copy_to_user(uaddr, &edata, sizeof(edata))) |
| 647 | return -EFAULT; |
| 648 | break; |
| 649 | |
| 650 | /* Set toe offload components in dongle */ |
| 651 | case ETHTOOL_SRXCSUM: |
| 652 | case ETHTOOL_STXCSUM: |
| 653 | if (copy_from_user(&edata, uaddr, sizeof(edata))) |
| 654 | return -EFAULT; |
| 655 | |
| 656 | /* Read the current settings, update and write back */ |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 657 | ret = brcmf_toe_get(drvr, 0, &toe_cmpnt); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 658 | if (ret < 0) |
| 659 | return ret; |
| 660 | |
| 661 | csum_dir = |
| 662 | (cmd == ETHTOOL_STXCSUM) ? TOE_TX_CSUM_OL : TOE_RX_CSUM_OL; |
| 663 | |
| 664 | if (edata.data != 0) |
| 665 | toe_cmpnt |= csum_dir; |
| 666 | else |
| 667 | toe_cmpnt &= ~csum_dir; |
| 668 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 669 | ret = brcmf_toe_set(drvr, 0, toe_cmpnt); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 670 | if (ret < 0) |
| 671 | return ret; |
| 672 | |
| 673 | /* If setting TX checksum mode, tell Linux the new mode */ |
| 674 | if (cmd == ETHTOOL_STXCSUM) { |
| 675 | if (edata.data) |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 676 | drvr->iflist[0]->ndev->features |= |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 677 | NETIF_F_IP_CSUM; |
| 678 | else |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 679 | drvr->iflist[0]->ndev->features &= |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 680 | ~NETIF_F_IP_CSUM; |
| 681 | } |
| 682 | |
| 683 | break; |
| 684 | |
| 685 | default: |
| 686 | return -EOPNOTSUPP; |
| 687 | } |
| 688 | |
| 689 | return 0; |
| 690 | } |
| 691 | |
| 692 | static int brcmf_netdev_ioctl_entry(struct net_device *ndev, struct ifreq *ifr, |
| 693 | int cmd) |
| 694 | { |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 695 | struct brcmf_if *ifp = netdev_priv(ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 696 | struct brcmf_pub *drvr = ifp->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 697 | |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 698 | brcmf_dbg(TRACE, "ifidx %d, cmd 0x%04x\n", ifp->idx, cmd); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 699 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 700 | if (!drvr->iflist[ifp->idx]) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 701 | return -1; |
| 702 | |
| 703 | if (cmd == SIOCETHTOOL) |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 704 | return brcmf_ethtool(drvr, ifr->ifr_data); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 705 | |
| 706 | return -EOPNOTSUPP; |
| 707 | } |
| 708 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 709 | static int brcmf_netdev_stop(struct net_device *ndev) |
| 710 | { |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 711 | struct brcmf_if *ifp = netdev_priv(ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 712 | struct brcmf_pub *drvr = ifp->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 713 | |
| 714 | brcmf_dbg(TRACE, "Enter\n"); |
| 715 | brcmf_cfg80211_down(drvr->config); |
Franky Lin | 3fb1d8d | 2011-12-16 18:37:04 -0800 | [diff] [blame] | 716 | if (drvr->bus_if->drvr_up == 0) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 717 | return 0; |
| 718 | |
| 719 | /* Set state and stop OS transmissions */ |
John W. Linville | 57adc1f | 2012-01-03 15:16:34 -0500 | [diff] [blame] | 720 | drvr->bus_if->drvr_up = false; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 721 | netif_stop_queue(ndev); |
| 722 | |
| 723 | return 0; |
| 724 | } |
| 725 | |
| 726 | static int brcmf_netdev_open(struct net_device *ndev) |
| 727 | { |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 728 | struct brcmf_if *ifp = netdev_priv(ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 729 | struct brcmf_pub *drvr = ifp->drvr; |
Arend van Spriel | 1bb1f38 | 2012-02-09 21:09:05 +0100 | [diff] [blame] | 730 | struct brcmf_bus *bus_if = drvr->bus_if; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 731 | u32 toe_ol; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 732 | s32 ret = 0; |
Franky Lin | 3338084 | 2012-04-11 11:52:47 +0200 | [diff] [blame] | 733 | uint up = 0; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 734 | |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 735 | brcmf_dbg(TRACE, "ifidx %d\n", ifp->idx); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 736 | |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 737 | if (ifp->idx == 0) { /* do it only for primary eth0 */ |
Arend van Spriel | 1bb1f38 | 2012-02-09 21:09:05 +0100 | [diff] [blame] | 738 | /* If bus is not ready, can't continue */ |
| 739 | if (bus_if->state != BRCMF_BUS_DATA) { |
| 740 | brcmf_dbg(ERROR, "failed bus is not ready\n"); |
| 741 | return -EAGAIN; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 742 | } |
Arend van Spriel | 1bb1f38 | 2012-02-09 21:09:05 +0100 | [diff] [blame] | 743 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 744 | atomic_set(&drvr->pend_8021x_cnt, 0); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 745 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 746 | memcpy(ndev->dev_addr, drvr->mac, ETH_ALEN); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 747 | |
| 748 | /* Get current TOE mode from dongle */ |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 749 | if (brcmf_toe_get(drvr, ifp->idx, &toe_ol) >= 0 |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 750 | && (toe_ol & TOE_TX_CSUM_OL) != 0) |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 751 | drvr->iflist[ifp->idx]->ndev->features |= |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 752 | NETIF_F_IP_CSUM; |
| 753 | else |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 754 | drvr->iflist[ifp->idx]->ndev->features &= |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 755 | ~NETIF_F_IP_CSUM; |
| 756 | } |
Franky Lin | 3338084 | 2012-04-11 11:52:47 +0200 | [diff] [blame] | 757 | |
| 758 | /* make sure RF is ready for work */ |
| 759 | brcmf_proto_cdc_set_dcmd(drvr, 0, BRCMF_C_UP, (char *)&up, sizeof(up)); |
| 760 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 761 | /* Allow transmit calls */ |
| 762 | netif_start_queue(ndev); |
John W. Linville | 57adc1f | 2012-01-03 15:16:34 -0500 | [diff] [blame] | 763 | drvr->bus_if->drvr_up = true; |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 764 | if (brcmf_cfg80211_up(drvr->config)) { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 765 | brcmf_dbg(ERROR, "failed to bring up cfg80211\n"); |
| 766 | return -1; |
| 767 | } |
| 768 | |
| 769 | return ret; |
| 770 | } |
| 771 | |
Franky Lin | dfded55 | 2011-10-21 16:16:20 +0200 | [diff] [blame] | 772 | static const struct net_device_ops brcmf_netdev_ops_pri = { |
| 773 | .ndo_open = brcmf_netdev_open, |
| 774 | .ndo_stop = brcmf_netdev_stop, |
| 775 | .ndo_get_stats = brcmf_netdev_get_stats, |
| 776 | .ndo_do_ioctl = brcmf_netdev_ioctl_entry, |
| 777 | .ndo_start_xmit = brcmf_netdev_start_xmit, |
| 778 | .ndo_set_mac_address = brcmf_netdev_set_mac_address, |
| 779 | .ndo_set_rx_mode = brcmf_netdev_set_multicast_list |
| 780 | }; |
| 781 | |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 782 | int brcmf_net_attach(struct brcmf_if *ifp) |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 783 | { |
Arend van Spriel | 3625c14 | 2012-04-11 11:52:44 +0200 | [diff] [blame] | 784 | struct brcmf_pub *drvr = ifp->drvr; |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 785 | struct net_device *ndev; |
Arend van Spriel | 3625c14 | 2012-04-11 11:52:44 +0200 | [diff] [blame] | 786 | u8 temp_addr[ETH_ALEN]; |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 787 | |
Arend van Spriel | 3625c14 | 2012-04-11 11:52:44 +0200 | [diff] [blame] | 788 | brcmf_dbg(TRACE, "ifidx %d\n", ifp->idx); |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 789 | |
Arend van Spriel | 3625c14 | 2012-04-11 11:52:44 +0200 | [diff] [blame] | 790 | ndev = drvr->iflist[ifp->idx]->ndev; |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 791 | ndev->netdev_ops = &brcmf_netdev_ops_pri; |
| 792 | |
| 793 | /* |
Arend van Spriel | 3625c14 | 2012-04-11 11:52:44 +0200 | [diff] [blame] | 794 | * determine mac address to use |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 795 | */ |
Arend van Spriel | 3625c14 | 2012-04-11 11:52:44 +0200 | [diff] [blame] | 796 | if (is_valid_ether_addr(ifp->mac_addr)) |
| 797 | memcpy(temp_addr, ifp->mac_addr, ETH_ALEN); |
| 798 | else |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 799 | memcpy(temp_addr, drvr->mac, ETH_ALEN); |
| 800 | |
Arend van Spriel | 3625c14 | 2012-04-11 11:52:44 +0200 | [diff] [blame] | 801 | if (ifp->idx == 1) { |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 802 | brcmf_dbg(TRACE, "ACCESS POINT MAC:\n"); |
| 803 | /* ACCESSPOINT INTERFACE CASE */ |
| 804 | temp_addr[0] |= 0X02; /* set bit 2 , |
| 805 | - Locally Administered address */ |
| 806 | |
| 807 | } |
| 808 | ndev->hard_header_len = ETH_HLEN + drvr->hdrlen; |
| 809 | ndev->ethtool_ops = &brcmf_ethtool_ops; |
| 810 | |
| 811 | drvr->rxsz = ndev->mtu + ndev->hard_header_len + |
| 812 | drvr->hdrlen; |
| 813 | |
| 814 | memcpy(ndev->dev_addr, temp_addr, ETH_ALEN); |
| 815 | |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 816 | if (register_netdev(ndev) != 0) { |
| 817 | brcmf_dbg(ERROR, "couldn't register the net device\n"); |
| 818 | goto fail; |
| 819 | } |
| 820 | |
| 821 | brcmf_dbg(INFO, "%s: Broadcom Dongle Host Driver\n", ndev->name); |
| 822 | |
| 823 | return 0; |
| 824 | |
| 825 | fail: |
| 826 | ndev->netdev_ops = NULL; |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 827 | free_netdev(ndev); |
Arend van Spriel | 75c4990 | 2012-04-11 11:52:43 +0200 | [diff] [blame] | 828 | return -EBADE; |
| 829 | } |
| 830 | |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 831 | struct brcmf_if *brcmf_add_if(struct device *dev, int ifidx, s32 bssidx, |
| 832 | char *name, u8 *mac_addr) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 833 | { |
| 834 | struct brcmf_if *ifp; |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 835 | struct net_device *ndev; |
Franky Lin | 55a63bc | 2011-12-16 18:36:54 -0800 | [diff] [blame] | 836 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
| 837 | struct brcmf_pub *drvr = bus_if->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 838 | |
Franky Lin | 15d45b6 | 2011-10-21 16:16:32 +0200 | [diff] [blame] | 839 | brcmf_dbg(TRACE, "idx %d\n", ifidx); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 840 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 841 | ifp = drvr->iflist[ifidx]; |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 842 | /* |
| 843 | * Delete the existing interface before overwriting it |
| 844 | * in case we missed the BRCMF_E_IF_DEL event. |
| 845 | */ |
| 846 | if (ifp) { |
| 847 | brcmf_dbg(ERROR, "ERROR: netdev:%s already exists, try free & unregister\n", |
| 848 | ifp->ndev->name); |
| 849 | netif_stop_queue(ifp->ndev); |
| 850 | unregister_netdev(ifp->ndev); |
| 851 | free_netdev(ifp->ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 852 | drvr->iflist[ifidx] = NULL; |
Franky Lin | 15d45b6 | 2011-10-21 16:16:32 +0200 | [diff] [blame] | 853 | } |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 854 | |
| 855 | /* Allocate netdev, including space for private structure */ |
| 856 | ndev = alloc_netdev(sizeof(struct brcmf_if), name, ether_setup); |
| 857 | if (!ndev) { |
| 858 | brcmf_dbg(ERROR, "OOM - alloc_netdev\n"); |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 859 | return ERR_PTR(-ENOMEM); |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 860 | } |
| 861 | |
| 862 | ifp = netdev_priv(ndev); |
| 863 | ifp->ndev = ndev; |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 864 | ifp->drvr = drvr; |
| 865 | drvr->iflist[ifidx] = ifp; |
Franky Lin | 15d45b6 | 2011-10-21 16:16:32 +0200 | [diff] [blame] | 866 | ifp->idx = ifidx; |
Arend van Spriel | 1d4fd8d | 2012-10-22 10:36:19 -0700 | [diff] [blame] | 867 | ifp->bssidx = bssidx; |
Franky Lin | 15d45b6 | 2011-10-21 16:16:32 +0200 | [diff] [blame] | 868 | if (mac_addr != NULL) |
| 869 | memcpy(&ifp->mac_addr, mac_addr, ETH_ALEN); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 870 | |
Franky Lin | 15d45b6 | 2011-10-21 16:16:32 +0200 | [diff] [blame] | 871 | brcmf_dbg(TRACE, " ==== pid:%x, net_device for if:%s created ===\n", |
| 872 | current->pid, ifp->ndev->name); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 873 | |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 874 | return ifp; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 875 | } |
| 876 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 877 | void brcmf_del_if(struct brcmf_pub *drvr, int ifidx) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 878 | { |
| 879 | struct brcmf_if *ifp; |
| 880 | |
| 881 | brcmf_dbg(TRACE, "idx %d\n", ifidx); |
| 882 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 883 | ifp = drvr->iflist[ifidx]; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 884 | if (!ifp) { |
| 885 | brcmf_dbg(ERROR, "Null interface\n"); |
| 886 | return; |
| 887 | } |
Franky Lin | dfded55 | 2011-10-21 16:16:20 +0200 | [diff] [blame] | 888 | if (ifp->ndev) { |
| 889 | if (ifidx == 0) { |
| 890 | if (ifp->ndev->netdev_ops == &brcmf_netdev_ops_pri) { |
| 891 | rtnl_lock(); |
| 892 | brcmf_netdev_stop(ifp->ndev); |
| 893 | rtnl_unlock(); |
| 894 | } |
| 895 | } else { |
| 896 | netif_stop_queue(ifp->ndev); |
| 897 | } |
| 898 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 899 | unregister_netdev(ifp->ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 900 | drvr->iflist[ifidx] = NULL; |
Franky Lin | dfded55 | 2011-10-21 16:16:20 +0200 | [diff] [blame] | 901 | if (ifidx == 0) |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 902 | brcmf_cfg80211_detach(drvr->config); |
Franky Lin | dfded55 | 2011-10-21 16:16:20 +0200 | [diff] [blame] | 903 | free_netdev(ifp->ndev); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 904 | } |
| 905 | } |
| 906 | |
Franky Lin | 2447ffb | 2011-12-16 18:37:10 -0800 | [diff] [blame] | 907 | int brcmf_attach(uint bus_hdrlen, struct device *dev) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 908 | { |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 909 | struct brcmf_pub *drvr = NULL; |
Franky Lin | 712ac5b | 2011-12-16 18:37:09 -0800 | [diff] [blame] | 910 | int ret = 0; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 911 | |
| 912 | brcmf_dbg(TRACE, "Enter\n"); |
| 913 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 914 | /* Allocate primary brcmf_info */ |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 915 | drvr = kzalloc(sizeof(struct brcmf_pub), GFP_ATOMIC); |
| 916 | if (!drvr) |
Franky Lin | 712ac5b | 2011-12-16 18:37:09 -0800 | [diff] [blame] | 917 | return -ENOMEM; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 918 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 919 | mutex_init(&drvr->proto_block); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 920 | |
| 921 | /* Link to bus module */ |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 922 | drvr->hdrlen = bus_hdrlen; |
| 923 | drvr->bus_if = dev_get_drvdata(dev); |
Franky Lin | 55a63bc | 2011-12-16 18:36:54 -0800 | [diff] [blame] | 924 | drvr->bus_if->drvr = drvr; |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 925 | drvr->dev = dev; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 926 | |
Arend van Spriel | d319a7c | 2012-06-09 22:51:43 +0200 | [diff] [blame] | 927 | /* create device debugfs folder */ |
| 928 | brcmf_debugfs_attach(drvr); |
| 929 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 930 | /* Attach and link in the protocol */ |
Franky Lin | 712ac5b | 2011-12-16 18:37:09 -0800 | [diff] [blame] | 931 | ret = brcmf_proto_attach(drvr); |
| 932 | if (ret != 0) { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 933 | brcmf_dbg(ERROR, "brcmf_prot_attach failed\n"); |
| 934 | goto fail; |
| 935 | } |
| 936 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 937 | INIT_WORK(&drvr->setmacaddr_work, _brcmf_set_mac_address); |
| 938 | INIT_WORK(&drvr->multicast_work, _brcmf_set_multicast_list); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 939 | |
Franky Lin | 135e4c6 | 2012-06-26 21:26:34 +0200 | [diff] [blame] | 940 | INIT_LIST_HEAD(&drvr->bus_if->dcmd_list); |
| 941 | |
Franky Lin | 712ac5b | 2011-12-16 18:37:09 -0800 | [diff] [blame] | 942 | return ret; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 943 | |
| 944 | fail: |
Franky Lin | 712ac5b | 2011-12-16 18:37:09 -0800 | [diff] [blame] | 945 | brcmf_detach(dev); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 946 | |
Franky Lin | 712ac5b | 2011-12-16 18:37:09 -0800 | [diff] [blame] | 947 | return ret; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 948 | } |
| 949 | |
Franky Lin | ed683c9 | 2011-12-16 18:36:55 -0800 | [diff] [blame] | 950 | int brcmf_bus_start(struct device *dev) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 951 | { |
| 952 | int ret = -1; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 953 | /* Room for "event_msgs" + '\0' + bitvec */ |
| 954 | char iovbuf[BRCMF_EVENTING_MASK_LEN + 12]; |
Franky Lin | ed683c9 | 2011-12-16 18:36:55 -0800 | [diff] [blame] | 955 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
| 956 | struct brcmf_pub *drvr = bus_if->drvr; |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 957 | struct brcmf_if *ifp; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 958 | |
| 959 | brcmf_dbg(TRACE, "\n"); |
| 960 | |
| 961 | /* Bring up the bus */ |
Franky Lin | 99a0b8f | 2011-12-16 18:37:14 -0800 | [diff] [blame] | 962 | ret = bus_if->brcmf_bus_init(dev); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 963 | if (ret != 0) { |
| 964 | brcmf_dbg(ERROR, "brcmf_sdbrcm_bus_init failed %d\n", ret); |
| 965 | return ret; |
| 966 | } |
| 967 | |
Alwin Beukers | 53a2277 | 2011-10-12 20:51:30 +0200 | [diff] [blame] | 968 | brcmf_c_mkiovar("event_msgs", drvr->eventmask, BRCMF_EVENTING_MASK_LEN, |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 969 | iovbuf, sizeof(iovbuf)); |
| 970 | brcmf_proto_cdc_query_dcmd(drvr, 0, BRCMF_C_GET_VAR, iovbuf, |
| 971 | sizeof(iovbuf)); |
| 972 | memcpy(drvr->eventmask, iovbuf, BRCMF_EVENTING_MASK_LEN); |
| 973 | |
| 974 | setbit(drvr->eventmask, BRCMF_E_SET_SSID); |
| 975 | setbit(drvr->eventmask, BRCMF_E_PRUNE); |
| 976 | setbit(drvr->eventmask, BRCMF_E_AUTH); |
| 977 | setbit(drvr->eventmask, BRCMF_E_REASSOC); |
| 978 | setbit(drvr->eventmask, BRCMF_E_REASSOC_IND); |
| 979 | setbit(drvr->eventmask, BRCMF_E_DEAUTH_IND); |
| 980 | setbit(drvr->eventmask, BRCMF_E_DISASSOC_IND); |
| 981 | setbit(drvr->eventmask, BRCMF_E_DISASSOC); |
| 982 | setbit(drvr->eventmask, BRCMF_E_JOIN); |
| 983 | setbit(drvr->eventmask, BRCMF_E_ASSOC_IND); |
| 984 | setbit(drvr->eventmask, BRCMF_E_PSK_SUP); |
| 985 | setbit(drvr->eventmask, BRCMF_E_LINK); |
| 986 | setbit(drvr->eventmask, BRCMF_E_NDIS_LINK); |
| 987 | setbit(drvr->eventmask, BRCMF_E_MIC_ERROR); |
| 988 | setbit(drvr->eventmask, BRCMF_E_PMKID_CACHE); |
| 989 | setbit(drvr->eventmask, BRCMF_E_TXFAIL); |
| 990 | setbit(drvr->eventmask, BRCMF_E_JOIN_START); |
| 991 | setbit(drvr->eventmask, BRCMF_E_SCAN_COMPLETE); |
Arend van Spriel | 1d4fd8d | 2012-10-22 10:36:19 -0700 | [diff] [blame] | 992 | setbit(drvr->eventmask, BRCMF_E_IF); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 993 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 994 | /* Setup filter to allow only unicast */ |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 995 | drvr->pktfilter_count = 1; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 996 | drvr->pktfilter[0] = "100 0 0 0 0x01 0x00"; |
| 997 | |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 998 | /* add primary networking interface */ |
| 999 | ifp = brcmf_add_if(dev, 0, 0, "wlan%d", drvr->mac); |
| 1000 | if (IS_ERR(ifp)) |
| 1001 | return PTR_ERR(ifp); |
| 1002 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1003 | /* Bus is ready, do any protocol initialization */ |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 1004 | ret = brcmf_proto_init(drvr); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1005 | if (ret < 0) |
| 1006 | return ret; |
| 1007 | |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 1008 | drvr->config = brcmf_cfg80211_attach(drvr); |
| 1009 | if (drvr->config == NULL) |
| 1010 | return -ENOMEM; |
| 1011 | |
| 1012 | ret = brcmf_net_attach(ifp); |
| 1013 | if (ret < 0) { |
| 1014 | brcmf_dbg(ERROR, "brcmf_net_attach failed"); |
| 1015 | drvr->iflist[0] = NULL; |
Arend van Spriel | 474a64c | 2012-04-11 11:52:45 +0200 | [diff] [blame] | 1016 | return ret; |
Arend van Spriel | 1ed9baf | 2012-10-22 10:36:20 -0700 | [diff] [blame^] | 1017 | } |
| 1018 | |
Arend van Spriel | 474a64c | 2012-04-11 11:52:45 +0200 | [diff] [blame] | 1019 | |
Arend van Spriel | 1bb1f38 | 2012-02-09 21:09:05 +0100 | [diff] [blame] | 1020 | /* signal bus ready */ |
| 1021 | bus_if->state = BRCMF_BUS_DATA; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1022 | return 0; |
| 1023 | } |
| 1024 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1025 | static void brcmf_bus_detach(struct brcmf_pub *drvr) |
| 1026 | { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1027 | brcmf_dbg(TRACE, "Enter\n"); |
| 1028 | |
| 1029 | if (drvr) { |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 1030 | /* Stop the protocol module */ |
| 1031 | brcmf_proto_stop(drvr); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1032 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 1033 | /* Stop the bus module */ |
Franky Lin | a9ffda8 | 2011-12-16 18:37:12 -0800 | [diff] [blame] | 1034 | drvr->bus_if->brcmf_bus_stop(drvr->dev); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1035 | } |
| 1036 | } |
| 1037 | |
Franky Lin | 5f947ad | 2011-12-16 18:36:56 -0800 | [diff] [blame] | 1038 | void brcmf_detach(struct device *dev) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1039 | { |
Franky Lin | 5f947ad | 2011-12-16 18:36:56 -0800 | [diff] [blame] | 1040 | int i; |
| 1041 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
| 1042 | struct brcmf_pub *drvr = bus_if->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1043 | |
| 1044 | brcmf_dbg(TRACE, "Enter\n"); |
| 1045 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1046 | |
Franky Lin | 5f947ad | 2011-12-16 18:36:56 -0800 | [diff] [blame] | 1047 | /* make sure primary interface removed last */ |
| 1048 | for (i = BRCMF_MAX_IFS-1; i > -1; i--) |
| 1049 | if (drvr->iflist[i]) |
| 1050 | brcmf_del_if(drvr, i); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1051 | |
Franky Lin | 5f947ad | 2011-12-16 18:36:56 -0800 | [diff] [blame] | 1052 | brcmf_bus_detach(drvr); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1053 | |
Franky Lin | 89fdb46 | 2012-02-09 21:09:01 +0100 | [diff] [blame] | 1054 | if (drvr->prot) { |
| 1055 | cancel_work_sync(&drvr->setmacaddr_work); |
| 1056 | cancel_work_sync(&drvr->multicast_work); |
Franky Lin | 5f947ad | 2011-12-16 18:36:56 -0800 | [diff] [blame] | 1057 | brcmf_proto_detach(drvr); |
Franky Lin | 89fdb46 | 2012-02-09 21:09:01 +0100 | [diff] [blame] | 1058 | } |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1059 | |
Arend van Spriel | d319a7c | 2012-06-09 22:51:43 +0200 | [diff] [blame] | 1060 | brcmf_debugfs_detach(drvr); |
Franky Lin | 5f947ad | 2011-12-16 18:36:56 -0800 | [diff] [blame] | 1061 | bus_if->drvr = NULL; |
| 1062 | kfree(drvr); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1063 | } |
| 1064 | |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 1065 | static int brcmf_get_pend_8021x_cnt(struct brcmf_pub *drvr) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1066 | { |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 1067 | return atomic_read(&drvr->pend_8021x_cnt); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1068 | } |
| 1069 | |
| 1070 | #define MAX_WAIT_FOR_8021X_TX 10 |
| 1071 | |
| 1072 | int brcmf_netdev_wait_pend8021x(struct net_device *ndev) |
| 1073 | { |
Franky Lin | e1b8358 | 2011-10-21 16:16:33 +0200 | [diff] [blame] | 1074 | struct brcmf_if *ifp = netdev_priv(ndev); |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 1075 | struct brcmf_pub *drvr = ifp->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1076 | int timeout = 10 * HZ / 1000; |
| 1077 | int ntimes = MAX_WAIT_FOR_8021X_TX; |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 1078 | int pend = brcmf_get_pend_8021x_cnt(drvr); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1079 | |
| 1080 | while (ntimes && pend) { |
| 1081 | if (pend) { |
| 1082 | set_current_state(TASK_INTERRUPTIBLE); |
| 1083 | schedule_timeout(timeout); |
| 1084 | set_current_state(TASK_RUNNING); |
| 1085 | ntimes--; |
| 1086 | } |
Franky Lin | d08b6a3 | 2011-12-16 18:36:51 -0800 | [diff] [blame] | 1087 | pend = brcmf_get_pend_8021x_cnt(drvr); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 1088 | } |
| 1089 | return pend; |
| 1090 | } |
| 1091 | |
Arend van Spriel | e64a4b7 | 2012-03-02 22:55:49 +0100 | [diff] [blame] | 1092 | static void brcmf_driver_init(struct work_struct *work) |
Arend van Spriel | f3d7cdc | 2012-02-09 21:09:03 +0100 | [diff] [blame] | 1093 | { |
Arend van Spriel | d319a7c | 2012-06-09 22:51:43 +0200 | [diff] [blame] | 1094 | brcmf_debugfs_init(); |
| 1095 | |
Arend van Spriel | f3d7cdc | 2012-02-09 21:09:03 +0100 | [diff] [blame] | 1096 | #ifdef CONFIG_BRCMFMAC_SDIO |
Arend van Spriel | 549040a | 2012-03-02 22:55:48 +0100 | [diff] [blame] | 1097 | brcmf_sdio_init(); |
Arend van Spriel | f3d7cdc | 2012-02-09 21:09:03 +0100 | [diff] [blame] | 1098 | #endif |
Arend van Spriel | 71bb244 | 2012-02-09 21:09:08 +0100 | [diff] [blame] | 1099 | #ifdef CONFIG_BRCMFMAC_USB |
Arend van Spriel | 549040a | 2012-03-02 22:55:48 +0100 | [diff] [blame] | 1100 | brcmf_usb_init(); |
Arend van Spriel | 71bb244 | 2012-02-09 21:09:08 +0100 | [diff] [blame] | 1101 | #endif |
Arend van Spriel | e64a4b7 | 2012-03-02 22:55:49 +0100 | [diff] [blame] | 1102 | } |
| 1103 | static DECLARE_WORK(brcmf_driver_work, brcmf_driver_init); |
| 1104 | |
| 1105 | static int __init brcmfmac_module_init(void) |
| 1106 | { |
| 1107 | if (!schedule_work(&brcmf_driver_work)) |
| 1108 | return -EBUSY; |
| 1109 | |
Arend van Spriel | 549040a | 2012-03-02 22:55:48 +0100 | [diff] [blame] | 1110 | return 0; |
Arend van Spriel | f3d7cdc | 2012-02-09 21:09:03 +0100 | [diff] [blame] | 1111 | } |
| 1112 | |
Arend van Spriel | e64a4b7 | 2012-03-02 22:55:49 +0100 | [diff] [blame] | 1113 | static void __exit brcmfmac_module_exit(void) |
Arend van Spriel | f3d7cdc | 2012-02-09 21:09:03 +0100 | [diff] [blame] | 1114 | { |
Arend van Spriel | e64a4b7 | 2012-03-02 22:55:49 +0100 | [diff] [blame] | 1115 | cancel_work_sync(&brcmf_driver_work); |
| 1116 | |
Arend van Spriel | f3d7cdc | 2012-02-09 21:09:03 +0100 | [diff] [blame] | 1117 | #ifdef CONFIG_BRCMFMAC_SDIO |
| 1118 | brcmf_sdio_exit(); |
| 1119 | #endif |
Arend van Spriel | 71bb244 | 2012-02-09 21:09:08 +0100 | [diff] [blame] | 1120 | #ifdef CONFIG_BRCMFMAC_USB |
| 1121 | brcmf_usb_exit(); |
| 1122 | #endif |
Arend van Spriel | d319a7c | 2012-06-09 22:51:43 +0200 | [diff] [blame] | 1123 | brcmf_debugfs_exit(); |
Arend van Spriel | f3d7cdc | 2012-02-09 21:09:03 +0100 | [diff] [blame] | 1124 | } |
| 1125 | |
Arend van Spriel | e64a4b7 | 2012-03-02 22:55:49 +0100 | [diff] [blame] | 1126 | module_init(brcmfmac_module_init); |
| 1127 | module_exit(brcmfmac_module_exit); |