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