]> git.proxmox.com Git - mirror_ubuntu-jammy-kernel.git/blame - drivers/net/wireless/brcm80211/brcmfmac/dhd_linux.c
brcmfmac: add peer-to-peer group discovery support
[mirror_ubuntu-jammy-kernel.git] / drivers / net / wireless / brcm80211 / brcmfmac / dhd_linux.c
CommitLineData
5b435de0
AS
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
5b435de0 17#include <linux/kernel.h>
5b435de0 18#include <linux/etherdevice.h>
b7a57e76 19#include <linux/module.h>
5b435de0
AS
20#include <net/cfg80211.h>
21#include <net/rtnetlink.h>
5b435de0
AS
22#include <brcmu_utils.h>
23#include <brcmu_wifi.h>
24
25#include "dhd.h"
26#include "dhd_bus.h"
27#include "dhd_proto.h"
28#include "dhd_dbg.h"
9f440b7b 29#include "p2p.h"
5b435de0 30#include "wl_cfg80211.h"
db22ae8c 31#include "fwil.h"
5b435de0
AS
32
33MODULE_AUTHOR("Broadcom Corporation");
b87e2c48
HM
34MODULE_DESCRIPTION("Broadcom 802.11 wireless LAN fullmac driver.");
35MODULE_SUPPORTED_DEVICE("Broadcom 802.11 WLAN fullmac cards");
5b435de0
AS
36MODULE_LICENSE("Dual BSD/GPL");
37
21fff75d 38#define MAX_WAIT_FOR_8021X_TX 50 /* msecs */
5b435de0 39
5b435de0 40/* Error bits */
5e8149f5 41int brcmf_msg_level;
5b435de0
AS
42module_param(brcmf_msg_level, int, 0);
43
5b435de0
AS
44
45char *brcmf_ifname(struct brcmf_pub *drvr, int ifidx)
46{
5b435de0 47 if (ifidx < 0 || ifidx >= BRCMF_MAX_IFS) {
5e8149f5 48 brcmf_err("ifidx %d out of range\n", ifidx);
5b435de0
AS
49 return "<if_bad>";
50 }
51
d08b6a37 52 if (drvr->iflist[ifidx] == NULL) {
5e8149f5 53 brcmf_err("null i/f %d\n", ifidx);
5b435de0
AS
54 return "<if_null>";
55 }
56
d08b6a37
FL
57 if (drvr->iflist[ifidx]->ndev)
58 return drvr->iflist[ifidx]->ndev->name;
5b435de0
AS
59
60 return "<if_none>";
61}
62
63static void _brcmf_set_multicast_list(struct work_struct *work)
64{
db22ae8c 65 struct brcmf_if *ifp;
5b435de0
AS
66 struct net_device *ndev;
67 struct netdev_hw_addr *ha;
db22ae8c 68 u32 cmd_value, cnt;
5b435de0 69 __le32 cnt_le;
5b435de0 70 char *buf, *bufp;
db22ae8c
HM
71 u32 buflen;
72 s32 err;
5b435de0 73
bdf5ff51 74 ifp = container_of(work, struct brcmf_if, multicast_work);
94889b1f 75
2880b868 76 brcmf_dbg(TRACE, "Enter, idx=%d\n", ifp->bssidx);
94889b1f 77
db22ae8c 78 ndev = ifp->ndev;
5b435de0
AS
79
80 /* Determine initial value of allmulti flag */
db22ae8c 81 cmd_value = (ndev->flags & IFF_ALLMULTI) ? true : false;
5b435de0
AS
82
83 /* Send down the multicast list first. */
db22ae8c
HM
84 cnt = netdev_mc_count(ndev);
85 buflen = sizeof(cnt) + (cnt * ETH_ALEN);
86 buf = kmalloc(buflen, GFP_ATOMIC);
87 if (!buf)
5b435de0 88 return;
db22ae8c 89 bufp = buf;
5b435de0
AS
90
91 cnt_le = cpu_to_le32(cnt);
db22ae8c 92 memcpy(bufp, &cnt_le, sizeof(cnt_le));
5b435de0
AS
93 bufp += sizeof(cnt_le);
94
95 netdev_for_each_mc_addr(ha, ndev) {
96 if (!cnt)
97 break;
98 memcpy(bufp, ha->addr, ETH_ALEN);
99 bufp += ETH_ALEN;
100 cnt--;
101 }
102
db22ae8c
HM
103 err = brcmf_fil_iovar_data_set(ifp, "mcast_list", buf, buflen);
104 if (err < 0) {
5e8149f5 105 brcmf_err("Setting mcast_list failed, %d\n", err);
db22ae8c 106 cmd_value = cnt ? true : cmd_value;
5b435de0
AS
107 }
108
109 kfree(buf);
110
db22ae8c
HM
111 /*
112 * Now send the allmulti setting. This is based on the setting in the
5b435de0
AS
113 * net_device flags, but might be modified above to be turned on if we
114 * were trying to set some addresses and dongle rejected it...
115 */
db22ae8c
HM
116 err = brcmf_fil_iovar_int_set(ifp, "allmulti", cmd_value);
117 if (err < 0)
5e8149f5 118 brcmf_err("Setting allmulti failed, %d\n", err);
db22ae8c
HM
119
120 /*Finally, pick up the PROMISC flag */
121 cmd_value = (ndev->flags & IFF_PROMISC) ? true : false;
122 err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_PROMISC, cmd_value);
123 if (err < 0)
5e8149f5 124 brcmf_err("Setting BRCMF_C_SET_PROMISC failed, %d\n",
db22ae8c 125 err);
5b435de0
AS
126}
127
128static void
129_brcmf_set_mac_address(struct work_struct *work)
130{
db22ae8c 131 struct brcmf_if *ifp;
db22ae8c 132 s32 err;
5b435de0 133
bdf5ff51 134 ifp = container_of(work, struct brcmf_if, setmacaddr_work);
94889b1f 135
2880b868 136 brcmf_dbg(TRACE, "Enter, idx=%d\n", ifp->bssidx);
94889b1f 137
bdf5ff51 138 err = brcmf_fil_iovar_data_set(ifp, "cur_etheraddr", ifp->mac_addr,
db22ae8c
HM
139 ETH_ALEN);
140 if (err < 0) {
5e8149f5 141 brcmf_err("Setting cur_etheraddr failed, %d\n", err);
db22ae8c
HM
142 } else {
143 brcmf_dbg(TRACE, "MAC address updated to %pM\n",
bdf5ff51
AS
144 ifp->mac_addr);
145 memcpy(ifp->ndev->dev_addr, ifp->mac_addr, ETH_ALEN);
db22ae8c 146 }
5b435de0
AS
147}
148
149static int brcmf_netdev_set_mac_address(struct net_device *ndev, void *addr)
150{
e1b83586 151 struct brcmf_if *ifp = netdev_priv(ndev);
5b435de0 152 struct sockaddr *sa = (struct sockaddr *)addr;
5b435de0 153
bdf5ff51
AS
154 memcpy(&ifp->mac_addr, sa->sa_data, ETH_ALEN);
155 schedule_work(&ifp->setmacaddr_work);
5b435de0
AS
156 return 0;
157}
158
159static void brcmf_netdev_set_multicast_list(struct net_device *ndev)
160{
e1b83586 161 struct brcmf_if *ifp = netdev_priv(ndev);
5b435de0 162
bdf5ff51 163 schedule_work(&ifp->multicast_work);
5b435de0
AS
164}
165
80fd2dbe
HM
166static netdev_tx_t brcmf_netdev_start_xmit(struct sk_buff *skb,
167 struct net_device *ndev)
5b435de0
AS
168{
169 int ret;
e1b83586 170 struct brcmf_if *ifp = netdev_priv(ndev);
d08b6a37 171 struct brcmf_pub *drvr = ifp->drvr;
12b33dac 172 struct ethhdr *eh;
5b435de0 173
2880b868 174 brcmf_dbg(TRACE, "Enter, idx=%d\n", ifp->bssidx);
5b435de0 175
80fd2dbe
HM
176 /* Can the device send data? */
177 if (drvr->bus_if->state != BRCMF_BUS_DATA) {
178 brcmf_err("xmit rejected state=%d\n", drvr->bus_if->state);
5b435de0 179 netif_stop_queue(ndev);
80fd2dbe
HM
180 dev_kfree_skb(skb);
181 ret = -ENODEV;
182 goto done;
5b435de0
AS
183 }
184
2880b868
HM
185 if (!drvr->iflist[ifp->bssidx]) {
186 brcmf_err("bad ifidx %d\n", ifp->bssidx);
5b435de0 187 netif_stop_queue(ndev);
80fd2dbe
HM
188 dev_kfree_skb(skb);
189 ret = -ENODEV;
190 goto done;
5b435de0
AS
191 }
192
193 /* Make sure there's enough room for any header */
d08b6a37 194 if (skb_headroom(skb) < drvr->hdrlen) {
5b435de0
AS
195 struct sk_buff *skb2;
196
197 brcmf_dbg(INFO, "%s: insufficient headroom\n",
2880b868 198 brcmf_ifname(drvr, ifp->bssidx));
9c1a043a 199 drvr->bus_if->tx_realloc++;
d08b6a37 200 skb2 = skb_realloc_headroom(skb, drvr->hdrlen);
5b435de0
AS
201 dev_kfree_skb(skb);
202 skb = skb2;
203 if (skb == NULL) {
5e8149f5 204 brcmf_err("%s: skb_realloc_headroom failed\n",
2880b868 205 brcmf_ifname(drvr, ifp->bssidx));
5b435de0
AS
206 ret = -ENOMEM;
207 goto done;
208 }
209 }
210
12b33dac
AS
211 /* validate length for ether packet */
212 if (skb->len < sizeof(*eh)) {
213 ret = -EINVAL;
214 dev_kfree_skb(skb);
215 goto done;
8514fd02
FL
216 }
217
12b33dac
AS
218 /* handle ethernet header */
219 eh = (struct ethhdr *)(skb->data);
220 if (is_multicast_ether_addr(eh->h_dest))
221 drvr->tx_multicast++;
222 if (ntohs(eh->h_proto) == ETH_P_PAE)
10ef7321 223 atomic_inc(&ifp->pend_8021x_cnt);
12b33dac 224
8514fd02 225 /* If the protocol uses a data header, apply it */
2880b868 226 brcmf_proto_hdrpush(drvr, ifp->ifidx, skb);
8514fd02
FL
227
228 /* Use bus module to send data frame */
d9cb2596 229 ret = brcmf_bus_txdata(drvr->bus_if, skb);
5b435de0
AS
230
231done:
b1a2a411
HM
232 if (ret) {
233 ifp->stats.tx_dropped++;
234 } else {
235 ifp->stats.tx_packets++;
236 ifp->stats.tx_bytes += skb->len;
237 }
5b435de0
AS
238
239 /* Return ok: we always eat the packet */
80fd2dbe 240 return NETDEV_TX_OK;
5b435de0
AS
241}
242
90d03ff7 243void brcmf_txflowblock(struct device *dev, bool state)
5b435de0
AS
244{
245 struct net_device *ndev;
2b459056
FL
246 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
247 struct brcmf_pub *drvr = bus_if->drvr;
90d03ff7 248 int i;
5b435de0
AS
249
250 brcmf_dbg(TRACE, "Enter\n");
251
90d03ff7
HM
252 for (i = 0; i < BRCMF_MAX_IFS; i++)
253 if (drvr->iflist[i]) {
254 ndev = drvr->iflist[i]->ndev;
255 if (state)
256 netif_stop_queue(ndev);
257 else
258 netif_wake_queue(ndev);
259 }
5b435de0
AS
260}
261
a43af515 262void brcmf_rx_frames(struct device *dev, struct sk_buff_head *skb_list)
5b435de0 263{
5b435de0
AS
264 unsigned char *eth;
265 uint len;
0b45bf74 266 struct sk_buff *skb, *pnext;
5b435de0 267 struct brcmf_if *ifp;
228bb43d
FL
268 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
269 struct brcmf_pub *drvr = bus_if->drvr;
a43af515
AS
270 u8 ifidx;
271 int ret;
5b435de0
AS
272
273 brcmf_dbg(TRACE, "Enter\n");
274
0b45bf74
AS
275 skb_queue_walk_safe(skb_list, skb, pnext) {
276 skb_unlink(skb, skb_list);
5b435de0 277
b1a2a411 278 /* process and remove protocol-specific header */
a43af515 279 ret = brcmf_proto_hdrpull(drvr, &ifidx, skb);
b1a2a411
HM
280 ifp = drvr->iflist[ifidx];
281
282 if (ret || !ifp || !ifp->ndev) {
283 if ((ret != -ENODATA) && ifp)
284 ifp->stats.rx_errors++;
a43af515
AS
285 brcmu_pkt_buf_free_skb(skb);
286 continue;
287 }
288
5b435de0
AS
289 /* Get the protocol, maintain skb around eth_type_trans()
290 * The main reason for this hack is for the limitation of
291 * Linux 2.4 where 'eth_type_trans' uses the
292 * 'net->hard_header_len'
293 * to perform skb_pull inside vs ETH_HLEN. Since to avoid
294 * coping of the packet coming from the network stack to add
295 * BDC, Hardware header etc, during network interface
296 * registration
297 * we set the 'net->hard_header_len' to ETH_HLEN + extra space
298 * required
299 * for BDC, Hardware header etc. and not just the ETH_HLEN
300 */
301 eth = skb->data;
302 len = skb->len;
303
5b435de0
AS
304 skb->dev = ifp->ndev;
305 skb->protocol = eth_type_trans(skb, skb->dev);
306
307 if (skb->pkt_type == PACKET_MULTICAST)
b1a2a411 308 ifp->stats.multicast++;
5b435de0
AS
309
310 skb->data = eth;
311 skb->len = len;
312
313 /* Strip header, count, deliver upward */
314 skb_pull(skb, ETH_HLEN);
315
316 /* Process special event packets and then discard them */
5c36b99a 317 brcmf_fweh_process_skb(drvr, skb, &ifidx);
5b435de0 318
d08b6a37
FL
319 if (drvr->iflist[ifidx]) {
320 ifp = drvr->iflist[ifidx];
5b435de0 321 ifp->ndev->last_rx = jiffies;
d1a5b6fb 322 }
5b435de0 323
b1a2a411
HM
324 if (!(ifp->ndev->flags & IFF_UP)) {
325 brcmu_pkt_buf_free_skb(skb);
326 continue;
327 }
328
329 ifp->stats.rx_bytes += skb->len;
330 ifp->stats.rx_packets++;
5b435de0
AS
331
332 if (in_interrupt())
333 netif_rx(skb);
334 else
335 /* If the receive is not processed inside an ISR,
336 * the softirqd must be woken explicitly to service
337 * the NET_RX_SOFTIRQ. In 2.6 kernels, this is handled
338 * by netif_rx_ni(), but in earlier kernels, we need
339 * to do it manually.
340 */
341 netif_rx_ni(skb);
342 }
343}
344
c995788f 345void brcmf_txcomplete(struct device *dev, struct sk_buff *txp, bool success)
5b435de0 346{
a43af515 347 u8 ifidx;
5b435de0
AS
348 struct ethhdr *eh;
349 u16 type;
c995788f
FL
350 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
351 struct brcmf_pub *drvr = bus_if->drvr;
10ef7321 352 struct brcmf_if *ifp;
5b435de0 353
a43af515 354 brcmf_proto_hdrpull(drvr, &ifidx, txp);
5b435de0 355
b1a2a411
HM
356 ifp = drvr->iflist[ifidx];
357 if (!ifp)
358 return;
359
5b435de0
AS
360 eh = (struct ethhdr *)(txp->data);
361 type = ntohs(eh->h_proto);
362
21fff75d 363 if (type == ETH_P_PAE) {
10ef7321
HM
364 atomic_dec(&ifp->pend_8021x_cnt);
365 if (waitqueue_active(&ifp->pend_8021x_wait))
366 wake_up(&ifp->pend_8021x_wait);
21fff75d 367 }
b1a2a411
HM
368 if (!success)
369 ifp->stats.tx_errors++;
5b435de0
AS
370}
371
372static struct net_device_stats *brcmf_netdev_get_stats(struct net_device *ndev)
373{
e1b83586 374 struct brcmf_if *ifp = netdev_priv(ndev);
5b435de0 375
2880b868 376 brcmf_dbg(TRACE, "Enter, idx=%d\n", ifp->bssidx);
5b435de0 377
5b435de0
AS
378 return &ifp->stats;
379}
380
db22ae8c
HM
381/*
382 * Set current toe component enables in toe_ol iovar,
383 * and set toe global enable iovar
384 */
385static int brcmf_toe_set(struct brcmf_if *ifp, u32 toe_ol)
5b435de0 386{
db22ae8c 387 s32 err;
5b435de0 388
db22ae8c
HM
389 err = brcmf_fil_iovar_int_set(ifp, "toe_ol", toe_ol);
390 if (err < 0) {
5e8149f5 391 brcmf_err("Setting toe_ol failed, %d\n", err);
db22ae8c 392 return err;
5b435de0
AS
393 }
394
db22ae8c
HM
395 err = brcmf_fil_iovar_int_set(ifp, "toe", (toe_ol != 0));
396 if (err < 0)
5e8149f5 397 brcmf_err("Setting toe failed, %d\n", err);
5b435de0 398
db22ae8c 399 return err;
5b435de0 400
5b435de0
AS
401}
402
403static void brcmf_ethtool_get_drvinfo(struct net_device *ndev,
404 struct ethtool_drvinfo *info)
405{
e1b83586 406 struct brcmf_if *ifp = netdev_priv(ndev);
d08b6a37 407 struct brcmf_pub *drvr = ifp->drvr;
5b435de0
AS
408
409 sprintf(info->driver, KBUILD_MODNAME);
d08b6a37 410 sprintf(info->version, "%lu", drvr->drv_version);
d9cb2596 411 sprintf(info->bus_info, "%s", dev_name(drvr->bus_if->dev));
5b435de0
AS
412}
413
3eb1fa7e
SH
414static const struct ethtool_ops brcmf_ethtool_ops = {
415 .get_drvinfo = brcmf_ethtool_get_drvinfo,
5b435de0
AS
416};
417
db22ae8c 418static int brcmf_ethtool(struct brcmf_if *ifp, void __user *uaddr)
5b435de0 419{
db22ae8c 420 struct brcmf_pub *drvr = ifp->drvr;
5b435de0
AS
421 struct ethtool_drvinfo info;
422 char drvname[sizeof(info.driver)];
423 u32 cmd;
424 struct ethtool_value edata;
425 u32 toe_cmpnt, csum_dir;
426 int ret;
427
2880b868 428 brcmf_dbg(TRACE, "Enter, idx=%d\n", ifp->bssidx);
5b435de0
AS
429
430 /* all ethtool calls start with a cmd word */
431 if (copy_from_user(&cmd, uaddr, sizeof(u32)))
432 return -EFAULT;
433
434 switch (cmd) {
435 case ETHTOOL_GDRVINFO:
436 /* Copy out any request driver name */
437 if (copy_from_user(&info, uaddr, sizeof(info)))
438 return -EFAULT;
439 strncpy(drvname, info.driver, sizeof(info.driver));
440 drvname[sizeof(info.driver) - 1] = '\0';
441
442 /* clear struct for return */
443 memset(&info, 0, sizeof(info));
444 info.cmd = cmd;
445
446 /* if requested, identify ourselves */
447 if (strcmp(drvname, "?dhd") == 0) {
448 sprintf(info.driver, "dhd");
449 strcpy(info.version, BRCMF_VERSION_STR);
450 }
05dde977 451 /* report dongle driver type */
5b435de0 452 else
91917c77 453 sprintf(info.driver, "wl");
5b435de0 454
d08b6a37 455 sprintf(info.version, "%lu", drvr->drv_version);
5b435de0
AS
456 if (copy_to_user(uaddr, &info, sizeof(info)))
457 return -EFAULT;
a6cfb147 458 brcmf_dbg(TRACE, "given %*s, returning %s\n",
5b435de0
AS
459 (int)sizeof(drvname), drvname, info.driver);
460 break;
461
462 /* Get toe offload components from dongle */
463 case ETHTOOL_GRXCSUM:
464 case ETHTOOL_GTXCSUM:
db22ae8c 465 ret = brcmf_fil_iovar_int_get(ifp, "toe_ol", &toe_cmpnt);
5b435de0
AS
466 if (ret < 0)
467 return ret;
468
469 csum_dir =
470 (cmd == ETHTOOL_GTXCSUM) ? TOE_TX_CSUM_OL : TOE_RX_CSUM_OL;
471
472 edata.cmd = cmd;
473 edata.data = (toe_cmpnt & csum_dir) ? 1 : 0;
474
475 if (copy_to_user(uaddr, &edata, sizeof(edata)))
476 return -EFAULT;
477 break;
478
479 /* Set toe offload components in dongle */
480 case ETHTOOL_SRXCSUM:
481 case ETHTOOL_STXCSUM:
482 if (copy_from_user(&edata, uaddr, sizeof(edata)))
483 return -EFAULT;
484
485 /* Read the current settings, update and write back */
db22ae8c 486 ret = brcmf_fil_iovar_int_get(ifp, "toe_ol", &toe_cmpnt);
5b435de0
AS
487 if (ret < 0)
488 return ret;
489
490 csum_dir =
491 (cmd == ETHTOOL_STXCSUM) ? TOE_TX_CSUM_OL : TOE_RX_CSUM_OL;
492
493 if (edata.data != 0)
494 toe_cmpnt |= csum_dir;
495 else
496 toe_cmpnt &= ~csum_dir;
497
db22ae8c 498 ret = brcmf_toe_set(ifp, toe_cmpnt);
5b435de0
AS
499 if (ret < 0)
500 return ret;
501
502 /* If setting TX checksum mode, tell Linux the new mode */
503 if (cmd == ETHTOOL_STXCSUM) {
504 if (edata.data)
db22ae8c 505 ifp->ndev->features |= NETIF_F_IP_CSUM;
5b435de0 506 else
db22ae8c 507 ifp->ndev->features &= ~NETIF_F_IP_CSUM;
5b435de0
AS
508 }
509
510 break;
511
512 default:
513 return -EOPNOTSUPP;
514 }
515
516 return 0;
517}
518
519static int brcmf_netdev_ioctl_entry(struct net_device *ndev, struct ifreq *ifr,
520 int cmd)
521{
e1b83586 522 struct brcmf_if *ifp = netdev_priv(ndev);
d08b6a37 523 struct brcmf_pub *drvr = ifp->drvr;
5b435de0 524
2880b868 525 brcmf_dbg(TRACE, "Enter, idx=%d, cmd=0x%04x\n", ifp->bssidx, cmd);
5b435de0 526
2880b868 527 if (!drvr->iflist[ifp->bssidx])
5b435de0
AS
528 return -1;
529
530 if (cmd == SIOCETHTOOL)
db22ae8c 531 return brcmf_ethtool(ifp, ifr->ifr_data);
5b435de0
AS
532
533 return -EOPNOTSUPP;
534}
535
5b435de0
AS
536static int brcmf_netdev_stop(struct net_device *ndev)
537{
94889b1f
HM
538 struct brcmf_if *ifp = netdev_priv(ndev);
539
2880b868 540 brcmf_dbg(TRACE, "Enter, idx=%d\n", ifp->bssidx);
817b178c 541
bdf5ff51 542 brcmf_cfg80211_down(ndev);
817b178c 543
5b435de0 544 /* Set state and stop OS transmissions */
5b435de0
AS
545 netif_stop_queue(ndev);
546
547 return 0;
548}
549
550static int brcmf_netdev_open(struct net_device *ndev)
551{
e1b83586 552 struct brcmf_if *ifp = netdev_priv(ndev);
d08b6a37 553 struct brcmf_pub *drvr = ifp->drvr;
1bb1f384 554 struct brcmf_bus *bus_if = drvr->bus_if;
5b435de0 555 u32 toe_ol;
5b435de0
AS
556 s32 ret = 0;
557
2880b868 558 brcmf_dbg(TRACE, "Enter, idx=%d\n", ifp->bssidx);
5b435de0 559
bdf5ff51
AS
560 /* If bus is not ready, can't continue */
561 if (bus_if->state != BRCMF_BUS_DATA) {
5e8149f5 562 brcmf_err("failed bus is not ready\n");
bdf5ff51
AS
563 return -EAGAIN;
564 }
1bb1f384 565
10ef7321 566 atomic_set(&ifp->pend_8021x_cnt, 0);
5b435de0 567
bdf5ff51
AS
568 /* Get current TOE mode from dongle */
569 if (brcmf_fil_iovar_int_get(ifp, "toe_ol", &toe_ol) >= 0
570 && (toe_ol & TOE_TX_CSUM_OL) != 0)
40a23296 571 ndev->features |= NETIF_F_IP_CSUM;
bdf5ff51 572 else
40a23296 573 ndev->features &= ~NETIF_F_IP_CSUM;
3338084a 574
5b435de0
AS
575 /* Allow transmit calls */
576 netif_start_queue(ndev);
bdf5ff51 577 if (brcmf_cfg80211_up(ndev)) {
5e8149f5 578 brcmf_err("failed to bring up cfg80211\n");
5b435de0
AS
579 return -1;
580 }
581
582 return ret;
583}
584
dfded557
FL
585static const struct net_device_ops brcmf_netdev_ops_pri = {
586 .ndo_open = brcmf_netdev_open,
587 .ndo_stop = brcmf_netdev_stop,
588 .ndo_get_stats = brcmf_netdev_get_stats,
589 .ndo_do_ioctl = brcmf_netdev_ioctl_entry,
590 .ndo_start_xmit = brcmf_netdev_start_xmit,
591 .ndo_set_mac_address = brcmf_netdev_set_mac_address,
592 .ndo_set_rx_mode = brcmf_netdev_set_multicast_list
593};
594
bdf5ff51
AS
595static const struct net_device_ops brcmf_netdev_ops_virt = {
596 .ndo_open = brcmf_cfg80211_up,
597 .ndo_stop = brcmf_cfg80211_down,
598 .ndo_get_stats = brcmf_netdev_get_stats,
599 .ndo_do_ioctl = brcmf_netdev_ioctl_entry,
600 .ndo_start_xmit = brcmf_netdev_start_xmit,
601 .ndo_set_mac_address = brcmf_netdev_set_mac_address,
602 .ndo_set_rx_mode = brcmf_netdev_set_multicast_list
603};
604
1ed9baf0 605int brcmf_net_attach(struct brcmf_if *ifp)
75c49904 606{
3625c149 607 struct brcmf_pub *drvr = ifp->drvr;
75c49904 608 struct net_device *ndev;
75c49904 609
2880b868 610 brcmf_dbg(TRACE, "Enter, idx=%d mac=%pM\n", ifp->bssidx,
94889b1f 611 ifp->mac_addr);
bdf5ff51 612 ndev = ifp->ndev;
75c49904 613
bdf5ff51 614 /* set appropriate operations */
2880b868 615 if (!ifp->bssidx)
bdf5ff51
AS
616 ndev->netdev_ops = &brcmf_netdev_ops_pri;
617 else
618 ndev->netdev_ops = &brcmf_netdev_ops_virt;
75c49904 619
75c49904
AS
620 ndev->hard_header_len = ETH_HLEN + drvr->hdrlen;
621 ndev->ethtool_ops = &brcmf_ethtool_ops;
622
623 drvr->rxsz = ndev->mtu + ndev->hard_header_len +
624 drvr->hdrlen;
625
0b63cb71
AS
626 /* set the mac address */
627 memcpy(ndev->dev_addr, ifp->mac_addr, ETH_ALEN);
75c49904 628
75c49904 629 if (register_netdev(ndev) != 0) {
5e8149f5 630 brcmf_err("couldn't register the net device\n");
75c49904
AS
631 goto fail;
632 }
633
634 brcmf_dbg(INFO, "%s: Broadcom Dongle Host Driver\n", ndev->name);
635
636 return 0;
637
638fail:
639 ndev->netdev_ops = NULL;
640 return -EBADE;
641}
642
2880b868
HM
643struct brcmf_if *brcmf_add_if(struct brcmf_pub *drvr, s32 bssidx, s32 ifidx,
644 char *name, u8 *mac_addr)
5b435de0
AS
645{
646 struct brcmf_if *ifp;
e1b83586 647 struct net_device *ndev;
5b435de0 648
2880b868 649 brcmf_dbg(TRACE, "Enter, idx=%d, ifidx=%d\n", bssidx, ifidx);
5b435de0 650
2880b868 651 ifp = drvr->iflist[bssidx];
e1b83586
FL
652 /*
653 * Delete the existing interface before overwriting it
654 * in case we missed the BRCMF_E_IF_DEL event.
655 */
656 if (ifp) {
5e8149f5 657 brcmf_err("ERROR: netdev:%s already exists\n",
e1b83586 658 ifp->ndev->name);
2880b868 659 if (bssidx) {
b522dd80
AS
660 netif_stop_queue(ifp->ndev);
661 unregister_netdev(ifp->ndev);
662 free_netdev(ifp->ndev);
2880b868 663 drvr->iflist[bssidx] = NULL;
b522dd80 664 } else {
5e8149f5 665 brcmf_err("ignore IF event\n");
b522dd80
AS
666 return ERR_PTR(-EINVAL);
667 }
15d45b6f 668 }
5b435de0 669
15d45b6f 670 /* Allocate netdev, including space for private structure */
e1b83586
FL
671 ndev = alloc_netdev(sizeof(struct brcmf_if), name, ether_setup);
672 if (!ndev) {
5e8149f5 673 brcmf_err("OOM - alloc_netdev\n");
1ed9baf0 674 return ERR_PTR(-ENOMEM);
15d45b6f 675 }
5b435de0 676
e1b83586
FL
677 ifp = netdev_priv(ndev);
678 ifp->ndev = ndev;
d08b6a37 679 ifp->drvr = drvr;
2880b868
HM
680 drvr->iflist[bssidx] = ifp;
681 ifp->ifidx = ifidx;
1d4fd8d7 682 ifp->bssidx = bssidx;
bdf5ff51
AS
683
684 INIT_WORK(&ifp->setmacaddr_work, _brcmf_set_mac_address);
685 INIT_WORK(&ifp->multicast_work, _brcmf_set_multicast_list);
686
10ef7321
HM
687 init_waitqueue_head(&ifp->pend_8021x_wait);
688
2880b868
HM
689 if (mac_addr != NULL)
690 memcpy(ifp->mac_addr, mac_addr, ETH_ALEN);
5b435de0 691
9bcb74f9
AS
692 brcmf_dbg(TRACE, " ==== pid:%x, if:%s (%pM) created ===\n",
693 current->pid, ifp->ndev->name, ifp->mac_addr);
5b435de0 694
1ed9baf0 695 return ifp;
5b435de0
AS
696}
697
2880b868 698void brcmf_del_if(struct brcmf_pub *drvr, s32 bssidx)
5b435de0
AS
699{
700 struct brcmf_if *ifp;
701
2880b868 702 ifp = drvr->iflist[bssidx];
5b435de0 703 if (!ifp) {
2880b868 704 brcmf_err("Null interface, idx=%d\n", bssidx);
5b435de0
AS
705 return;
706 }
2880b868 707 brcmf_dbg(TRACE, "Enter, idx=%d, ifidx=%d\n", bssidx, ifp->ifidx);
dfded557 708 if (ifp->ndev) {
2880b868 709 if (bssidx == 0) {
dfded557
FL
710 if (ifp->ndev->netdev_ops == &brcmf_netdev_ops_pri) {
711 rtnl_lock();
712 brcmf_netdev_stop(ifp->ndev);
713 rtnl_unlock();
714 }
715 } else {
716 netif_stop_queue(ifp->ndev);
717 }
718
bdf5ff51
AS
719 cancel_work_sync(&ifp->setmacaddr_work);
720 cancel_work_sync(&ifp->multicast_work);
721
5b435de0 722 unregister_netdev(ifp->ndev);
2880b868
HM
723 drvr->iflist[bssidx] = NULL;
724 if (bssidx == 0)
d08b6a37 725 brcmf_cfg80211_detach(drvr->config);
dfded557 726 free_netdev(ifp->ndev);
5b435de0
AS
727 }
728}
729
2447ffb0 730int brcmf_attach(uint bus_hdrlen, struct device *dev)
5b435de0 731{
d08b6a37 732 struct brcmf_pub *drvr = NULL;
712ac5b3 733 int ret = 0;
5b435de0
AS
734
735 brcmf_dbg(TRACE, "Enter\n");
736
5b435de0 737 /* Allocate primary brcmf_info */
d08b6a37
FL
738 drvr = kzalloc(sizeof(struct brcmf_pub), GFP_ATOMIC);
739 if (!drvr)
712ac5b3 740 return -ENOMEM;
5b435de0 741
d08b6a37 742 mutex_init(&drvr->proto_block);
5b435de0
AS
743
744 /* Link to bus module */
d08b6a37
FL
745 drvr->hdrlen = bus_hdrlen;
746 drvr->bus_if = dev_get_drvdata(dev);
55a63bcc 747 drvr->bus_if->drvr = drvr;
5b435de0 748
d319a7cf
AS
749 /* create device debugfs folder */
750 brcmf_debugfs_attach(drvr);
751
5b435de0 752 /* Attach and link in the protocol */
712ac5b3
FL
753 ret = brcmf_proto_attach(drvr);
754 if (ret != 0) {
5e8149f5 755 brcmf_err("brcmf_prot_attach failed\n");
5b435de0
AS
756 goto fail;
757 }
758
5c36b99a
AS
759 /* attach firmware event handler */
760 brcmf_fweh_attach(drvr);
761
135e4c61
FL
762 INIT_LIST_HEAD(&drvr->bus_if->dcmd_list);
763
712ac5b3 764 return ret;
5b435de0
AS
765
766fail:
712ac5b3 767 brcmf_detach(dev);
5b435de0 768
712ac5b3 769 return ret;
5b435de0
AS
770}
771
ed683c98 772int brcmf_bus_start(struct device *dev)
5b435de0
AS
773{
774 int ret = -1;
ed683c98
FL
775 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
776 struct brcmf_pub *drvr = bus_if->drvr;
1ed9baf0 777 struct brcmf_if *ifp;
5b435de0
AS
778
779 brcmf_dbg(TRACE, "\n");
780
781 /* Bring up the bus */
d9cb2596 782 ret = brcmf_bus_init(bus_if);
5b435de0 783 if (ret != 0) {
5e8149f5 784 brcmf_err("brcmf_sdbrcm_bus_init failed %d\n", ret);
5b435de0
AS
785 return ret;
786 }
787
1ed9baf0 788 /* add primary networking interface */
699b5e5b 789 ifp = brcmf_add_if(drvr, 0, 0, "wlan%d", NULL);
1ed9baf0
AS
790 if (IS_ERR(ifp))
791 return PTR_ERR(ifp);
792
0af29bf7
HM
793 /* signal bus ready */
794 bus_if->state = BRCMF_BUS_DATA;
795
796 /* Bus is ready, do any initialization */
797 ret = brcmf_c_preinit_dcmds(ifp);
5b435de0 798 if (ret < 0)
6b028c5e 799 goto fail;
5b435de0 800
d9cb2596 801 drvr->config = brcmf_cfg80211_attach(drvr, bus_if->dev);
6b028c5e
HM
802 if (drvr->config == NULL) {
803 ret = -ENOMEM;
804 goto fail;
805 }
1ed9baf0 806
5c36b99a
AS
807 ret = brcmf_fweh_activate_events(ifp);
808 if (ret < 0)
809 goto fail;
810
1ed9baf0 811 ret = brcmf_net_attach(ifp);
6b028c5e 812fail:
1ed9baf0 813 if (ret < 0) {
5e8149f5 814 brcmf_err("failed: %d\n", ret);
6b028c5e
HM
815 if (drvr->config)
816 brcmf_cfg80211_detach(drvr->config);
2880b868 817 free_netdev(ifp->ndev);
1ed9baf0 818 drvr->iflist[0] = NULL;
474a64c8 819 return ret;
1ed9baf0
AS
820 }
821
5b435de0
AS
822 return 0;
823}
824
5b435de0
AS
825static void brcmf_bus_detach(struct brcmf_pub *drvr)
826{
5b435de0
AS
827 brcmf_dbg(TRACE, "Enter\n");
828
829 if (drvr) {
d08b6a37
FL
830 /* Stop the protocol module */
831 brcmf_proto_stop(drvr);
5b435de0 832
d08b6a37 833 /* Stop the bus module */
d9cb2596 834 brcmf_bus_stop(drvr->bus_if);
5b435de0
AS
835 }
836}
837
81d5f1bb
AS
838void brcmf_dev_reset(struct device *dev)
839{
840 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
841 struct brcmf_pub *drvr = bus_if->drvr;
842
843 if (drvr == NULL)
844 return;
845
643ecaab
HM
846 if (drvr->iflist[0])
847 brcmf_fil_cmd_int_set(drvr->iflist[0], BRCMF_C_TERMINATED, 1);
81d5f1bb
AS
848}
849
5f947ad9 850void brcmf_detach(struct device *dev)
5b435de0 851{
2880b868 852 s32 i;
5f947ad9
FL
853 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
854 struct brcmf_pub *drvr = bus_if->drvr;
5b435de0
AS
855
856 brcmf_dbg(TRACE, "Enter\n");
857
817b178c
HM
858 if (drvr == NULL)
859 return;
5b435de0 860
5c36b99a
AS
861 /* stop firmware event handling */
862 brcmf_fweh_detach(drvr);
863
5f947ad9
FL
864 /* make sure primary interface removed last */
865 for (i = BRCMF_MAX_IFS-1; i > -1; i--)
866 if (drvr->iflist[i])
867 brcmf_del_if(drvr, i);
5b435de0 868
5f947ad9 869 brcmf_bus_detach(drvr);
5b435de0 870
b84e3112 871 if (drvr->prot)
5f947ad9 872 brcmf_proto_detach(drvr);
5b435de0 873
d319a7cf 874 brcmf_debugfs_detach(drvr);
5f947ad9
FL
875 bus_if->drvr = NULL;
876 kfree(drvr);
5b435de0
AS
877}
878
10ef7321 879static int brcmf_get_pend_8021x_cnt(struct brcmf_if *ifp)
5b435de0 880{
10ef7321 881 return atomic_read(&ifp->pend_8021x_cnt);
5b435de0
AS
882}
883
5b435de0
AS
884int brcmf_netdev_wait_pend8021x(struct net_device *ndev)
885{
e1b83586 886 struct brcmf_if *ifp = netdev_priv(ndev);
21fff75d
HM
887 int err;
888
10ef7321
HM
889 err = wait_event_timeout(ifp->pend_8021x_wait,
890 !brcmf_get_pend_8021x_cnt(ifp),
21fff75d
HM
891 msecs_to_jiffies(MAX_WAIT_FOR_8021X_TX));
892
893 WARN_ON(!err);
894
895 return !err;
5b435de0
AS
896}
897
371830ea
AS
898/*
899 * return chip id and rev of the device encoded in u32.
900 */
901u32 brcmf_get_chip_info(struct brcmf_if *ifp)
902{
903 struct brcmf_bus *bus = ifp->drvr->bus_if;
904
905 return bus->chip << 4 | bus->chiprev;
906}
907
e64a4b70 908static void brcmf_driver_init(struct work_struct *work)
f3d7cdc3 909{
d319a7cf
AS
910 brcmf_debugfs_init();
911
f3d7cdc3 912#ifdef CONFIG_BRCMFMAC_SDIO
549040ab 913 brcmf_sdio_init();
f3d7cdc3 914#endif
71bb244b 915#ifdef CONFIG_BRCMFMAC_USB
549040ab 916 brcmf_usb_init();
71bb244b 917#endif
e64a4b70
AS
918}
919static DECLARE_WORK(brcmf_driver_work, brcmf_driver_init);
920
921static int __init brcmfmac_module_init(void)
922{
923 if (!schedule_work(&brcmf_driver_work))
924 return -EBUSY;
925
549040ab 926 return 0;
f3d7cdc3
AS
927}
928
e64a4b70 929static void __exit brcmfmac_module_exit(void)
f3d7cdc3 930{
e64a4b70
AS
931 cancel_work_sync(&brcmf_driver_work);
932
f3d7cdc3
AS
933#ifdef CONFIG_BRCMFMAC_SDIO
934 brcmf_sdio_exit();
935#endif
71bb244b
AS
936#ifdef CONFIG_BRCMFMAC_USB
937 brcmf_usb_exit();
938#endif
d319a7cf 939 brcmf_debugfs_exit();
f3d7cdc3
AS
940}
941
e64a4b70
AS
942module_init(brcmfmac_module_init);
943module_exit(brcmfmac_module_exit);