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> |
44129ed0 | 20 | #include <linux/inetdevice.h> |
5b435de0 AS |
21 | #include <net/cfg80211.h> |
22 | #include <net/rtnetlink.h> | |
52f22fb2 FL |
23 | #include <net/addrconf.h> |
24 | #include <net/ipv6.h> | |
5b435de0 AS |
25 | #include <brcmu_utils.h> |
26 | #include <brcmu_wifi.h> | |
27 | ||
122d3d04 | 28 | #include "core.h" |
d14f78b9 | 29 | #include "bus.h" |
a8e8ed34 | 30 | #include "debug.h" |
7a5c1f64 | 31 | #include "fwil_types.h" |
9f440b7b | 32 | #include "p2p.h" |
bfe81975 | 33 | #include "cfg80211.h" |
db22ae8c | 34 | #include "fwil.h" |
349e7104 | 35 | #include "fwsignal.h" |
c08437b4 | 36 | #include "feature.h" |
85b84133 | 37 | #include "proto.h" |
9e37f045 | 38 | #include "pcie.h" |
c443e169 | 39 | #include "common.h" |
5b435de0 | 40 | |
e9217b4b | 41 | #define MAX_WAIT_FOR_8021X_TX msecs_to_jiffies(950) |
5b435de0 | 42 | |
6ea696eb HM |
43 | #define BRCMF_BSSIDX_INVALID -1 |
44 | ||
c9c00438 | 45 | char *brcmf_ifname(struct brcmf_if *ifp) |
5b435de0 | 46 | { |
c9c00438 | 47 | if (!ifp) |
5b435de0 | 48 | return "<if_null>"; |
5b435de0 | 49 | |
c9c00438 HM |
50 | if (ifp->ndev) |
51 | return ifp->ndev->name; | |
5b435de0 AS |
52 | |
53 | return "<if_none>"; | |
54 | } | |
55 | ||
75effb03 AS |
56 | struct brcmf_if *brcmf_get_ifp(struct brcmf_pub *drvr, int ifidx) |
57 | { | |
291da87b | 58 | struct brcmf_if *ifp; |
37a869ec | 59 | s32 bsscfgidx; |
291da87b | 60 | |
75effb03 AS |
61 | if (ifidx < 0 || ifidx >= BRCMF_MAX_IFS) { |
62 | brcmf_err("ifidx %d out of range\n", ifidx); | |
796cfb65 | 63 | return NULL; |
75effb03 AS |
64 | } |
65 | ||
291da87b | 66 | ifp = NULL; |
37a869ec HM |
67 | bsscfgidx = drvr->if2bss[ifidx]; |
68 | if (bsscfgidx >= 0) | |
69 | ifp = drvr->iflist[bsscfgidx]; | |
75effb03 | 70 | |
291da87b | 71 | return ifp; |
75effb03 AS |
72 | } |
73 | ||
5b435de0 AS |
74 | static void _brcmf_set_multicast_list(struct work_struct *work) |
75 | { | |
db22ae8c | 76 | struct brcmf_if *ifp; |
5b435de0 AS |
77 | struct net_device *ndev; |
78 | struct netdev_hw_addr *ha; | |
db22ae8c | 79 | u32 cmd_value, cnt; |
5b435de0 | 80 | __le32 cnt_le; |
5b435de0 | 81 | char *buf, *bufp; |
db22ae8c HM |
82 | u32 buflen; |
83 | s32 err; | |
5b435de0 | 84 | |
bdf5ff51 | 85 | ifp = container_of(work, struct brcmf_if, multicast_work); |
94889b1f | 86 | |
37a869ec | 87 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d\n", ifp->bsscfgidx); |
94889b1f | 88 | |
db22ae8c | 89 | ndev = ifp->ndev; |
5b435de0 AS |
90 | |
91 | /* Determine initial value of allmulti flag */ | |
db22ae8c | 92 | cmd_value = (ndev->flags & IFF_ALLMULTI) ? true : false; |
5b435de0 AS |
93 | |
94 | /* Send down the multicast list first. */ | |
db22ae8c HM |
95 | cnt = netdev_mc_count(ndev); |
96 | buflen = sizeof(cnt) + (cnt * ETH_ALEN); | |
97 | buf = kmalloc(buflen, GFP_ATOMIC); | |
98 | if (!buf) | |
5b435de0 | 99 | return; |
db22ae8c | 100 | bufp = buf; |
5b435de0 AS |
101 | |
102 | cnt_le = cpu_to_le32(cnt); | |
db22ae8c | 103 | memcpy(bufp, &cnt_le, sizeof(cnt_le)); |
5b435de0 AS |
104 | bufp += sizeof(cnt_le); |
105 | ||
106 | netdev_for_each_mc_addr(ha, ndev) { | |
107 | if (!cnt) | |
108 | break; | |
109 | memcpy(bufp, ha->addr, ETH_ALEN); | |
110 | bufp += ETH_ALEN; | |
111 | cnt--; | |
112 | } | |
113 | ||
db22ae8c HM |
114 | err = brcmf_fil_iovar_data_set(ifp, "mcast_list", buf, buflen); |
115 | if (err < 0) { | |
5e8149f5 | 116 | brcmf_err("Setting mcast_list failed, %d\n", err); |
db22ae8c | 117 | cmd_value = cnt ? true : cmd_value; |
5b435de0 AS |
118 | } |
119 | ||
120 | kfree(buf); | |
121 | ||
db22ae8c HM |
122 | /* |
123 | * Now send the allmulti setting. This is based on the setting in the | |
5b435de0 AS |
124 | * net_device flags, but might be modified above to be turned on if we |
125 | * were trying to set some addresses and dongle rejected it... | |
126 | */ | |
db22ae8c HM |
127 | err = brcmf_fil_iovar_int_set(ifp, "allmulti", cmd_value); |
128 | if (err < 0) | |
5e8149f5 | 129 | brcmf_err("Setting allmulti failed, %d\n", err); |
db22ae8c HM |
130 | |
131 | /*Finally, pick up the PROMISC flag */ | |
132 | cmd_value = (ndev->flags & IFF_PROMISC) ? true : false; | |
133 | err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_PROMISC, cmd_value); | |
134 | if (err < 0) | |
5e8149f5 | 135 | brcmf_err("Setting BRCMF_C_SET_PROMISC failed, %d\n", |
db22ae8c | 136 | err); |
5b435de0 AS |
137 | } |
138 | ||
139 | static void | |
140 | _brcmf_set_mac_address(struct work_struct *work) | |
141 | { | |
db22ae8c | 142 | struct brcmf_if *ifp; |
db22ae8c | 143 | s32 err; |
5b435de0 | 144 | |
bdf5ff51 | 145 | ifp = container_of(work, struct brcmf_if, setmacaddr_work); |
94889b1f | 146 | |
37a869ec | 147 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d\n", ifp->bsscfgidx); |
94889b1f | 148 | |
bdf5ff51 | 149 | err = brcmf_fil_iovar_data_set(ifp, "cur_etheraddr", ifp->mac_addr, |
db22ae8c HM |
150 | ETH_ALEN); |
151 | if (err < 0) { | |
5e8149f5 | 152 | brcmf_err("Setting cur_etheraddr failed, %d\n", err); |
db22ae8c HM |
153 | } else { |
154 | brcmf_dbg(TRACE, "MAC address updated to %pM\n", | |
bdf5ff51 AS |
155 | ifp->mac_addr); |
156 | memcpy(ifp->ndev->dev_addr, ifp->mac_addr, ETH_ALEN); | |
db22ae8c | 157 | } |
5b435de0 AS |
158 | } |
159 | ||
52f22fb2 FL |
160 | #if IS_ENABLED(CONFIG_IPV6) |
161 | static void _brcmf_update_ndtable(struct work_struct *work) | |
162 | { | |
163 | struct brcmf_if *ifp; | |
164 | int i, ret; | |
165 | ||
166 | ifp = container_of(work, struct brcmf_if, ndoffload_work); | |
167 | ||
168 | /* clear the table in firmware */ | |
169 | ret = brcmf_fil_iovar_data_set(ifp, "nd_hostip_clear", NULL, 0); | |
170 | if (ret) { | |
171 | brcmf_dbg(TRACE, "fail to clear nd ip table err:%d\n", ret); | |
172 | return; | |
173 | } | |
174 | ||
175 | for (i = 0; i < ifp->ipv6addr_idx; i++) { | |
176 | ret = brcmf_fil_iovar_data_set(ifp, "nd_hostip", | |
177 | &ifp->ipv6_addr_tbl[i], | |
178 | sizeof(struct in6_addr)); | |
179 | if (ret) | |
180 | brcmf_err("add nd ip err %d\n", ret); | |
181 | } | |
182 | } | |
183 | #else | |
184 | static void _brcmf_update_ndtable(struct work_struct *work) | |
185 | { | |
186 | } | |
187 | #endif | |
188 | ||
5b435de0 AS |
189 | static int brcmf_netdev_set_mac_address(struct net_device *ndev, void *addr) |
190 | { | |
e1b83586 | 191 | struct brcmf_if *ifp = netdev_priv(ndev); |
5b435de0 | 192 | struct sockaddr *sa = (struct sockaddr *)addr; |
5b435de0 | 193 | |
bdf5ff51 AS |
194 | memcpy(&ifp->mac_addr, sa->sa_data, ETH_ALEN); |
195 | schedule_work(&ifp->setmacaddr_work); | |
5b435de0 AS |
196 | return 0; |
197 | } | |
198 | ||
199 | static void brcmf_netdev_set_multicast_list(struct net_device *ndev) | |
200 | { | |
e1b83586 | 201 | struct brcmf_if *ifp = netdev_priv(ndev); |
5b435de0 | 202 | |
bdf5ff51 | 203 | schedule_work(&ifp->multicast_work); |
5b435de0 AS |
204 | } |
205 | ||
80fd2dbe HM |
206 | static netdev_tx_t brcmf_netdev_start_xmit(struct sk_buff *skb, |
207 | struct net_device *ndev) | |
5b435de0 AS |
208 | { |
209 | int ret; | |
e1b83586 | 210 | struct brcmf_if *ifp = netdev_priv(ndev); |
d08b6a37 | 211 | struct brcmf_pub *drvr = ifp->drvr; |
55929443 | 212 | struct ethhdr *eh = (struct ethhdr *)(skb->data); |
5b435de0 | 213 | |
37a869ec | 214 | brcmf_dbg(DATA, "Enter, bsscfgidx=%d\n", ifp->bsscfgidx); |
5b435de0 | 215 | |
80fd2dbe | 216 | /* Can the device send data? */ |
a1cee865 | 217 | if (drvr->bus_if->state != BRCMF_BUS_UP) { |
80fd2dbe | 218 | brcmf_err("xmit rejected state=%d\n", drvr->bus_if->state); |
5b435de0 | 219 | netif_stop_queue(ndev); |
80fd2dbe HM |
220 | dev_kfree_skb(skb); |
221 | ret = -ENODEV; | |
222 | goto done; | |
5b435de0 AS |
223 | } |
224 | ||
5b435de0 | 225 | /* Make sure there's enough room for any header */ |
d08b6a37 | 226 | if (skb_headroom(skb) < drvr->hdrlen) { |
5b435de0 AS |
227 | struct sk_buff *skb2; |
228 | ||
229 | brcmf_dbg(INFO, "%s: insufficient headroom\n", | |
c9c00438 | 230 | brcmf_ifname(ifp)); |
9c1a043a | 231 | drvr->bus_if->tx_realloc++; |
d08b6a37 | 232 | skb2 = skb_realloc_headroom(skb, drvr->hdrlen); |
5b435de0 AS |
233 | dev_kfree_skb(skb); |
234 | skb = skb2; | |
235 | if (skb == NULL) { | |
5e8149f5 | 236 | brcmf_err("%s: skb_realloc_headroom failed\n", |
c9c00438 | 237 | brcmf_ifname(ifp)); |
5b435de0 AS |
238 | ret = -ENOMEM; |
239 | goto done; | |
240 | } | |
241 | } | |
242 | ||
12b33dac AS |
243 | /* validate length for ether packet */ |
244 | if (skb->len < sizeof(*eh)) { | |
245 | ret = -EINVAL; | |
246 | dev_kfree_skb(skb); | |
247 | goto done; | |
8514fd02 FL |
248 | } |
249 | ||
55929443 HM |
250 | if (eh->h_proto == htons(ETH_P_PAE)) |
251 | atomic_inc(&ifp->pend_8021x_cnt); | |
252 | ||
3edc1cff | 253 | ret = brcmf_fws_process_skb(ifp, skb); |
5b435de0 AS |
254 | |
255 | done: | |
b1a2a411 HM |
256 | if (ret) { |
257 | ifp->stats.tx_dropped++; | |
258 | } else { | |
259 | ifp->stats.tx_packets++; | |
260 | ifp->stats.tx_bytes += skb->len; | |
261 | } | |
5b435de0 AS |
262 | |
263 | /* Return ok: we always eat the packet */ | |
80fd2dbe | 264 | return NETDEV_TX_OK; |
5b435de0 AS |
265 | } |
266 | ||
29e04ae3 AS |
267 | void brcmf_txflowblock_if(struct brcmf_if *ifp, |
268 | enum brcmf_netif_stop_reason reason, bool state) | |
269 | { | |
df50f756 HM |
270 | unsigned long flags; |
271 | ||
23d412a2 | 272 | if (!ifp || !ifp->ndev) |
29e04ae3 AS |
273 | return; |
274 | ||
37a869ec HM |
275 | brcmf_dbg(TRACE, "enter: bsscfgidx=%d stop=0x%X reason=%d state=%d\n", |
276 | ifp->bsscfgidx, ifp->netif_stop, reason, state); | |
df50f756 HM |
277 | |
278 | spin_lock_irqsave(&ifp->netif_stop_lock, flags); | |
29e04ae3 AS |
279 | if (state) { |
280 | if (!ifp->netif_stop) | |
281 | netif_stop_queue(ifp->ndev); | |
282 | ifp->netif_stop |= reason; | |
283 | } else { | |
284 | ifp->netif_stop &= ~reason; | |
285 | if (!ifp->netif_stop) | |
286 | netif_wake_queue(ifp->ndev); | |
287 | } | |
df50f756 | 288 | spin_unlock_irqrestore(&ifp->netif_stop_lock, flags); |
29e04ae3 AS |
289 | } |
290 | ||
90d03ff7 | 291 | void brcmf_txflowblock(struct device *dev, bool state) |
5b435de0 | 292 | { |
2b459056 FL |
293 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
294 | struct brcmf_pub *drvr = bus_if->drvr; | |
5b435de0 AS |
295 | |
296 | brcmf_dbg(TRACE, "Enter\n"); | |
297 | ||
0a4254be | 298 | brcmf_fws_bus_blocked(drvr, state); |
5b435de0 AS |
299 | } |
300 | ||
9c349892 | 301 | void brcmf_netif_rx(struct brcmf_if *ifp, struct sk_buff *skb) |
87edd891 | 302 | { |
87edd891 AS |
303 | if (skb->pkt_type == PACKET_MULTICAST) |
304 | ifp->stats.multicast++; | |
305 | ||
87edd891 AS |
306 | if (!(ifp->ndev->flags & IFF_UP)) { |
307 | brcmu_pkt_buf_free_skb(skb); | |
308 | return; | |
309 | } | |
310 | ||
311 | ifp->stats.rx_bytes += skb->len; | |
312 | ifp->stats.rx_packets++; | |
313 | ||
314 | brcmf_dbg(DATA, "rx proto=0x%X\n", ntohs(skb->protocol)); | |
315 | if (in_interrupt()) | |
316 | netif_rx(skb); | |
317 | else | |
318 | /* If the receive is not processed inside an ISR, | |
319 | * the softirqd must be woken explicitly to service | |
320 | * the NET_RX_SOFTIRQ. This is handled by netif_rx_ni(). | |
321 | */ | |
322 | netif_rx_ni(skb); | |
323 | } | |
324 | ||
c462ebcd AS |
325 | static int brcmf_rx_hdrpull(struct brcmf_pub *drvr, struct sk_buff *skb, |
326 | struct brcmf_if **ifp) | |
5b435de0 | 327 | { |
a43af515 | 328 | int ret; |
5b435de0 | 329 | |
05f3820b | 330 | /* process and remove protocol-specific header */ |
c462ebcd | 331 | ret = brcmf_proto_hdrpull(drvr, true, skb, ifp); |
a43af515 | 332 | |
c462ebcd | 333 | if (ret || !(*ifp) || !(*ifp)->ndev) { |
81542fac | 334 | if (ret != -ENODATA && *ifp) |
c462ebcd | 335 | (*ifp)->stats.rx_errors++; |
05f3820b | 336 | brcmu_pkt_buf_free_skb(skb); |
c462ebcd | 337 | return -ENODATA; |
5b435de0 | 338 | } |
05f3820b | 339 | |
c462ebcd AS |
340 | skb->protocol = eth_type_trans(skb, (*ifp)->ndev); |
341 | return 0; | |
342 | } | |
343 | ||
344 | void brcmf_rx_frame(struct device *dev, struct sk_buff *skb, bool handle_event) | |
345 | { | |
346 | struct brcmf_if *ifp; | |
347 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); | |
348 | struct brcmf_pub *drvr = bus_if->drvr; | |
349 | ||
350 | brcmf_dbg(DATA, "Enter: %s: rxp=%p\n", dev_name(dev), skb); | |
351 | ||
352 | if (brcmf_rx_hdrpull(drvr, skb, &ifp)) | |
353 | return; | |
9c349892 AS |
354 | |
355 | if (brcmf_proto_is_reorder_skb(skb)) { | |
bbd1f932 | 356 | brcmf_proto_rxreorder(ifp, skb); |
9c349892 AS |
357 | } else { |
358 | /* Process special event packets */ | |
359 | if (handle_event) | |
360 | brcmf_fweh_process_skb(ifp->drvr, skb); | |
361 | ||
362 | brcmf_netif_rx(ifp, skb); | |
363 | } | |
c56caa9d FL |
364 | } |
365 | ||
366 | void brcmf_rx_event(struct device *dev, struct sk_buff *skb) | |
367 | { | |
368 | struct brcmf_if *ifp; | |
369 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); | |
370 | struct brcmf_pub *drvr = bus_if->drvr; | |
c56caa9d FL |
371 | |
372 | brcmf_dbg(EVENT, "Enter: %s: rxp=%p\n", dev_name(dev), skb); | |
373 | ||
c462ebcd | 374 | if (brcmf_rx_hdrpull(drvr, skb, &ifp)) |
c56caa9d | 375 | return; |
c56caa9d FL |
376 | |
377 | brcmf_fweh_process_skb(ifp->drvr, skb); | |
378 | brcmu_pkt_buf_free_skb(skb); | |
5b435de0 AS |
379 | } |
380 | ||
054e68ad | 381 | void brcmf_txfinalize(struct brcmf_if *ifp, struct sk_buff *txp, bool success) |
5b435de0 | 382 | { |
5b435de0 AS |
383 | struct ethhdr *eh; |
384 | u16 type; | |
5b435de0 | 385 | |
53e30ea4 HM |
386 | eh = (struct ethhdr *)(txp->data); |
387 | type = ntohs(eh->h_proto); | |
5b435de0 | 388 | |
53e30ea4 HM |
389 | if (type == ETH_P_PAE) { |
390 | atomic_dec(&ifp->pend_8021x_cnt); | |
391 | if (waitqueue_active(&ifp->pend_8021x_wait)) | |
392 | wake_up(&ifp->pend_8021x_wait); | |
21fff75d | 393 | } |
53e30ea4 | 394 | |
b1a2a411 HM |
395 | if (!success) |
396 | ifp->stats.tx_errors++; | |
054e68ad | 397 | |
3edc1cff | 398 | brcmu_pkt_buf_free_skb(txp); |
c7f34a69 | 399 | } |
7f4bceec | 400 | |
c7f34a69 AS |
401 | void brcmf_txcomplete(struct device *dev, struct sk_buff *txp, bool success) |
402 | { | |
403 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); | |
404 | struct brcmf_pub *drvr = bus_if->drvr; | |
796cfb65 | 405 | struct brcmf_if *ifp; |
c7f34a69 | 406 | |
0f8b5cc5 AS |
407 | /* await txstatus signal for firmware if active */ |
408 | if (brcmf_fws_fc_active(drvr->fws)) { | |
409 | if (!success) | |
410 | brcmf_fws_bustxfail(drvr->fws, txp); | |
411 | } else { | |
796cfb65 | 412 | if (brcmf_proto_hdrpull(drvr, false, txp, &ifp)) |
53e30ea4 HM |
413 | brcmu_pkt_buf_free_skb(txp); |
414 | else | |
054e68ad | 415 | brcmf_txfinalize(ifp, txp, success); |
0f8b5cc5 | 416 | } |
5b435de0 AS |
417 | } |
418 | ||
419 | static struct net_device_stats *brcmf_netdev_get_stats(struct net_device *ndev) | |
420 | { | |
e1b83586 | 421 | struct brcmf_if *ifp = netdev_priv(ndev); |
5b435de0 | 422 | |
37a869ec | 423 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d\n", ifp->bsscfgidx); |
5b435de0 AS |
424 | |
425 | return &ifp->stats; | |
426 | } | |
427 | ||
5b435de0 AS |
428 | static void brcmf_ethtool_get_drvinfo(struct net_device *ndev, |
429 | struct ethtool_drvinfo *info) | |
430 | { | |
e1b83586 | 431 | struct brcmf_if *ifp = netdev_priv(ndev); |
d08b6a37 | 432 | struct brcmf_pub *drvr = ifp->drvr; |
7f52c81d | 433 | char drev[BRCMU_DOTREV_LEN] = "n/a"; |
5b435de0 | 434 | |
7f52c81d AS |
435 | if (drvr->revinfo.result == 0) |
436 | brcmu_dotrev_str(drvr->revinfo.driverrev, drev); | |
7826d43f | 437 | strlcpy(info->driver, KBUILD_MODNAME, sizeof(info->driver)); |
7f52c81d | 438 | strlcpy(info->version, drev, sizeof(info->version)); |
55685b8f | 439 | strlcpy(info->fw_version, drvr->fwver, sizeof(info->fw_version)); |
7826d43f JP |
440 | strlcpy(info->bus_info, dev_name(drvr->bus_if->dev), |
441 | sizeof(info->bus_info)); | |
5b435de0 AS |
442 | } |
443 | ||
3eb1fa7e SH |
444 | static const struct ethtool_ops brcmf_ethtool_ops = { |
445 | .get_drvinfo = brcmf_ethtool_get_drvinfo, | |
5b435de0 AS |
446 | }; |
447 | ||
5b435de0 AS |
448 | static int brcmf_netdev_stop(struct net_device *ndev) |
449 | { | |
e1b83586 | 450 | struct brcmf_if *ifp = netdev_priv(ndev); |
817b178c | 451 | |
37a869ec | 452 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d\n", ifp->bsscfgidx); |
5b435de0 | 453 | |
bdf5ff51 | 454 | brcmf_cfg80211_down(ndev); |
817b178c | 455 | |
44129ed0 FL |
456 | brcmf_fil_iovar_data_set(ifp, "arp_hostip_clear", NULL, 0); |
457 | ||
92121e69 | 458 | brcmf_net_setcarrier(ifp, false); |
5b435de0 AS |
459 | |
460 | return 0; | |
461 | } | |
462 | ||
463 | static int brcmf_netdev_open(struct net_device *ndev) | |
464 | { | |
e1b83586 | 465 | struct brcmf_if *ifp = netdev_priv(ndev); |
d08b6a37 | 466 | struct brcmf_pub *drvr = ifp->drvr; |
1bb1f384 | 467 | struct brcmf_bus *bus_if = drvr->bus_if; |
5b435de0 | 468 | u32 toe_ol; |
5b435de0 | 469 | |
37a869ec | 470 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d\n", ifp->bsscfgidx); |
5b435de0 | 471 | |
bdf5ff51 | 472 | /* If bus is not ready, can't continue */ |
a1cee865 | 473 | if (bus_if->state != BRCMF_BUS_UP) { |
5e8149f5 | 474 | brcmf_err("failed bus is not ready\n"); |
bdf5ff51 AS |
475 | return -EAGAIN; |
476 | } | |
1bb1f384 | 477 | |
10ef7321 | 478 | atomic_set(&ifp->pend_8021x_cnt, 0); |
5b435de0 | 479 | |
bdf5ff51 AS |
480 | /* Get current TOE mode from dongle */ |
481 | if (brcmf_fil_iovar_int_get(ifp, "toe_ol", &toe_ol) >= 0 | |
482 | && (toe_ol & TOE_TX_CSUM_OL) != 0) | |
40a23296 | 483 | ndev->features |= NETIF_F_IP_CSUM; |
bdf5ff51 | 484 | else |
40a23296 | 485 | ndev->features &= ~NETIF_F_IP_CSUM; |
3338084a | 486 | |
bdf5ff51 | 487 | if (brcmf_cfg80211_up(ndev)) { |
5e8149f5 | 488 | brcmf_err("failed to bring up cfg80211\n"); |
dcede4b8 | 489 | return -EIO; |
5b435de0 AS |
490 | } |
491 | ||
92121e69 HM |
492 | /* Clear, carrier, set when connected or AP mode. */ |
493 | netif_carrier_off(ndev); | |
dcede4b8 | 494 | return 0; |
5b435de0 AS |
495 | } |
496 | ||
dfded557 FL |
497 | static const struct net_device_ops brcmf_netdev_ops_pri = { |
498 | .ndo_open = brcmf_netdev_open, | |
499 | .ndo_stop = brcmf_netdev_stop, | |
500 | .ndo_get_stats = brcmf_netdev_get_stats, | |
dfded557 FL |
501 | .ndo_start_xmit = brcmf_netdev_start_xmit, |
502 | .ndo_set_mac_address = brcmf_netdev_set_mac_address, | |
503 | .ndo_set_rx_mode = brcmf_netdev_set_multicast_list | |
504 | }; | |
505 | ||
28c14f4a | 506 | int brcmf_net_attach(struct brcmf_if *ifp, bool rtnl_locked) |
75c49904 | 507 | { |
3625c149 | 508 | struct brcmf_pub *drvr = ifp->drvr; |
75c49904 | 509 | struct net_device *ndev; |
28c14f4a | 510 | s32 err; |
75c49904 | 511 | |
37a869ec | 512 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d mac=%pM\n", ifp->bsscfgidx, |
94889b1f | 513 | ifp->mac_addr); |
bdf5ff51 | 514 | ndev = ifp->ndev; |
75c49904 | 515 | |
bdf5ff51 | 516 | /* set appropriate operations */ |
2fde59d9 | 517 | ndev->netdev_ops = &brcmf_netdev_ops_pri; |
75c49904 | 518 | |
cb39288f | 519 | ndev->needed_headroom += drvr->hdrlen; |
75c49904 AS |
520 | ndev->ethtool_ops = &brcmf_ethtool_ops; |
521 | ||
522 | drvr->rxsz = ndev->mtu + ndev->hard_header_len + | |
523 | drvr->hdrlen; | |
524 | ||
0b63cb71 AS |
525 | /* set the mac address */ |
526 | memcpy(ndev->dev_addr, ifp->mac_addr, ETH_ALEN); | |
75c49904 | 527 | |
2fde59d9 HM |
528 | INIT_WORK(&ifp->setmacaddr_work, _brcmf_set_mac_address); |
529 | INIT_WORK(&ifp->multicast_work, _brcmf_set_multicast_list); | |
52f22fb2 | 530 | INIT_WORK(&ifp->ndoffload_work, _brcmf_update_ndtable); |
2fde59d9 | 531 | |
28c14f4a HM |
532 | if (rtnl_locked) |
533 | err = register_netdevice(ndev); | |
534 | else | |
535 | err = register_netdev(ndev); | |
536 | if (err != 0) { | |
5e8149f5 | 537 | brcmf_err("couldn't register the net device\n"); |
75c49904 AS |
538 | goto fail; |
539 | } | |
540 | ||
541 | brcmf_dbg(INFO, "%s: Broadcom Dongle Host Driver\n", ndev->name); | |
75c49904 AS |
542 | return 0; |
543 | ||
544 | fail: | |
37a869ec | 545 | drvr->iflist[ifp->bsscfgidx] = NULL; |
75c49904 | 546 | ndev->netdev_ops = NULL; |
9390ace9 | 547 | free_netdev(ndev); |
75c49904 AS |
548 | return -EBADE; |
549 | } | |
550 | ||
b50ddfa8 | 551 | static void brcmf_net_detach(struct net_device *ndev, bool rtnl_locked) |
95ef1239 | 552 | { |
b50ddfa8 RM |
553 | if (ndev->reg_state == NETREG_REGISTERED) { |
554 | if (rtnl_locked) | |
555 | unregister_netdevice(ndev); | |
556 | else | |
557 | unregister_netdev(ndev); | |
558 | } else { | |
95ef1239 | 559 | brcmf_cfg80211_free_netdev(ndev); |
b50ddfa8 | 560 | } |
95ef1239 AS |
561 | } |
562 | ||
92121e69 HM |
563 | void brcmf_net_setcarrier(struct brcmf_if *ifp, bool on) |
564 | { | |
565 | struct net_device *ndev; | |
566 | ||
37a869ec HM |
567 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d carrier=%d\n", ifp->bsscfgidx, |
568 | on); | |
92121e69 HM |
569 | |
570 | ndev = ifp->ndev; | |
571 | brcmf_txflowblock_if(ifp, BRCMF_NETIF_STOP_REASON_DISCONNECTED, !on); | |
572 | if (on) { | |
573 | if (!netif_carrier_ok(ndev)) | |
574 | netif_carrier_on(ndev); | |
575 | ||
576 | } else { | |
577 | if (netif_carrier_ok(ndev)) | |
578 | netif_carrier_off(ndev); | |
579 | } | |
580 | } | |
581 | ||
2fde59d9 HM |
582 | static int brcmf_net_p2p_open(struct net_device *ndev) |
583 | { | |
584 | brcmf_dbg(TRACE, "Enter\n"); | |
585 | ||
586 | return brcmf_cfg80211_up(ndev); | |
587 | } | |
588 | ||
589 | static int brcmf_net_p2p_stop(struct net_device *ndev) | |
590 | { | |
591 | brcmf_dbg(TRACE, "Enter\n"); | |
592 | ||
593 | return brcmf_cfg80211_down(ndev); | |
594 | } | |
595 | ||
2fde59d9 HM |
596 | static netdev_tx_t brcmf_net_p2p_start_xmit(struct sk_buff *skb, |
597 | struct net_device *ndev) | |
598 | { | |
599 | if (skb) | |
600 | dev_kfree_skb_any(skb); | |
601 | ||
602 | return NETDEV_TX_OK; | |
603 | } | |
604 | ||
605 | static const struct net_device_ops brcmf_netdev_ops_p2p = { | |
606 | .ndo_open = brcmf_net_p2p_open, | |
607 | .ndo_stop = brcmf_net_p2p_stop, | |
2fde59d9 HM |
608 | .ndo_start_xmit = brcmf_net_p2p_start_xmit |
609 | }; | |
610 | ||
611 | static int brcmf_net_p2p_attach(struct brcmf_if *ifp) | |
612 | { | |
613 | struct net_device *ndev; | |
614 | ||
37a869ec | 615 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d mac=%pM\n", ifp->bsscfgidx, |
2fde59d9 HM |
616 | ifp->mac_addr); |
617 | ndev = ifp->ndev; | |
618 | ||
619 | ndev->netdev_ops = &brcmf_netdev_ops_p2p; | |
620 | ||
621 | /* set the mac address */ | |
622 | memcpy(ndev->dev_addr, ifp->mac_addr, ETH_ALEN); | |
623 | ||
624 | if (register_netdev(ndev) != 0) { | |
625 | brcmf_err("couldn't register the p2p net device\n"); | |
626 | goto fail; | |
627 | } | |
628 | ||
629 | brcmf_dbg(INFO, "%s: Broadcom Dongle Host Driver\n", ndev->name); | |
630 | ||
631 | return 0; | |
632 | ||
633 | fail: | |
37a869ec | 634 | ifp->drvr->iflist[ifp->bsscfgidx] = NULL; |
9390ace9 AS |
635 | ndev->netdev_ops = NULL; |
636 | free_netdev(ndev); | |
2fde59d9 HM |
637 | return -EBADE; |
638 | } | |
639 | ||
37a869ec | 640 | struct brcmf_if *brcmf_add_if(struct brcmf_pub *drvr, s32 bsscfgidx, s32 ifidx, |
54264e7e | 641 | bool is_p2pdev, const char *name, u8 *mac_addr) |
5b435de0 AS |
642 | { |
643 | struct brcmf_if *ifp; | |
e1b83586 | 644 | struct net_device *ndev; |
5b435de0 | 645 | |
37a869ec | 646 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d, ifidx=%d\n", bsscfgidx, ifidx); |
5b435de0 | 647 | |
37a869ec | 648 | ifp = drvr->iflist[bsscfgidx]; |
e1b83586 FL |
649 | /* |
650 | * Delete the existing interface before overwriting it | |
651 | * in case we missed the BRCMF_E_IF_DEL event. | |
652 | */ | |
653 | if (ifp) { | |
b522dd80 | 654 | if (ifidx) { |
6a23863e HM |
655 | brcmf_err("ERROR: netdev:%s already exists\n", |
656 | ifp->ndev->name); | |
b522dd80 | 657 | netif_stop_queue(ifp->ndev); |
b50ddfa8 | 658 | brcmf_net_detach(ifp->ndev, false); |
37a869ec | 659 | drvr->iflist[bsscfgidx] = NULL; |
b522dd80 | 660 | } else { |
6a23863e HM |
661 | brcmf_dbg(INFO, "netdev:%s ignore IF event\n", |
662 | ifp->ndev->name); | |
b522dd80 AS |
663 | return ERR_PTR(-EINVAL); |
664 | } | |
15d45b6f | 665 | } |
5b435de0 | 666 | |
7d34b056 | 667 | if (!drvr->settings->p2p_enable && is_p2pdev) { |
01b8e7db AS |
668 | /* this is P2P_DEVICE interface */ |
669 | brcmf_dbg(INFO, "allocate non-netdev interface\n"); | |
670 | ifp = kzalloc(sizeof(*ifp), GFP_KERNEL); | |
991c2093 AS |
671 | if (!ifp) |
672 | return ERR_PTR(-ENOMEM); | |
01b8e7db AS |
673 | } else { |
674 | brcmf_dbg(INFO, "allocate netdev interface\n"); | |
675 | /* Allocate netdev, including space for private structure */ | |
2b76acdb HM |
676 | ndev = alloc_netdev(sizeof(*ifp), is_p2pdev ? "p2p%d" : name, |
677 | NET_NAME_UNKNOWN, ether_setup); | |
a652bf03 | 678 | if (!ndev) |
01b8e7db | 679 | return ERR_PTR(-ENOMEM); |
01b8e7db | 680 | |
95ef1239 | 681 | ndev->destructor = brcmf_cfg80211_free_netdev; |
01b8e7db AS |
682 | ifp = netdev_priv(ndev); |
683 | ifp->ndev = ndev; | |
37a869ec | 684 | /* store mapping ifidx to bsscfgidx */ |
6ea696eb | 685 | if (drvr->if2bss[ifidx] == BRCMF_BSSIDX_INVALID) |
37a869ec | 686 | drvr->if2bss[ifidx] = bsscfgidx; |
15d45b6f | 687 | } |
5b435de0 | 688 | |
d08b6a37 | 689 | ifp->drvr = drvr; |
37a869ec | 690 | drvr->iflist[bsscfgidx] = ifp; |
2880b868 | 691 | ifp->ifidx = ifidx; |
37a869ec | 692 | ifp->bsscfgidx = bsscfgidx; |
bdf5ff51 | 693 | |
10ef7321 | 694 | init_waitqueue_head(&ifp->pend_8021x_wait); |
df50f756 | 695 | spin_lock_init(&ifp->netif_stop_lock); |
10ef7321 | 696 | |
2880b868 HM |
697 | if (mac_addr != NULL) |
698 | memcpy(ifp->mac_addr, mac_addr, ETH_ALEN); | |
5b435de0 | 699 | |
9bcb74f9 | 700 | brcmf_dbg(TRACE, " ==== pid:%x, if:%s (%pM) created ===\n", |
01b8e7db | 701 | current->pid, name, ifp->mac_addr); |
5b435de0 | 702 | |
1ed9baf0 | 703 | return ifp; |
5b435de0 AS |
704 | } |
705 | ||
b50ddfa8 RM |
706 | static void brcmf_del_if(struct brcmf_pub *drvr, s32 bsscfgidx, |
707 | bool rtnl_locked) | |
5b435de0 AS |
708 | { |
709 | struct brcmf_if *ifp; | |
710 | ||
37a869ec HM |
711 | ifp = drvr->iflist[bsscfgidx]; |
712 | drvr->iflist[bsscfgidx] = NULL; | |
5b435de0 | 713 | if (!ifp) { |
37a869ec | 714 | brcmf_err("Null interface, bsscfgidx=%d\n", bsscfgidx); |
5b435de0 AS |
715 | return; |
716 | } | |
37a869ec HM |
717 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d, ifidx=%d\n", bsscfgidx, |
718 | ifp->ifidx); | |
719 | if (drvr->if2bss[ifp->ifidx] == bsscfgidx) | |
6ea696eb | 720 | drvr->if2bss[ifp->ifidx] = BRCMF_BSSIDX_INVALID; |
dfded557 | 721 | if (ifp->ndev) { |
37a869ec | 722 | if (bsscfgidx == 0) { |
dfded557 FL |
723 | if (ifp->ndev->netdev_ops == &brcmf_netdev_ops_pri) { |
724 | rtnl_lock(); | |
725 | brcmf_netdev_stop(ifp->ndev); | |
726 | rtnl_unlock(); | |
727 | } | |
728 | } else { | |
729 | netif_stop_queue(ifp->ndev); | |
730 | } | |
731 | ||
2fde59d9 HM |
732 | if (ifp->ndev->netdev_ops == &brcmf_netdev_ops_pri) { |
733 | cancel_work_sync(&ifp->setmacaddr_work); | |
734 | cancel_work_sync(&ifp->multicast_work); | |
52f22fb2 | 735 | cancel_work_sync(&ifp->ndoffload_work); |
2fde59d9 | 736 | } |
b50ddfa8 | 737 | brcmf_net_detach(ifp->ndev, rtnl_locked); |
9831bcb9 HM |
738 | } else { |
739 | /* Only p2p device interfaces which get dynamically created | |
740 | * end up here. In this case the p2p module should be informed | |
741 | * about the removal of the interface within the firmware. If | |
742 | * not then p2p commands towards the firmware will cause some | |
743 | * serious troublesome side effects. The p2p module will clean | |
744 | * up the ifp if needed. | |
745 | */ | |
15dacf88 | 746 | brcmf_p2p_ifp_removed(ifp, rtnl_locked); |
9831bcb9 | 747 | kfree(ifp); |
5b435de0 AS |
748 | } |
749 | } | |
750 | ||
b50ddfa8 | 751 | void brcmf_remove_interface(struct brcmf_if *ifp, bool rtnl_locked) |
a44aa400 | 752 | { |
37a869ec | 753 | if (!ifp || WARN_ON(ifp->drvr->iflist[ifp->bsscfgidx] != ifp)) |
ee6e3a34 | 754 | return; |
37a869ec | 755 | brcmf_dbg(TRACE, "Enter, bsscfgidx=%d, ifidx=%d\n", ifp->bsscfgidx, |
9831bcb9 | 756 | ifp->ifidx); |
ee6e3a34 | 757 | brcmf_fws_del_interface(ifp); |
b50ddfa8 | 758 | brcmf_del_if(ifp->drvr, ifp->bsscfgidx, rtnl_locked); |
a44aa400 HM |
759 | } |
760 | ||
44129ed0 FL |
761 | #ifdef CONFIG_INET |
762 | #define ARPOL_MAX_ENTRIES 8 | |
763 | static int brcmf_inetaddr_changed(struct notifier_block *nb, | |
764 | unsigned long action, void *data) | |
765 | { | |
766 | struct brcmf_pub *drvr = container_of(nb, struct brcmf_pub, | |
767 | inetaddr_notifier); | |
768 | struct in_ifaddr *ifa = data; | |
769 | struct net_device *ndev = ifa->ifa_dev->dev; | |
770 | struct brcmf_if *ifp; | |
771 | int idx, i, ret; | |
772 | u32 val; | |
773 | __be32 addr_table[ARPOL_MAX_ENTRIES] = {0}; | |
774 | ||
775 | /* Find out if the notification is meant for us */ | |
776 | for (idx = 0; idx < BRCMF_MAX_IFS; idx++) { | |
777 | ifp = drvr->iflist[idx]; | |
778 | if (ifp && ifp->ndev == ndev) | |
779 | break; | |
780 | if (idx == BRCMF_MAX_IFS - 1) | |
781 | return NOTIFY_DONE; | |
782 | } | |
783 | ||
784 | /* check if arp offload is supported */ | |
785 | ret = brcmf_fil_iovar_int_get(ifp, "arpoe", &val); | |
786 | if (ret) | |
787 | return NOTIFY_OK; | |
788 | ||
789 | /* old version only support primary index */ | |
790 | ret = brcmf_fil_iovar_int_get(ifp, "arp_version", &val); | |
791 | if (ret) | |
792 | val = 1; | |
793 | if (val == 1) | |
794 | ifp = drvr->iflist[0]; | |
795 | ||
796 | /* retrieve the table from firmware */ | |
797 | ret = brcmf_fil_iovar_data_get(ifp, "arp_hostip", addr_table, | |
798 | sizeof(addr_table)); | |
799 | if (ret) { | |
800 | brcmf_err("fail to get arp ip table err:%d\n", ret); | |
801 | return NOTIFY_OK; | |
802 | } | |
803 | ||
804 | for (i = 0; i < ARPOL_MAX_ENTRIES; i++) | |
805 | if (ifa->ifa_address == addr_table[i]) | |
806 | break; | |
807 | ||
808 | switch (action) { | |
809 | case NETDEV_UP: | |
810 | if (i == ARPOL_MAX_ENTRIES) { | |
811 | brcmf_dbg(TRACE, "add %pI4 to arp table\n", | |
812 | &ifa->ifa_address); | |
813 | /* set it directly */ | |
814 | ret = brcmf_fil_iovar_data_set(ifp, "arp_hostip", | |
815 | &ifa->ifa_address, sizeof(ifa->ifa_address)); | |
816 | if (ret) | |
817 | brcmf_err("add arp ip err %d\n", ret); | |
818 | } | |
819 | break; | |
820 | case NETDEV_DOWN: | |
821 | if (i < ARPOL_MAX_ENTRIES) { | |
822 | addr_table[i] = 0; | |
823 | brcmf_dbg(TRACE, "remove %pI4 from arp table\n", | |
824 | &ifa->ifa_address); | |
825 | /* clear the table in firmware */ | |
826 | ret = brcmf_fil_iovar_data_set(ifp, "arp_hostip_clear", | |
827 | NULL, 0); | |
828 | if (ret) { | |
829 | brcmf_err("fail to clear arp ip table err:%d\n", | |
830 | ret); | |
831 | return NOTIFY_OK; | |
832 | } | |
833 | for (i = 0; i < ARPOL_MAX_ENTRIES; i++) { | |
cd2bc19c FL |
834 | if (addr_table[i] == 0) |
835 | continue; | |
836 | ret = brcmf_fil_iovar_data_set(ifp, "arp_hostip", | |
837 | &addr_table[i], | |
838 | sizeof(addr_table[i])); | |
839 | if (ret) | |
840 | brcmf_err("add arp ip err %d\n", | |
841 | ret); | |
44129ed0 FL |
842 | } |
843 | } | |
844 | break; | |
845 | default: | |
846 | break; | |
847 | } | |
848 | ||
849 | return NOTIFY_OK; | |
850 | } | |
851 | #endif | |
852 | ||
52f22fb2 FL |
853 | #if IS_ENABLED(CONFIG_IPV6) |
854 | static int brcmf_inet6addr_changed(struct notifier_block *nb, | |
855 | unsigned long action, void *data) | |
856 | { | |
857 | struct brcmf_pub *drvr = container_of(nb, struct brcmf_pub, | |
858 | inet6addr_notifier); | |
859 | struct inet6_ifaddr *ifa = data; | |
860 | struct brcmf_if *ifp; | |
861 | int i; | |
862 | struct in6_addr *table; | |
863 | ||
864 | /* Only handle primary interface */ | |
865 | ifp = drvr->iflist[0]; | |
866 | if (!ifp) | |
867 | return NOTIFY_DONE; | |
868 | if (ifp->ndev != ifa->idev->dev) | |
869 | return NOTIFY_DONE; | |
870 | ||
871 | table = ifp->ipv6_addr_tbl; | |
872 | for (i = 0; i < NDOL_MAX_ENTRIES; i++) | |
873 | if (ipv6_addr_equal(&ifa->addr, &table[i])) | |
874 | break; | |
875 | ||
876 | switch (action) { | |
877 | case NETDEV_UP: | |
878 | if (i == NDOL_MAX_ENTRIES) { | |
879 | if (ifp->ipv6addr_idx < NDOL_MAX_ENTRIES) { | |
880 | table[ifp->ipv6addr_idx++] = ifa->addr; | |
881 | } else { | |
882 | for (i = 0; i < NDOL_MAX_ENTRIES - 1; i++) | |
883 | table[i] = table[i + 1]; | |
884 | table[NDOL_MAX_ENTRIES - 1] = ifa->addr; | |
885 | } | |
886 | } | |
887 | break; | |
888 | case NETDEV_DOWN: | |
889 | if (i < NDOL_MAX_ENTRIES) | |
890 | for (; i < ifp->ipv6addr_idx; i++) | |
891 | table[i] = table[i + 1]; | |
892 | break; | |
893 | default: | |
894 | break; | |
895 | } | |
896 | ||
897 | schedule_work(&ifp->ndoffload_work); | |
898 | ||
899 | return NOTIFY_OK; | |
900 | } | |
901 | #endif | |
902 | ||
af5b5e62 | 903 | int brcmf_attach(struct device *dev, struct brcmf_mp_device *settings) |
5b435de0 | 904 | { |
d08b6a37 | 905 | struct brcmf_pub *drvr = NULL; |
712ac5b3 | 906 | int ret = 0; |
6ea696eb | 907 | int i; |
5b435de0 AS |
908 | |
909 | brcmf_dbg(TRACE, "Enter\n"); | |
910 | ||
5b435de0 | 911 | /* Allocate primary brcmf_info */ |
d08b6a37 FL |
912 | drvr = kzalloc(sizeof(struct brcmf_pub), GFP_ATOMIC); |
913 | if (!drvr) | |
712ac5b3 | 914 | return -ENOMEM; |
5b435de0 | 915 | |
6ea696eb HM |
916 | for (i = 0; i < ARRAY_SIZE(drvr->if2bss); i++) |
917 | drvr->if2bss[i] = BRCMF_BSSIDX_INVALID; | |
918 | ||
d08b6a37 | 919 | mutex_init(&drvr->proto_block); |
5b435de0 AS |
920 | |
921 | /* Link to bus module */ | |
8dee77ba | 922 | drvr->hdrlen = 0; |
d08b6a37 | 923 | drvr->bus_if = dev_get_drvdata(dev); |
55a63bcc | 924 | drvr->bus_if->drvr = drvr; |
af5b5e62 | 925 | drvr->settings = settings; |
7d34b056 | 926 | |
ff4445a8 AS |
927 | /* attach debug facilities */ |
928 | brcmf_debug_attach(drvr); | |
d319a7cf | 929 | |
5b435de0 | 930 | /* Attach and link in the protocol */ |
712ac5b3 FL |
931 | ret = brcmf_proto_attach(drvr); |
932 | if (ret != 0) { | |
5e8149f5 | 933 | brcmf_err("brcmf_prot_attach failed\n"); |
5b435de0 AS |
934 | goto fail; |
935 | } | |
936 | ||
5c36b99a AS |
937 | /* attach firmware event handler */ |
938 | brcmf_fweh_attach(drvr); | |
939 | ||
712ac5b3 | 940 | return ret; |
5b435de0 AS |
941 | |
942 | fail: | |
712ac5b3 | 943 | brcmf_detach(dev); |
5b435de0 | 944 | |
712ac5b3 | 945 | return ret; |
5b435de0 AS |
946 | } |
947 | ||
c7cd5d27 AS |
948 | static int brcmf_revinfo_read(struct seq_file *s, void *data) |
949 | { | |
950 | struct brcmf_bus *bus_if = dev_get_drvdata(s->private); | |
951 | struct brcmf_rev_info *ri = &bus_if->drvr->revinfo; | |
952 | char drev[BRCMU_DOTREV_LEN]; | |
953 | char brev[BRCMU_BOARDREV_LEN]; | |
954 | ||
955 | seq_printf(s, "vendorid: 0x%04x\n", ri->vendorid); | |
956 | seq_printf(s, "deviceid: 0x%04x\n", ri->deviceid); | |
957 | seq_printf(s, "radiorev: %s\n", brcmu_dotrev_str(ri->radiorev, drev)); | |
958 | seq_printf(s, "chipnum: %u (%x)\n", ri->chipnum, ri->chipnum); | |
959 | seq_printf(s, "chiprev: %u\n", ri->chiprev); | |
960 | seq_printf(s, "chippkg: %u\n", ri->chippkg); | |
961 | seq_printf(s, "corerev: %u\n", ri->corerev); | |
962 | seq_printf(s, "boardid: 0x%04x\n", ri->boardid); | |
963 | seq_printf(s, "boardvendor: 0x%04x\n", ri->boardvendor); | |
964 | seq_printf(s, "boardrev: %s\n", brcmu_boardrev_str(ri->boardrev, brev)); | |
965 | seq_printf(s, "driverrev: %s\n", brcmu_dotrev_str(ri->driverrev, drev)); | |
966 | seq_printf(s, "ucoderev: %u\n", ri->ucoderev); | |
967 | seq_printf(s, "bus: %u\n", ri->bus); | |
968 | seq_printf(s, "phytype: %u\n", ri->phytype); | |
969 | seq_printf(s, "phyrev: %u\n", ri->phyrev); | |
970 | seq_printf(s, "anarev: %u\n", ri->anarev); | |
971 | seq_printf(s, "nvramrev: %08x\n", ri->nvramrev); | |
972 | ||
973 | return 0; | |
974 | } | |
975 | ||
ed683c98 | 976 | int brcmf_bus_start(struct device *dev) |
5b435de0 AS |
977 | { |
978 | int ret = -1; | |
ed683c98 FL |
979 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
980 | struct brcmf_pub *drvr = bus_if->drvr; | |
1ed9baf0 | 981 | struct brcmf_if *ifp; |
2fde59d9 | 982 | struct brcmf_if *p2p_ifp; |
5b435de0 AS |
983 | |
984 | brcmf_dbg(TRACE, "\n"); | |
985 | ||
1ed9baf0 | 986 | /* add primary networking interface */ |
ddddfed2 | 987 | ifp = brcmf_add_if(drvr, 0, 0, false, "wlan%d", NULL); |
1ed9baf0 AS |
988 | if (IS_ERR(ifp)) |
989 | return PTR_ERR(ifp); | |
990 | ||
2b76acdb | 991 | p2p_ifp = NULL; |
2fde59d9 | 992 | |
0af29bf7 | 993 | /* signal bus ready */ |
a1cee865 | 994 | brcmf_bus_change_state(bus_if, BRCMF_BUS_UP); |
0af29bf7 HM |
995 | |
996 | /* Bus is ready, do any initialization */ | |
997 | ret = brcmf_c_preinit_dcmds(ifp); | |
5b435de0 | 998 | if (ret < 0) |
6b028c5e | 999 | goto fail; |
5b435de0 | 1000 | |
c7cd5d27 AS |
1001 | brcmf_debugfs_add_entry(drvr, "revinfo", brcmf_revinfo_read); |
1002 | ||
9b1933a3 AS |
1003 | /* assure we have chipid before feature attach */ |
1004 | if (!bus_if->chip) { | |
48622903 AS |
1005 | bus_if->chip = drvr->revinfo.chipnum; |
1006 | bus_if->chiprev = drvr->revinfo.chiprev; | |
1007 | brcmf_dbg(INFO, "firmware revinfo: chip %x (%d) rev %d\n", | |
1008 | bus_if->chip, bus_if->chip, bus_if->chiprev); | |
9b1933a3 | 1009 | } |
c08437b4 AS |
1010 | brcmf_feat_attach(drvr); |
1011 | ||
a786b38d AS |
1012 | ret = brcmf_fws_init(drvr); |
1013 | if (ret < 0) | |
1014 | goto fail; | |
1015 | ||
bb8c8063 | 1016 | brcmf_fws_add_interface(ifp); |
349e7104 | 1017 | |
ae7c03f6 | 1018 | drvr->config = brcmf_cfg80211_attach(drvr, bus_if->dev, |
7d34b056 | 1019 | drvr->settings->p2p_enable); |
6b028c5e HM |
1020 | if (drvr->config == NULL) { |
1021 | ret = -ENOMEM; | |
1022 | goto fail; | |
1023 | } | |
1ed9baf0 | 1024 | |
28c14f4a | 1025 | ret = brcmf_net_attach(ifp, false); |
2b76acdb | 1026 | |
7d34b056 | 1027 | if ((!ret) && (drvr->settings->p2p_enable)) { |
2b76acdb HM |
1028 | p2p_ifp = drvr->iflist[1]; |
1029 | if (p2p_ifp) | |
1030 | ret = brcmf_net_p2p_attach(p2p_ifp); | |
1031 | } | |
44129ed0 FL |
1032 | |
1033 | if (ret) | |
1034 | goto fail; | |
1035 | ||
1036 | #ifdef CONFIG_INET | |
1037 | drvr->inetaddr_notifier.notifier_call = brcmf_inetaddr_changed; | |
1038 | ret = register_inetaddr_notifier(&drvr->inetaddr_notifier); | |
52f22fb2 FL |
1039 | if (ret) |
1040 | goto fail; | |
1041 | ||
1042 | #if IS_ENABLED(CONFIG_IPV6) | |
1043 | drvr->inet6addr_notifier.notifier_call = brcmf_inet6addr_changed; | |
1044 | ret = register_inet6addr_notifier(&drvr->inet6addr_notifier); | |
1045 | if (ret) { | |
1046 | unregister_inetaddr_notifier(&drvr->inetaddr_notifier); | |
1047 | goto fail; | |
1048 | } | |
44129ed0 | 1049 | #endif |
52f22fb2 FL |
1050 | #endif /* CONFIG_INET */ |
1051 | ||
1052 | return 0; | |
44129ed0 | 1053 | |
6b028c5e | 1054 | fail: |
52f22fb2 FL |
1055 | brcmf_err("failed: %d\n", ret); |
1056 | if (drvr->config) { | |
1057 | brcmf_cfg80211_detach(drvr->config); | |
1058 | drvr->config = NULL; | |
1ed9baf0 | 1059 | } |
52f22fb2 FL |
1060 | if (drvr->fws) { |
1061 | brcmf_fws_del_interface(ifp); | |
1062 | brcmf_fws_deinit(drvr); | |
1063 | } | |
1064 | if (ifp) | |
b50ddfa8 | 1065 | brcmf_net_detach(ifp->ndev, false); |
52f22fb2 | 1066 | if (p2p_ifp) |
b50ddfa8 | 1067 | brcmf_net_detach(p2p_ifp->ndev, false); |
52f22fb2 FL |
1068 | drvr->iflist[0] = NULL; |
1069 | drvr->iflist[1] = NULL; | |
af5b5e62 | 1070 | if (drvr->settings->ignore_probe_fail) |
52f22fb2 FL |
1071 | ret = 0; |
1072 | ||
1073 | return ret; | |
5b435de0 AS |
1074 | } |
1075 | ||
8dee77ba AS |
1076 | void brcmf_bus_add_txhdrlen(struct device *dev, uint len) |
1077 | { | |
1078 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); | |
1079 | struct brcmf_pub *drvr = bus_if->drvr; | |
1080 | ||
1081 | if (drvr) { | |
1082 | drvr->hdrlen += len; | |
1083 | } | |
1084 | } | |
1085 | ||
5b435de0 AS |
1086 | static void brcmf_bus_detach(struct brcmf_pub *drvr) |
1087 | { | |
5b435de0 AS |
1088 | brcmf_dbg(TRACE, "Enter\n"); |
1089 | ||
1090 | if (drvr) { | |
d08b6a37 | 1091 | /* Stop the bus module */ |
d9cb2596 | 1092 | brcmf_bus_stop(drvr->bus_if); |
5b435de0 AS |
1093 | } |
1094 | } | |
1095 | ||
81d5f1bb AS |
1096 | void brcmf_dev_reset(struct device *dev) |
1097 | { | |
1098 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); | |
1099 | struct brcmf_pub *drvr = bus_if->drvr; | |
1100 | ||
1101 | if (drvr == NULL) | |
1102 | return; | |
1103 | ||
643ecaab HM |
1104 | if (drvr->iflist[0]) |
1105 | brcmf_fil_cmd_int_set(drvr->iflist[0], BRCMF_C_TERMINATED, 1); | |
81d5f1bb AS |
1106 | } |
1107 | ||
5f947ad9 | 1108 | void brcmf_detach(struct device *dev) |
5b435de0 | 1109 | { |
2880b868 | 1110 | s32 i; |
5f947ad9 FL |
1111 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
1112 | struct brcmf_pub *drvr = bus_if->drvr; | |
5b435de0 AS |
1113 | |
1114 | brcmf_dbg(TRACE, "Enter\n"); | |
1115 | ||
817b178c HM |
1116 | if (drvr == NULL) |
1117 | return; | |
5b435de0 | 1118 | |
44129ed0 FL |
1119 | #ifdef CONFIG_INET |
1120 | unregister_inetaddr_notifier(&drvr->inetaddr_notifier); | |
1121 | #endif | |
1122 | ||
52f22fb2 FL |
1123 | #if IS_ENABLED(CONFIG_IPV6) |
1124 | unregister_inet6addr_notifier(&drvr->inet6addr_notifier); | |
1125 | #endif | |
1126 | ||
5c36b99a AS |
1127 | /* stop firmware event handling */ |
1128 | brcmf_fweh_detach(drvr); | |
40b503c7 AS |
1129 | if (drvr->config) |
1130 | brcmf_p2p_detach(&drvr->config->p2p); | |
5c36b99a | 1131 | |
bb350711 AS |
1132 | brcmf_bus_change_state(bus_if, BRCMF_BUS_DOWN); |
1133 | ||
5f947ad9 FL |
1134 | /* make sure primary interface removed last */ |
1135 | for (i = BRCMF_MAX_IFS-1; i > -1; i--) | |
b50ddfa8 | 1136 | brcmf_remove_interface(drvr->iflist[i], false); |
5b435de0 | 1137 | |
e1479951 AS |
1138 | brcmf_cfg80211_detach(drvr->config); |
1139 | ||
05c2c767 HM |
1140 | brcmf_fws_deinit(drvr); |
1141 | ||
5f947ad9 | 1142 | brcmf_bus_detach(drvr); |
5b435de0 | 1143 | |
85b84133 | 1144 | brcmf_proto_detach(drvr); |
5b435de0 | 1145 | |
ff4445a8 | 1146 | brcmf_debug_detach(drvr); |
5f947ad9 FL |
1147 | bus_if->drvr = NULL; |
1148 | kfree(drvr); | |
5b435de0 AS |
1149 | } |
1150 | ||
cf458287 AS |
1151 | s32 brcmf_iovar_data_set(struct device *dev, char *name, void *data, u32 len) |
1152 | { | |
1153 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); | |
1154 | struct brcmf_if *ifp = bus_if->drvr->iflist[0]; | |
1155 | ||
1156 | return brcmf_fil_iovar_data_set(ifp, name, data, len); | |
1157 | } | |
1158 | ||
10ef7321 | 1159 | static int brcmf_get_pend_8021x_cnt(struct brcmf_if *ifp) |
5b435de0 | 1160 | { |
10ef7321 | 1161 | return atomic_read(&ifp->pend_8021x_cnt); |
5b435de0 AS |
1162 | } |
1163 | ||
118eb304 | 1164 | int brcmf_netdev_wait_pend8021x(struct brcmf_if *ifp) |
5b435de0 | 1165 | { |
21fff75d HM |
1166 | int err; |
1167 | ||
10ef7321 HM |
1168 | err = wait_event_timeout(ifp->pend_8021x_wait, |
1169 | !brcmf_get_pend_8021x_cnt(ifp), | |
63ce3d5d | 1170 | MAX_WAIT_FOR_8021X_TX); |
21fff75d HM |
1171 | |
1172 | WARN_ON(!err); | |
1173 | ||
1174 | return !err; | |
5b435de0 AS |
1175 | } |
1176 | ||
649f38ae HM |
1177 | void brcmf_bus_change_state(struct brcmf_bus *bus, enum brcmf_bus_state state) |
1178 | { | |
1179 | struct brcmf_pub *drvr = bus->drvr; | |
1180 | struct net_device *ndev; | |
1181 | int ifidx; | |
1182 | ||
1183 | brcmf_dbg(TRACE, "%d -> %d\n", bus->state, state); | |
1184 | bus->state = state; | |
1185 | ||
1186 | if (state == BRCMF_BUS_UP) { | |
1187 | for (ifidx = 0; ifidx < BRCMF_MAX_IFS; ifidx++) { | |
1188 | if ((drvr->iflist[ifidx]) && | |
1189 | (drvr->iflist[ifidx]->ndev)) { | |
1190 | ndev = drvr->iflist[ifidx]->ndev; | |
1191 | if (netif_queue_stopped(ndev)) | |
1192 | netif_wake_queue(ndev); | |
1193 | } | |
1194 | } | |
1195 | } | |
1196 | } | |
1197 | ||
db4efbbe | 1198 | static void brcmf_driver_register(struct work_struct *work) |
f3d7cdc3 | 1199 | { |
f3d7cdc3 | 1200 | #ifdef CONFIG_BRCMFMAC_SDIO |
db4efbbe | 1201 | brcmf_sdio_register(); |
f3d7cdc3 | 1202 | #endif |
71bb244b | 1203 | #ifdef CONFIG_BRCMFMAC_USB |
db4efbbe | 1204 | brcmf_usb_register(); |
71bb244b | 1205 | #endif |
9e37f045 HM |
1206 | #ifdef CONFIG_BRCMFMAC_PCIE |
1207 | brcmf_pcie_register(); | |
1208 | #endif | |
e64a4b70 | 1209 | } |
db4efbbe | 1210 | static DECLARE_WORK(brcmf_driver_work, brcmf_driver_register); |
e64a4b70 | 1211 | |
d84d99e0 | 1212 | int __init brcmf_core_init(void) |
e64a4b70 AS |
1213 | { |
1214 | if (!schedule_work(&brcmf_driver_work)) | |
1215 | return -EBUSY; | |
1216 | ||
549040ab | 1217 | return 0; |
f3d7cdc3 AS |
1218 | } |
1219 | ||
d84d99e0 | 1220 | void __exit brcmf_core_exit(void) |
f3d7cdc3 | 1221 | { |
e64a4b70 AS |
1222 | cancel_work_sync(&brcmf_driver_work); |
1223 | ||
f3d7cdc3 AS |
1224 | #ifdef CONFIG_BRCMFMAC_SDIO |
1225 | brcmf_sdio_exit(); | |
1226 | #endif | |
71bb244b AS |
1227 | #ifdef CONFIG_BRCMFMAC_USB |
1228 | brcmf_usb_exit(); | |
9e37f045 HM |
1229 | #endif |
1230 | #ifdef CONFIG_BRCMFMAC_PCIE | |
1231 | brcmf_pcie_exit(); | |
71bb244b | 1232 | #endif |
f3d7cdc3 AS |
1233 | } |
1234 |