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