projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
staging: brcm80211: fix "ERROR: return is not a function, paren..."
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / brcm80211 / sys / wl_mac80211.c
CommitLineData
a9533e7e
HP		 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
17#define __UNDEF_NO_VERSION__
18
19#include <typedefs.h>
20#include <linuxver.h>
21#include <osl.h>
22#include <linux/module.h>
23#include <linux/types.h>
24#include <linux/errno.h>
25#include <linux/pci.h>
26#include <linux/init.h>
27#include <linux/kernel.h>
28#include <linux/netdevice.h>
29#include <linux/etherdevice.h>
30#include <linux/skbuff.h>
31#include <linux/delay.h>
32#include <linux/string.h>
33#include <linux/ethtool.h>
34#include <linux/completion.h>
35#include <linux/pci_ids.h>
36#define WLC_MAXBSSCFG 1 /* single BSS configs */
37
38#include <asm/system.h>
39#include <asm/io.h>
40#include <asm/irq.h>
41#include <asm/pgtable.h>
42#include <asm/uaccess.h>
43#include <asm/unaligned.h>
44#include <wlc_cfg.h>
45#include <net/mac80211.h>
46#include <epivers.h>
47#ifndef WLC_HIGH_ONLY
48#include <phy_version.h>
49#endif
50#include <bcmendian.h>
51#include <bcmutils.h>
52#include <pcicfg.h>
53#include <wlioctl.h>
54#include <wlc_key.h>
55#include <proto/802.1d.h> /* NUMPRIO & BE */
56#include <linux/proc_fs.h>
57#include <linux/vmalloc.h>
58#include <wlc_channel.h>
59#include <wlc_pub.h>
60#include <wlc_scb.h>
61#include <wl_dbg.h>
62#ifdef BCMSDIO
63#include <bcmsdh.h>
64#endif
65#include <wl_export.h>
66#ifdef WLC_HIGH_ONLY
67#include "dbus.h"
68#include "bcm_rpc_tp.h"
69#include "bcm_rpc.h"
70#include "bcm_xdr.h"
71#include "wlc_rpc.h"
72#endif
73
74#include <wl_mac80211.h>
75#include <linux/firmware.h>
76#ifndef WLC_HIGH_ONLY
77#include <wl_ucode.h>
78#include <d11ucode_ext.h>
79#endif
80
81#ifdef BCMSDIO
82extern struct device *sdiommc_dev;
83#endif
84
7cc4a4c0 85extern void wlc_wme_setparams(wlc_info_t *wlc, u16 aci, void *arg,
a9533e7e 86 bool suspend);
7cc4a4c0
JC		 87bool wlc_sendpkt_mac80211(wlc_info_t *wlc, void *sdu, struct ieee80211_hw *hw);
88void wlc_mac_bcn_promisc_change(wlc_info_t *wlc, bool promisc);
89void wlc_set_addrmatch(wlc_info_t *wlc, int match_reg_offset,
a9533e7e
HP		 90 const struct ether_addr *addr);
91
92static void wl_timer(ulong data);
7cc4a4c0 93static void _wl_timer(wl_timer_t *t);
a9533e7e
HP		 94
95/* proc fs */
96static int wl_proc_read(char *buffer, char **start, off_t offset, int length,
97 int *eof, void *data);
7cc4a4c0 98static int wl_proc_write(struct file *filp, const char __user *buff,
a9533e7e
HP		 99 unsigned long len, void *data);
100
101#ifdef WLC_HIGH_ONLY
102#define RPCQ_LOCK(_wl, _flags) spin_lock_irqsave(&(_wl)->rpcq_lock, (_flags))
103#define RPCQ_UNLOCK(_wl, _flags) spin_unlock_irqrestore(&(_wl)->rpcq_lock, (_flags))
104#define TXQ_LOCK(_wl, _flags) spin_lock_irqsave(&(_wl)->txq_lock, (_flags))
105#define TXQ_UNLOCK(_wl, _flags) spin_unlock_irqrestore(&(_wl)->txq_lock, (_flags))
106static void wl_rpc_down(void *wlh);
7cc4a4c0 107static void wl_rpcq_free(wl_info_t *wl);
a9533e7e
HP		 108static void wl_rpcq_dispatch(struct wl_task *task);
109static void wl_rpc_dispatch_schedule(void *ctx, struct rpc_buf *buf);
110static void wl_start_txqwork(struct wl_task *task);
7cc4a4c0
JC		 111static void wl_txq_free(wl_info_t *wl);
112static void wl_timer_task(wl_task_t *task);
113static int wl_schedule_task(wl_info_t *wl, void (*fn) (struct wl_task *),
a9533e7e
HP		 114 void *context);
115#endif /* WLC_HIGH_ONLY */
116
117static int ieee_hw_init(struct ieee80211_hw *hw);
118static int ieee_hw_rate_init(struct ieee80211_hw *hw);
119
120static int wl_linux_watchdog(void *ctx);
121
122/* Flags we support */
123#define MAC_FILTERS (FIF_PROMISC_IN_BSS | \
124 FIF_ALLMULTI | \
125 FIF_FCSFAIL | \
126 FIF_PLCPFAIL | \
127 FIF_CONTROL | \
128 FIF_OTHER_BSS | \
129 FIF_BCN_PRBRESP_PROMISC)
130
131static int wl_found = 0;
132
133struct ieee80211_tkip_data {
134#define TKIP_KEY_LEN 32
135 u8 key[TKIP_KEY_LEN];
136 int key_set;
137
138 u32 tx_iv32;
139 u16 tx_iv16;
140 u16 tx_ttak[5];
141 int tx_phase1_done;
142
143 u32 rx_iv32;
144 u16 rx_iv16;
145 u16 rx_ttak[5];
146 int rx_phase1_done;
147 u32 rx_iv32_new;
148 u16 rx_iv16_new;
149
150 u32 dot11RSNAStatsTKIPReplays;
151 u32 dot11RSNAStatsTKIPICVErrors;
152 u32 dot11RSNAStatsTKIPLocalMICFailures;
153
154 int key_idx;
155
156 struct crypto_tfm *tfm_arc4;
157 struct crypto_tfm *tfm_michael;
158
159 /* scratch buffers for virt_to_page() (crypto API) */
160 u8 rx_hdr[16], tx_hdr[16];
161};
162
163#ifndef WLC_HIGH_ONLY
164#define WL_INFO(dev) ((wl_info_t*)(WL_DEV_IF(dev)->wl)) /* points to wl */
7cc4a4c0
JC		 165static int wl_request_fw(wl_info_t *wl, struct pci_dev *pdev);
166static void wl_release_fw(wl_info_t *wl);
a9533e7e
HP		 167#endif
168
169/* local prototypes */
7cc4a4c0
JC		 170static int wl_start(struct sk_buff *skb, wl_info_t *wl);
171static int wl_start_int(wl_info_t *wl, struct ieee80211_hw *hw,
a9533e7e
HP		 172 struct sk_buff *skb);
173static void wl_dpc(ulong data);
174
175MODULE_AUTHOR("Broadcom Corporation");
176MODULE_DESCRIPTION("Broadcom 802.11n wireless LAN driver.");
177MODULE_SUPPORTED_DEVICE("Broadcom 802.11n WLAN cards");
178MODULE_LICENSE("Dual BSD/GPL");
179
180#ifndef BCMSDIO
181/* recognized PCI IDs */
182static struct pci_device_id wl_id_table[] = {
183 {PCI_VENDOR_ID_BROADCOM, 0x4357, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* 43225 2G */
184 {PCI_VENDOR_ID_BROADCOM, 0x4353, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* 43224 DUAL */
185 {PCI_VENDOR_ID_BROADCOM, 0x4727, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* 4313 DUAL */
186 {0}
187};
188
189MODULE_DEVICE_TABLE(pci, wl_id_table);
190#endif /* !BCMSDIO */
191
192#ifdef BCMSDIO
193static uint sd_drivestrength = 6;
194module_param(sd_drivestrength, uint, 0);
195#endif
196
197#ifdef BCMDBG
198static int msglevel = 0xdeadbeef;
199module_param(msglevel, int, 0);
200#ifndef WLC_HIGH_ONLY
201static int phymsglevel = 0xdeadbeef;
202module_param(phymsglevel, int, 0);
203#endif /* WLC_HIGH_ONLY */
204#endif /* BCMDBG */
205
206static int oneonly = 0;
207module_param(oneonly, int, 0);
208
209static int piomode = 0;
210module_param(piomode, int, 0);
211
212static int instance_base = 0; /* Starting instance number */
213module_param(instance_base, int, 0);
214
215#if defined(BCMDBG)
216static char *macaddr = NULL;
217module_param(macaddr, charp, S_IRUGO);
218#endif
219
220static int nompc = 1;
221module_param(nompc, int, 0);
222
223static char name[IFNAMSIZ] = "eth%d";
224module_param_string(name, name, IFNAMSIZ, 0);
225
226#ifndef SRCBASE
227#define SRCBASE "."
228#endif
229
230#define WL_MAGIC 0xdeadbeef
231
232#define HW_TO_WL(hw) hw->priv
233#define WL_TO_HW(wl) wl->pub->ieee_hw
234#ifdef WLC_HIGH_ONLY
235static int wl_ops_tx_nl(struct ieee80211_hw *hw, struct sk_buff *skb);
236#else
237static int wl_ops_tx(struct ieee80211_hw *hw, struct sk_buff *skb);
238#endif
239static int wl_ops_start(struct ieee80211_hw *hw);
240static void wl_ops_stop(struct ieee80211_hw *hw);
241static int wl_ops_add_interface(struct ieee80211_hw *hw,
242 struct ieee80211_vif *vif);
243static void wl_ops_remove_interface(struct ieee80211_hw *hw,
244 struct ieee80211_vif *vif);
245static int wl_ops_config(struct ieee80211_hw *hw, u32 changed);
246static void wl_ops_bss_info_changed(struct ieee80211_hw *hw,
247 struct ieee80211_vif *vif,
248 struct ieee80211_bss_conf *info,
249 u32 changed);
250static void wl_ops_configure_filter(struct ieee80211_hw *hw,
251 unsigned int changed_flags,
252 unsigned int *total_flags, u64 multicast);
253static int wl_ops_set_tim(struct ieee80211_hw *hw, struct ieee80211_sta *sta,
254 bool set);
255static void wl_ops_sw_scan_start(struct ieee80211_hw *hw);
256static void wl_ops_sw_scan_complete(struct ieee80211_hw *hw);
257static void wl_ops_set_tsf(struct ieee80211_hw *hw, u64 tsf);
258static int wl_ops_get_stats(struct ieee80211_hw *hw,
259 struct ieee80211_low_level_stats *stats);
260static int wl_ops_set_rts_threshold(struct ieee80211_hw *hw, u32 value);
261static void wl_ops_sta_notify(struct ieee80211_hw *hw,
262 struct ieee80211_vif *vif,
263 enum sta_notify_cmd cmd,
264 struct ieee80211_sta *sta);
265static int wl_ops_conf_tx(struct ieee80211_hw *hw, u16 queue,
266 const struct ieee80211_tx_queue_params *params);
267static u64 wl_ops_get_tsf(struct ieee80211_hw *hw);
268static int wl_sta_add(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
269 struct ieee80211_sta *sta);
270static int wl_sta_remove(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
271 struct ieee80211_sta *sta);
272static int wl_ampdu_action(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
273 enum ieee80211_ampdu_mlme_action action,
7cc4a4c0 274 struct ieee80211_sta *sta, u16 tid, u16 *ssn);
a9533e7e
HP		 275
276#ifdef WLC_HIGH_ONLY
277static int wl_ops_tx_nl(struct ieee80211_hw *hw, struct sk_buff *skb)
278{
279 int status;
280 wl_info_t *wl = hw->priv;
281 if (!wl->pub->up) {
282 WL_ERROR(("ops->tx called while down\n"));
283 status = -ENETDOWN;
284 goto done;
285 }
286 status = wl_start(skb, wl);
287 done:
288 return status;
289}
290#else
291static int wl_ops_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
292{
293 int status;
294 wl_info_t *wl = hw->priv;
295 WL_LOCK(wl);
296 if (!wl->pub->up) {
297 WL_ERROR(("ops->tx called while down\n"));
298 status = -ENETDOWN;
299 goto done;
300 }
301 status = wl_start(skb, wl);
302 done:
303 WL_UNLOCK(wl);
304 return status;
305}
306#endif /* WLC_HIGH_ONLY */
307
308static int wl_ops_start(struct ieee80211_hw *hw)
309{
310 wl_info_t *wl = hw->priv;
311 /* struct ieee80211_channel *curchan = hw->conf.channel; */
312 WL_NONE(("%s : Initial channel: %d\n", __func__, curchan->hw_value));
313
314 WL_LOCK(wl);
315 ieee80211_wake_queues(hw);
316 WL_UNLOCK(wl);
317
318 return 0;
319}
320
321static void wl_ops_stop(struct ieee80211_hw *hw)
322{
323 wl_info_t *wl = hw->priv;
324 ASSERT(wl);
325 WL_LOCK(wl);
326 wl_down(wl);
327 ieee80211_stop_queues(hw);
328 WL_UNLOCK(wl);
329
330 return;
331}
332
333static int
334wl_ops_add_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
335{
336 wl_info_t *wl;
337 int err;
338
339 /* Just STA for now */
340 if (vif->type != NL80211_IFTYPE_AP &&
341 vif->type != NL80211_IFTYPE_MESH_POINT &&
342 vif->type != NL80211_IFTYPE_STATION &&
343 vif->type != NL80211_IFTYPE_WDS &&
344 vif->type != NL80211_IFTYPE_ADHOC) {
345 WL_ERROR(("%s: Attempt to add type %d, only STA for now\n",
346 __func__, vif->type));
347 return -EOPNOTSUPP;
348 }
349
350 wl = HW_TO_WL(hw);
351 WL_LOCK(wl);
352 err = wl_up(wl);
353 WL_UNLOCK(wl);
354
355 if (err != 0)
356 WL_ERROR(("%s: wl_up() returned %d\n", __func__, err));
357 return err;
358}
359
360static void
361wl_ops_remove_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
362{
363 return;
364}
365
366static int
367ieee_set_channel(struct ieee80211_hw *hw, struct ieee80211_channel *chan,
368 enum nl80211_channel_type type)
369{
370 wl_info_t *wl = HW_TO_WL(hw);
371 int err = 0;
372
373 switch (type) {
374 case NL80211_CHAN_HT20:
375 case NL80211_CHAN_NO_HT:
376 WL_LOCK(wl);
377 err = wlc_set(wl->wlc, WLC_SET_CHANNEL, chan->hw_value);
378 WL_UNLOCK(wl);
379 break;
380 case NL80211_CHAN_HT40MINUS:
381 case NL80211_CHAN_HT40PLUS:
382 WL_ERROR(("%s: Need to implement 40 Mhz Channels!\n",
383 __func__));
384 break;
385 }
386
387 if (err)
388 return -EIO;
389 return err;
390}
391
392static int wl_ops_config(struct ieee80211_hw *hw, u32 changed)
393{
394 struct ieee80211_conf *conf = &hw->conf;
395 wl_info_t *wl = HW_TO_WL(hw);
396 int err = 0;
397 int new_int;
398
399 if (changed & IEEE80211_CONF_CHANGE_LISTEN_INTERVAL) {
400 WL_NONE(("%s: Setting listen interval to %d\n",
401 __func__, conf->listen_interval));
402 if (wlc_iovar_setint
403 (wl->wlc, "bcn_li_bcn", conf->listen_interval)) {
404 WL_ERROR(("%s: Error setting listen_interval\n",
405 __func__));
406 err = -EIO;
407 goto config_out;
408 }
409 wlc_iovar_getint(wl->wlc, "bcn_li_bcn", &new_int);
410 ASSERT(new_int == conf->listen_interval);
411 }
412 if (changed & IEEE80211_CONF_CHANGE_MONITOR)
413 WL_NONE(("Need to set monitor mode\n"));
414 if (changed & IEEE80211_CONF_CHANGE_PS)
415 WL_NONE(("Need to set Power-save mode\n"));
416
417 if (changed & IEEE80211_CONF_CHANGE_POWER) {
418 WL_NONE(("%s: Setting tx power to %d dbm\n", __func__,
419 conf->power_level));
420 if (wlc_iovar_setint
421 (wl->wlc, "qtxpower", conf->power_level * 4)) {
422 WL_ERROR(("%s: Error setting power_level\n", __func__));
423 err = -EIO;
424 goto config_out;
425 }
426 wlc_iovar_getint(wl->wlc, "qtxpower", &new_int);
427 if (new_int != (conf->power_level * 4))
428 WL_ERROR(("%s: Power level req != actual, %d %d\n",
429 __func__, conf->power_level * 4, new_int));
430 }
431 if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
432 err = ieee_set_channel(hw, conf->channel, conf->channel_type);
433 }
434 if (changed & IEEE80211_CONF_CHANGE_RETRY_LIMITS) {
435 WL_NONE(("%s: srl %d, lrl %d\n", __func__,
436 conf->short_frame_max_tx_count,
437 conf->long_frame_max_tx_count));
438 if (wlc_set
439 (wl->wlc, WLC_SET_SRL,
440 conf->short_frame_max_tx_count) < 0) {
441 WL_ERROR(("%s: Error setting srl\n", __func__));
442 err = -EIO;
443 goto config_out;
444 }
445 if (wlc_set(wl->wlc, WLC_SET_LRL, conf->long_frame_max_tx_count)
446 < 0) {
447 WL_ERROR(("%s: Error setting lrl\n", __func__));
448 err = -EIO;
449 goto config_out;
450 }
451 }
452
453 config_out:
454 return err;
455}
456
457static void
458wl_ops_bss_info_changed(struct ieee80211_hw *hw,
459 struct ieee80211_vif *vif,
460 struct ieee80211_bss_conf *info, u32 changed)
461{
462 wl_info_t *wl = HW_TO_WL(hw);
463 int val;
464
465#ifdef WLC_HIGH_ONLY
466 WL_LOCK(wl);
467#endif
468
469 if (changed & BSS_CHANGED_ASSOC) {
470 WL_ERROR(("Associated:\t%s\n", info->assoc ? "True" : "False"));
471 /* association status changed (associated/disassociated)
472 * also implies a change in the AID.
473 */
474 }
475 if (changed & BSS_CHANGED_ERP_CTS_PROT) {
476 WL_NONE(("Use_cts_prot:\t%s Implement me\n",
477 info->use_cts_prot ? "True" : "False"));
478 /* CTS protection changed */
479 }
480 if (changed & BSS_CHANGED_ERP_PREAMBLE) {
481 WL_NONE(("Short preamble:\t%s Implement me\n",
482 info->use_short_preamble ? "True" : "False"));
483 /* preamble changed */
484 }
485 if (changed & BSS_CHANGED_ERP_SLOT) {
486 WL_NONE(("Changing short slot:\t%s\n",
487 info->use_short_slot ? "True" : "False"));
488 if (info->use_short_slot)
489 val = 1;
490 else
491 val = 0;
492 wlc_set(wl->wlc, WLC_SET_SHORTSLOT_OVERRIDE, val);
493 /* slot timing changed */
494 }
495
496 if (changed & BSS_CHANGED_HT) {
497 WL_NONE(("%s: HT mode - Implement me\n", __func__));
498 /* 802.11n parameters changed */
499 }
500 if (changed & BSS_CHANGED_BASIC_RATES) {
501 WL_NONE(("Need to change Basic Rates:\t0x%x! Implement me\n",
502 (uint32) info->basic_rates));
503 /* Basic rateset changed */
504 }
505 if (changed & BSS_CHANGED_BEACON_INT) {
506 WL_NONE(("Beacon Interval:\t%d Implement me\n",
507 info->beacon_int));
508 /* Beacon interval changed */
509 }
510 if (changed & BSS_CHANGED_BSSID) {
511 /* char eabuf[ETHER_ADDR_STR_LEN]; */
512 WL_NONE(("new BSSID:\taid %d bss:%s\n",
513 info->aid,
514 bcm_ether_ntoa((struct ether_addr *)info->bssid,
515 eabuf)));
516 /* BSSID changed, for whatever reason (IBSS and managed mode) */
517 /* FIXME: need to store bssid in bsscfg */
518 wlc_set_addrmatch(wl->wlc, RCM_BSSID_OFFSET,
519 (struct ether_addr *)info->bssid);
520 }
521 if (changed & BSS_CHANGED_BEACON) {
522 WL_ERROR(("BSS_CHANGED_BEACON\n"));
523 /* Beacon data changed, retrieve new beacon (beaconing modes) */
524 }
525 if (changed & BSS_CHANGED_BEACON_ENABLED) {
526 WL_ERROR(("Beacon enabled:\t%s\n",
527 info->enable_beacon ? "True" : "False"));
528 /* Beaconing should be enabled/disabled (beaconing modes) */
529 }
530#ifdef WLC_HIGH_ONLY
531 WL_UNLOCK(wl);
532#endif
533 return;
534}
535
536static void
537wl_ops_configure_filter(struct ieee80211_hw *hw,
538 unsigned int changed_flags,
539 unsigned int *total_flags, u64 multicast)
540{
541#ifndef WLC_HIGH_ONLY
542 wl_info_t *wl = hw->priv;
543#endif
544
545 changed_flags &= MAC_FILTERS;
546 *total_flags &= MAC_FILTERS;
547 if (changed_flags & FIF_PROMISC_IN_BSS)
548 WL_ERROR(("FIF_PROMISC_IN_BSS\n"));
549 if (changed_flags & FIF_ALLMULTI)
550 WL_ERROR(("FIF_ALLMULTI\n"));
551 if (changed_flags & FIF_FCSFAIL)
552 WL_ERROR(("FIF_FCSFAIL\n"));
553 if (changed_flags & FIF_PLCPFAIL)
554 WL_ERROR(("FIF_PLCPFAIL\n"));
555 if (changed_flags & FIF_CONTROL)
556 WL_ERROR(("FIF_CONTROL\n"));
557 if (changed_flags & FIF_OTHER_BSS)
558 WL_ERROR(("FIF_OTHER_BSS\n"));
559 if (changed_flags & FIF_BCN_PRBRESP_PROMISC) {
560 WL_NONE(("FIF_BCN_PRBRESP_PROMISC\n"));
561#ifndef WLC_HIGH_ONLY
562 WL_LOCK(wl);
563 if (*total_flags & FIF_BCN_PRBRESP_PROMISC) {
564 wl->pub->mac80211_state |= MAC80211_PROMISC_BCNS;
565 wlc_mac_bcn_promisc_change(wl->wlc, 1);
566 } else {
567 wlc_mac_bcn_promisc_change(wl->wlc, 0);
568 wl->pub->mac80211_state &= ~MAC80211_PROMISC_BCNS;
569 }
570 WL_UNLOCK(wl);
571#endif
572 }
573 return;
574}
575
576static int
577wl_ops_set_tim(struct ieee80211_hw *hw, struct ieee80211_sta *sta, bool set)
578{
579 WL_ERROR(("%s: Enter\n", __func__));
580 return 0;
581}
582
583static void wl_ops_sw_scan_start(struct ieee80211_hw *hw)
584{
585 WL_NONE(("Scan Start\n"));
586 return;
587}
588
589static void wl_ops_sw_scan_complete(struct ieee80211_hw *hw)
590{
591 WL_NONE(("Scan Complete\n"));
592 return;
593}
594
595static void wl_ops_set_tsf(struct ieee80211_hw *hw, u64 tsf)
596{
597 WL_ERROR(("%s: Enter\n", __func__));
598 return;
599}
600
601static int
602wl_ops_get_stats(struct ieee80211_hw *hw,
603 struct ieee80211_low_level_stats *stats)
604{
605 WL_ERROR(("%s: Enter\n", __func__));
606 return 0;
607}
608
609static int wl_ops_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
610{
611 WL_ERROR(("%s: Enter\n", __func__));
612 return 0;
613}
614
615static void
616wl_ops_sta_notify(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
617 enum sta_notify_cmd cmd, struct ieee80211_sta *sta)
618{
619 WL_NONE(("%s: Enter\n", __func__));
620 switch (cmd) {
621 default:
622 WL_ERROR(("%s: Uknown cmd = %d\n", __func__, cmd));
623 break;
624 }
625 return;
626}
627
628static int
629wl_ops_conf_tx(struct ieee80211_hw *hw, u16 queue,
630 const struct ieee80211_tx_queue_params *params)
631{
632 wl_info_t *wl = hw->priv;
633
634 WL_NONE(("%s: Enter (WME config)\n", __func__));
635 WL_NONE(("queue %d, txop %d, cwmin %d, cwmax %d, aifs %d\n", queue,
636 params->txop, params->cw_min, params->cw_max, params->aifs));
637
638 WL_LOCK(wl);
639 wlc_wme_setparams(wl->wlc, queue, (void *)params, TRUE);
640 WL_UNLOCK(wl);
641
642 return 0;
643}
644
645static u64 wl_ops_get_tsf(struct ieee80211_hw *hw)
646{
647 WL_ERROR(("%s: Enter\n", __func__));
648 return 0;
649}
650
651static int
652wl_sta_add(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
653 struct ieee80211_sta *sta)
654{
655 struct scb *scb;
656
657 int i;
658 wl_info_t *wl = hw->priv;
659
660 /* Init the scb */
661 scb = (struct scb *)sta->drv_priv;
662 bzero(scb, sizeof(struct scb));
663 for (i = 0; i < NUMPRIO; i++)
664 scb->seqctl[i] = 0xFFFF;
665 scb->seqctl_nonqos = 0xFFFF;
666 scb->magic = SCB_MAGIC;
667
668 wl->pub->global_scb = scb;
669 wl->pub->global_ampdu = &(scb->scb_ampdu);
670 wl->pub->global_ampdu->scb = scb;
671#ifdef WLC_HIGH_ONLY
672 wl->pub->global_ampdu->max_pdu = AMPDU_NUM_MPDU;
673#else
674 wl->pub->global_ampdu->max_pdu = 16;
675#endif
676 pktq_init(&scb->scb_ampdu.txq, AMPDU_MAX_SCB_TID,
677 AMPDU_MAX_SCB_TID * PKTQ_LEN_DEFAULT);
678
679 sta->ht_cap.ht_supported = TRUE;
680#ifdef WLC_HIGH_ONLY
681 sta->ht_cap.ampdu_factor = AMPDU_RX_FACTOR_16K;
682#else
683 sta->ht_cap.ampdu_factor = AMPDU_RX_FACTOR_64K;
684#endif
685 sta->ht_cap.ampdu_density = AMPDU_DEF_MPDU_DENSITY;
686 sta->ht_cap.cap = IEEE80211_HT_CAP_GRN_FLD |
687 IEEE80211_HT_CAP_SGI_20 |
688 IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_40MHZ_INTOLERANT;
689
690 /* minstrel_ht initiates addBA on our behalf by calling ieee80211_start_tx_ba_session() */
691 return 0;
692}
693
694static int
695wl_sta_remove(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
696 struct ieee80211_sta *sta)
697{
698 WL_NONE(("%s: Enter\n", __func__));
699 return 0;
700}
701
702static int
703wl_ampdu_action(struct ieee80211_hw *hw,
704 struct ieee80211_vif *vif,
705 enum ieee80211_ampdu_mlme_action action,
7cc4a4c0 706 struct ieee80211_sta *sta, u16 tid, u16 *ssn)
a9533e7e
HP		 707{
708#if defined(BCMDBG)
709 struct scb *scb = (struct scb *)sta->drv_priv;
710#endif
711 wl_info_t *wl = hw->priv;
712
713 ASSERT(scb->magic == SCB_MAGIC);
714 switch (action) {
715 case IEEE80211_AMPDU_RX_START:
716 WL_NONE(("%s: action = IEEE80211_AMPDU_RX_START\n", __func__));
717 break;
718 case IEEE80211_AMPDU_RX_STOP:
719 WL_NONE(("%s: action = IEEE80211_AMPDU_RX_STOP\n", __func__));
720 break;
721 case IEEE80211_AMPDU_TX_START:
722 if (!wlc_aggregatable(wl->wlc, tid)) {
723 /* WL_ERROR(("START: tid %d is not agg' able, return FAILURE to stack\n", tid)); */
724 return -1;
725 }
726 /* XXX: Use the starting sequence number provided ... */
727 *ssn = 0;
728 ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid);
729 break;
730
731 case IEEE80211_AMPDU_TX_STOP:
732 ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
733 break;
734 case IEEE80211_AMPDU_TX_OPERATIONAL:
735 /* Not sure what to do here */
736 /* Power save wakeup */
737 WL_NONE(("%s: action = IEEE80211_AMPDU_TX_OPERATIONAL\n",
738 __func__));
739 break;
740 default:
741 WL_ERROR(("%s: Invalid command, ignoring\n", __func__));
742 }
743
744 return 0;
745}
746
747static const struct ieee80211_ops wl_ops = {
748#ifdef WLC_HIGH_ONLY
749 .tx = wl_ops_tx_nl,
750#else
751 .tx = wl_ops_tx,
752#endif
753 .start = wl_ops_start,
754 .stop = wl_ops_stop,
755 .add_interface = wl_ops_add_interface,
756 .remove_interface = wl_ops_remove_interface,
757 .config = wl_ops_config,
758 .bss_info_changed = wl_ops_bss_info_changed,
759 .configure_filter = wl_ops_configure_filter,
760 .set_tim = wl_ops_set_tim,
761 .sw_scan_start = wl_ops_sw_scan_start,
762 .sw_scan_complete = wl_ops_sw_scan_complete,
763 .set_tsf = wl_ops_set_tsf,
764 .get_stats = wl_ops_get_stats,
765 .set_rts_threshold = wl_ops_set_rts_threshold,
766 .sta_notify = wl_ops_sta_notify,
767 .conf_tx = wl_ops_conf_tx,
768 .get_tsf = wl_ops_get_tsf,
769 .sta_add = wl_sta_add,
770 .sta_remove = wl_sta_remove,
771 .ampdu_action = wl_ampdu_action,
772};
773
7cc4a4c0 774static int wl_set_hint(wl_info_t *wl, char *abbrev)
a9533e7e
HP		 775{
776 WL_ERROR(("%s: Sending country code %c%c to MAC80211\n", __func__,
777 abbrev[0], abbrev[1]));
90ea2296 778 return regulatory_hint(wl->pub->ieee_hw->wiphy, abbrev);
a9533e7e
HP		 779}
780
781/**
782 * attach to the WL device.
783 *
784 * Attach to the WL device identified by vendor and device parameters.
785 * regs is a host accessible memory address pointing to WL device registers.
786 *
787 * wl_attach is not defined as static because in the case where no bus
788 * is defined, wl_attach will never be called, and thus, gcc will issue
789 * a warning that this function is defined but not used if we declare
790 * it as static.
791 */
792static wl_info_t *wl_attach(uint16 vendor, uint16 device, ulong regs,
793 uint bustype, void *btparam, uint irq)
794{
795 wl_info_t *wl;
796 osl_t *osh;
797 int unit, err;
798
799 ulong base_addr;
800 struct ieee80211_hw *hw;
801 uint8 perm[ETH_ALEN];
802
803 unit = wl_found + instance_base;
804 err = 0;
805
806 if (unit < 0) {
807 WL_ERROR(("wl%d: unit number overflow, exiting\n", unit));
808 return NULL;
809 }
810
811 if (oneonly && (unit != instance_base)) {
812 WL_ERROR(("wl%d: wl_attach: oneonly is set, exiting\n", unit));
813 return NULL;
814 }
815
816 /* Requires pkttag feature */
817 osh = osl_attach(btparam, bustype, TRUE);
818 ASSERT(osh);
819
820#ifdef WLC_HIGH_ONLY
821 hw = ieee80211_alloc_hw(sizeof(wl_info_t), &wl_ops);
822 if (!hw) {
823 WL_ERROR(("%s: ieee80211_alloc_hw failed\n", __func__));
824 ASSERT(0);
825 }
826
827 bzero(hw->priv, sizeof(*wl));
828 wl = hw->priv;
829#else
830 /* allocate private info */
831 hw = pci_get_drvdata(btparam); /* btparam == pdev */
832 wl = hw->priv;
833#endif
834 ASSERT(wl);
835
836 wl->magic = WL_MAGIC;
837 wl->osh = osh;
838 atomic_set(&wl->callbacks, 0);
839
eb4764c3
BH		 840 /* setup the bottom half handler */
841 tasklet_init(&wl->tasklet, wl_dpc, (ulong) wl);
842
a9533e7e
HP		 843#ifdef WLC_HIGH_ONLY
844 wl->rpc_th = bcm_rpc_tp_attach(osh, NULL);
845 if (wl->rpc_th == NULL) {
846 WL_ERROR(("wl%d: %s: bcm_rpc_tp_attach failed!\n", unit,
847 __func__));
848 goto fail;
849 }
850
851 wl->rpc = bcm_rpc_attach(NULL, osh, wl->rpc_th);
852 if (wl->rpc == NULL) {
853 WL_ERROR(("wl%d: %s: bcm_rpc_attach failed!\n", unit,
854 __func__));
855 goto fail;
856 }
857
858 /* init tx work queue for wl_start/send pkt; no need to destroy workitem */
859 MY_INIT_WORK(&wl->txq_task.work, (work_func_t) wl_start_txqwork);
860 wl->txq_task.context = wl;
861#endif /* WLC_HIGH_ONLY */
862
863#ifdef BCMSDIO
864 SET_IEEE80211_DEV(hw, sdiommc_dev);
865#endif
866
867 base_addr = regs;
868
869 if (bustype == PCI_BUS) {
870 /* piomode can be overwritten by command argument */
871 wl->piomode = piomode;
872 WL_TRACE(("PCI/%s\n", wl->piomode ? "PIO" : "DMA"));
873 } else if (bustype == RPC_BUS) {
874 /* Do nothing */
875 } else {
876 bustype = PCI_BUS;
877 WL_TRACE(("force to PCI\n"));
878 }
879 wl->bcm_bustype = bustype;
880
881#ifdef WLC_HIGH_ONLY
882 if (wl->bcm_bustype == RPC_BUS) {
883 wl->regsva = (void *)0;
884 btparam = wl->rpc;
885 } else
886#endif
887 if ((wl->regsva = ioremap_nocache(base_addr, PCI_BAR0_WINSZ)) == NULL) {
888 WL_ERROR(("wl%d: ioremap() failed\n", unit));
889 goto fail;
890 }
891#ifdef WLC_HIGH_ONLY
892 spin_lock_init(&wl->rpcq_lock);
893 spin_lock_init(&wl->txq_lock);
894
895 init_MUTEX(&wl->sem);
896#else
897 spin_lock_init(&wl->lock);
898 spin_lock_init(&wl->isr_lock);
899#endif
900
901#ifndef WLC_HIGH_ONLY
902 /* prepare ucode */
903 if (wl_request_fw(wl, (struct pci_dev *)btparam)) {
904 printf("%s: %s driver failed\n", KBUILD_MODNAME,
905 EPI_VERSION_STR);
906 goto fail;
907 }
908#endif
909
910 /* common load-time initialization */
eb4764c3
BH		 911 wl->wlc = wlc_attach((void *)wl, vendor, device, unit, wl->piomode, osh,
912 wl->regsva, wl->bcm_bustype, btparam, &err);
913#ifndef WLC_HIGH_ONLY
914 wl_release_fw(wl);
915#endif
916 if (!wl->wlc) {
a9533e7e
HP		 917 printf("%s: %s driver failed with code %d\n", KBUILD_MODNAME,
918 EPI_VERSION_STR, err);
919 goto fail;
920 }
a9533e7e
HP		 921 wl->pub = wlc_pub(wl->wlc);
922
923 wl->pub->ieee_hw = hw;
924 ASSERT(wl->pub->ieee_hw);
925 ASSERT(wl->pub->ieee_hw->priv == wl);
926
927#ifdef WLC_HIGH_ONLY
928 REGOPSSET(osh, (osl_rreg_fn_t) wlc_reg_read,
929 (osl_wreg_fn_t) wlc_reg_write, wl->wlc);
930 wl->rpc_dispatch_ctx.rpc = wl->rpc;
931 wl->rpc_dispatch_ctx.wlc = wl->wlc;
932 bcm_rpc_rxcb_init(wl->rpc, wl, wl_rpc_dispatch_schedule, wl,
933 wl_rpc_down, NULL, NULL);
934#endif /* WLC_HIGH_ONLY */
935
936 if (nompc) {
937 if (wlc_iovar_setint(wl->wlc, "mpc", 0)) {
938 WL_ERROR(("wl%d: Error setting MPC variable to 0\n",
939 unit));
940 }
941 }
942#ifdef BCMSDIO
943 /* Set SDIO drive strength */
944 wlc_iovar_setint(wl->wlc, "sd_drivestrength", sd_drivestrength);
945#endif
946
a9533e7e
HP		 947#ifdef WLC_LOW
948 /* register our interrupt handler */
949 if (request_irq(irq, wl_isr, IRQF_SHARED, KBUILD_MODNAME, wl)) {
950 WL_ERROR(("wl%d: request_irq() failed\n", unit));
951 goto fail;
952 }
953 wl->irq = irq;
954#endif /* WLC_LOW */
955
956 /* register module */
957 wlc_module_register(wl->pub, NULL, "linux", wl, NULL, wl_linux_watchdog,
958 NULL);
959
960 if (ieee_hw_init(hw)) {
961 WL_ERROR(("wl%d: %s: ieee_hw_init failed!\n", unit, __func__));
962 goto fail;
963 }
964
965 bcopy(&wl->pub->cur_etheraddr, perm, ETHER_ADDR_LEN);
966 ASSERT(is_valid_ether_addr(perm));
967 SET_IEEE80211_PERM_ADDR(hw, perm);
968
969 err = ieee80211_register_hw(hw);
970 if (err) {
971 WL_ERROR(("%s: ieee80211_register_hw failed, status %d\n",
972 __func__, err));
973 }
974
975 if (wl->pub->srom_ccode[0])
976 err = wl_set_hint(wl, wl->pub->srom_ccode);
977 else
978 err = wl_set_hint(wl, "US");
979 if (err) {
980 WL_ERROR(("%s: regulatory_hint failed, status %d\n", __func__,
981 err));
982 }
983#ifndef WLC_HIGH_ONLY
984 WL_ERROR(("wl%d: Broadcom BCM43xx 802.11 MAC80211 Driver "
985 EPI_VERSION_STR " (" PHY_VERSION_STR ")", unit));
986#else
987 WL_ERROR(("wl%d: Broadcom BCM43xx 802.11 MAC80211 Driver "
988 EPI_VERSION_STR, unit));
989#endif
990
991#ifdef BCMDBG
992 printf(" (Compiled in " SRCBASE " at " __TIME__ " on " __DATE__ ")");
993#endif /* BCMDBG */
994 printf("\n");
995
996 if ((wl->proc_entry =
997 create_proc_entry(PROC_ENTRY_NAME, 0644, NULL)) == NULL) {
998 WL_ERROR(("create_proc_entry failed *******\n"));
999 ASSERT(0);
1000 } else {
1001 wl->proc_entry->read_proc = wl_proc_read;
1002 wl->proc_entry->write_proc = wl_proc_write;
1003 wl->proc_entry->data = wl;
1004 /* wl->proc_entry->owner = THIS_MODULE; */
1005
1006 if ((wl->ioctlbuf = (char *)vmalloc(PAGE_SIZE)) == NULL) {
1007 WL_ERROR(("%s: Vmalloc failed\n", __func__));
1008 }
1009 wl->ioctlbuf_sz = PAGE_SIZE;
1010 memset(wl->ioctlbuf, 0, PAGE_SIZE);
1011 wl->ioctlbuf[0] = '!';
1012 }
1013
1014 wl_found++;
1015 return wl;
1016
1017 fail:
1018 wl_free(wl);
1019 return NULL;
1020}
1021
1022#define PROC_MESSAGE "Broadcom driver debugger access only. Requires matching 'wl' app\n"
1023
1024/* OS Entry point when app attempts to read */
1025static int
1026wl_proc_read(char *buffer, char **start, off_t offset, int length, int *eof,
1027 void *data)
1028{
1029 wl_info_t *wl = (wl_info_t *) data;
1030
1031 switch (wl->proc_state) {
1032
1033 case WL_PROC_IDLE:
1034 return 0;
1035
1036 case WL_PROC_HAVE_IOC:
1037 /* Give the processed buffer back to userland */
1038 if (!wl->ioctl_in_progress) {
1039 WL_ERROR(("%s: No ioctl in progress nothing to read, 2\n", __func__));
1040 return 0;
1041 }
1042
1043 if (wl->ioc.len > wl->ioctlbuf_sz) {
1044 }
1045 bcopy(wl->ioctlbuf, buffer + offset, wl->ioc.len);
1046 wl->proc_state--;
1047 wl->ioctl_in_progress = 0;
1048 return wl->ioc.len + offset;
1049
1050 case WL_PROC_HAVE_BUF:
1051 /* Give the processed IOC back to userland */
1052 if (!wl->ioctl_in_progress) {
1053 WL_ERROR(("%s: No ioctl in progress nothing to read, 1\n", __func__));
1054 return 0;
1055 }
1056 if (length != sizeof(wl_ioctl_t)) {
1057 WL_ERROR(("%s: Reading ioc but len != sizeof(wl_ioctl_t)\n", __func__));
1058 return 0;
1059 }
1060 bcopy(&wl->ioc, buffer + offset, length);
1061 wl->proc_state--;
1062 return length + offset;
1063
1064 default:
1065 WL_ERROR(("%s: Proc read out of sync. proc_state %d, ioctl_in_progress %d\n", __func__, wl->proc_state, wl->ioctl_in_progress));
1066 }
1067
1068 WL_ERROR(("%s: Invalid ioctl!!!\n", __func__));
1069 return 0;
1070}
1071
1072/* OS Entry point when app attempts to write */
1073static int
7cc4a4c0 1074wl_proc_write(struct file *filp, const char __user *buff, unsigned long length,
a9533e7e
HP		 1075 void *data)
1076{
1077 wl_info_t *wl = (wl_info_t *) data;
1078 int bcmerror;
1079
1080 switch (wl->proc_state) {
1081
1082 case WL_PROC_IDLE:
1083 if (wl->ioctl_in_progress) {
1084 WL_ERROR(("%s: ioctl still in progress\n", __func__));
1085 return -EIO;
1086 }
1087 if (length != sizeof(wl_ioctl_t)) {
1088 WL_ERROR(("%s: Expecting ioctl sized buf\n", __func__));
1089 return -EIO;
1090 }
1091 if (copy_from_user(&wl->ioc, buff, sizeof(wl_ioctl_t))) {
1092 WL_ERROR(("%s: copy from user failed\n", __func__));
1093 return -EIO;
1094 }
1095 wl->proc_state++;
1096 wl->ioctl_in_progress++;
1097 return sizeof(wl_ioctl_t);
1098
1099 case WL_PROC_HAVE_IOC:
1100 if (!wl->ioctl_in_progress) {
1101 WL_ERROR(("%s: Ioctl not ready yet 1\n", __func__));
1102 return -EIO;
1103 }
1104 if (wl->ioctlbuf_sz < length) {
1105 WL_ERROR(("%s: Buf write, ioctl buf %d not big enough too hold buffer %d\n", __func__, (int)sizeof(wl->ioctlbuf), (int)length));
1106 WL_ERROR(("Shortening input\n"));
1107 length = wl->ioctlbuf_sz;
1108 }
1109 if (length != wl->ioc.len) {
1110 WL_ERROR(("%s: ioc.len %d != length param %d\n",
1111 __func__, wl->ioc.len, (int)length));
1112 return -EIO;
1113 }
1114 if (copy_from_user(wl->ioctlbuf, buff, length)) {
1115 WL_ERROR(("%s: copy from user of %d bytes failed\n",
1116 __func__, (int)length));
1117 return -EIO;
1118 }
1119 wl->proc_state++;
1120
1121 WL_LOCK(wl);
1122 bcmerror =
1123 wlc_ioctl(wl->wlc, wl->ioc.cmd, wl->ioctlbuf, wl->ioc.len,
1124 NULL);
1125 WL_UNLOCK(wl);
1126
1127 if (bcmerror < 0)
1128 return bcmerror;
1129
1130 return length;
1131
1132 case WL_PROC_HAVE_BUF:
1133 WL_ERROR(("%s: Illegal write. Rejecting.\n", __func__));
1134 return 0;
1135 default:
1136 WL_ERROR(("%s: Proc write out of sync. proc_state %d, ioctl_in_progress %d\n", __func__, wl->proc_state, wl->ioctl_in_progress));
1137 }
1138 return 0;
1139}
1140
1141#ifdef WLC_HIGH_ONLY
1142static void *wl_dbus_probe_cb(void *arg, const char *desc, uint32 bustype,
1143 uint32 hdrlen)
1144{
1145 wl_info_t *wl;
1146 WL_ERROR(("%s:\n", __func__));
1147
1148 if (!
1149 (wl =
1150 wl_attach(BCM_DNGL_VID, BCM_DNGL_BDC_PID, (ulong) NULL, RPC_BUS,
1151 NULL, 0))) {
1152 WL_ERROR(("%s: wl_attach failed\n", __func__));
1153 }
1154
1155 /* This is later passed to wl_dbus_disconnect_cb */
1156 return wl;
1157}
1158
1159static void wl_dbus_disconnect_cb(void *arg)
1160{
1161 wl_info_t *wl = arg;
1162
1163 WL_ERROR(("%s:\n", __func__));
1164
1165 if (wl) {
1166#ifdef WLC_HIGH_ONLY
1167 if (wl->pub->ieee_hw) {
1168 ieee80211_unregister_hw(wl->pub->ieee_hw);
1169 WL_ERROR(("%s: Back from down\n", __func__));
1170 }
1171 wlc_device_removed(wl->wlc);
1172 wlc_bmac_dngl_reboot(wl->rpc);
1173 bcm_rpc_down(wl->rpc);
1174#endif
1175 WL_LOCK(wl);
1176 wl_down(wl);
1177 WL_UNLOCK(wl);
1178#ifdef WLC_HIGH_ONLY
1179 if (wl->pub->ieee_hw) {
1180 ieee80211_free_hw(wl->pub->ieee_hw);
1181 WL_ERROR(("%s: Back from ieee80211_free_hw\n",
1182 __func__));
1183 wl->pub->ieee_hw = NULL;
1184 }
1185#endif
1186 wl_free(wl);
1187 }
1188}
1189#endif /* WLC_HIGH_ONLY */
1190
1191#ifndef BCMSDIO
1192static void __devexit wl_remove(struct pci_dev *pdev);
1193#endif
1194
1195#define CHAN2GHZ(channel, freqency, chflags) { \
1196 .band = IEEE80211_BAND_2GHZ, \
1197 .center_freq = (freqency), \
1198 .hw_value = (channel), \
1199 .flags = chflags, \
1200 .max_antenna_gain = 0, \
1201 .max_power = 19, \
1202}
1203
1204static struct ieee80211_channel wl_2ghz_chantable[] = {
1205 CHAN2GHZ(1, 2412, IEEE80211_CHAN_NO_HT40MINUS),
1206 CHAN2GHZ(2, 2417, IEEE80211_CHAN_NO_HT40MINUS),
1207 CHAN2GHZ(3, 2422, IEEE80211_CHAN_NO_HT40MINUS),
1208 CHAN2GHZ(4, 2427, IEEE80211_CHAN_NO_HT40MINUS),
1209 CHAN2GHZ(5, 2432, 0),
1210 CHAN2GHZ(6, 2437, 0),
1211 CHAN2GHZ(7, 2442, 0),
1212 CHAN2GHZ(8, 2447, IEEE80211_CHAN_NO_HT40PLUS),
1213 CHAN2GHZ(9, 2452, IEEE80211_CHAN_NO_HT40PLUS),
1214 CHAN2GHZ(10, 2457, IEEE80211_CHAN_NO_HT40PLUS),
1215 CHAN2GHZ(11, 2462, IEEE80211_CHAN_NO_HT40PLUS),
1216 CHAN2GHZ(12, 2467,
1217 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_IBSS |
1218 IEEE80211_CHAN_NO_HT40PLUS),
1219 CHAN2GHZ(13, 2472,
1220 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_IBSS |
1221 IEEE80211_CHAN_NO_HT40PLUS),
1222 CHAN2GHZ(14, 2484,
1223 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_IBSS |
1224 IEEE80211_CHAN_NO_HT40PLUS | IEEE80211_CHAN_NO_HT40MINUS)
1225};
1226
1227#define CHAN5GHZ(channel, chflags) { \
1228 .band = IEEE80211_BAND_5GHZ, \
1229 .center_freq = 5000 + 5*(channel), \
1230 .hw_value = (channel), \
1231 .flags = chflags, \
1232 .max_antenna_gain = 0, \
1233 .max_power = 21, \
1234}
1235
1236static struct ieee80211_channel wl_5ghz_nphy_chantable[] = {
1237 /* UNII-1 */
1238 CHAN5GHZ(36, IEEE80211_CHAN_NO_HT40MINUS),
1239 CHAN5GHZ(40, IEEE80211_CHAN_NO_HT40PLUS),
1240 CHAN5GHZ(44, IEEE80211_CHAN_NO_HT40MINUS),
1241 CHAN5GHZ(48, IEEE80211_CHAN_NO_HT40PLUS),
1242 /* UNII-2 */
1243 CHAN5GHZ(52,
1244 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1245 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40MINUS),
1246 CHAN5GHZ(56,
1247 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1248 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40PLUS),
1249 CHAN5GHZ(60,
1250 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1251 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40MINUS),
1252 CHAN5GHZ(64,
1253 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1254 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40PLUS),
1255 /* MID */
1256 CHAN5GHZ(100,
1257 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1258 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40MINUS),
1259 CHAN5GHZ(104,
1260 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1261 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40PLUS),
1262 CHAN5GHZ(108,
1263 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1264 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40MINUS),
1265 CHAN5GHZ(112,
1266 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1267 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40PLUS),
1268 CHAN5GHZ(116,
1269 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1270 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40MINUS),
1271 CHAN5GHZ(120,
1272 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1273 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40PLUS),
1274 CHAN5GHZ(124,
1275 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1276 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40MINUS),
1277 CHAN5GHZ(128,
1278 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1279 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40PLUS),
1280 CHAN5GHZ(132,
1281 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1282 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40MINUS),
1283 CHAN5GHZ(136,
1284 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1285 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40PLUS),
1286 CHAN5GHZ(140,
1287 IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IBSS |
1288 IEEE80211_CHAN_PASSIVE_SCAN | IEEE80211_CHAN_NO_HT40PLUS |
1289 IEEE80211_CHAN_NO_HT40MINUS),
1290 /* UNII-3 */
1291 CHAN5GHZ(149, IEEE80211_CHAN_NO_HT40MINUS),
1292 CHAN5GHZ(153, IEEE80211_CHAN_NO_HT40PLUS),
1293 CHAN5GHZ(157, IEEE80211_CHAN_NO_HT40MINUS),
1294 CHAN5GHZ(161, IEEE80211_CHAN_NO_HT40PLUS),
1295 CHAN5GHZ(165, IEEE80211_CHAN_NO_HT40PLUS | IEEE80211_CHAN_NO_HT40MINUS)
1296};
1297
1298#define RATE(rate100m, _flags) { \
1299 .bitrate = (rate100m), \
1300 .flags = (_flags), \
1301 .hw_value = (rate100m / 5), \
1302}
1303
1304static struct ieee80211_rate wl_legacy_ratetable[] = {
1305 RATE(10, 0),
1306 RATE(20, IEEE80211_RATE_SHORT_PREAMBLE),
1307 RATE(55, IEEE80211_RATE_SHORT_PREAMBLE),
1308 RATE(110, IEEE80211_RATE_SHORT_PREAMBLE),
1309 RATE(60, 0),
1310 RATE(90, 0),
1311 RATE(120, 0),
1312 RATE(180, 0),
1313 RATE(240, 0),
1314 RATE(360, 0),
1315 RATE(480, 0),
1316 RATE(540, 0),
1317};
1318
1319static struct ieee80211_supported_band wl_band_2GHz_nphy = {
1320 .band = IEEE80211_BAND_2GHZ,
1321 .channels = wl_2ghz_chantable,
1322 .n_channels = ARRAY_SIZE(wl_2ghz_chantable),
1323 .bitrates = wl_legacy_ratetable,
1324 .n_bitrates = ARRAY_SIZE(wl_legacy_ratetable),
1325 .ht_cap = {
1326 /* from include/linux/ieee80211.h */
1327 .cap = IEEE80211_HT_CAP_GRN_FLD |
1328 IEEE80211_HT_CAP_SGI_20 |
1329 IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_40MHZ_INTOLERANT,
1330#ifdef WLC_HIGH_ONLY
1331 .ht_supported = true,
1332 .ampdu_factor = AMPDU_RX_FACTOR_16K,
1333#else
1334 .ht_supported = true,
1335 .ampdu_factor = AMPDU_RX_FACTOR_64K,
1336#endif
1337 .ampdu_density = AMPDU_DEF_MPDU_DENSITY,
1338 .mcs = {
1339 /* placeholders for now */
1340#ifdef WLC_HIGH_ONLY
1341 /*
1342 * rx_mask[0] = 0xff by default
1343 * rx_mask[1] = 0xff if number of rx chain >=2
1344 * rx_mask[2] = 0xff if number of rx chain >=3
1345 * rx_mask[4] = 1 if 40Mhz is supported
1346 */
1347 .rx_mask = {0xff, 0, 0, 0, 0, 0, 0, 0, 0, 0},
1348 .rx_highest = 72, /* max rate of single stream */
1349#else
1350 .rx_mask = {0xff, 0xff, 0, 0, 0, 0, 0, 0, 0, 0},
1351 .rx_highest = 500,
1352#endif
1353 .tx_params = IEEE80211_HT_MCS_TX_DEFINED}
1354 }
1355};
1356
1357static struct ieee80211_supported_band wl_band_5GHz_nphy = {
1358 .band = IEEE80211_BAND_5GHZ,
1359 .channels = wl_5ghz_nphy_chantable,
1360 .n_channels = ARRAY_SIZE(wl_5ghz_nphy_chantable),
1361 .bitrates = wl_legacy_ratetable + 4,
1362 .n_bitrates = ARRAY_SIZE(wl_legacy_ratetable) - 4,
1363 .ht_cap = {
1364 /* use IEEE80211_HT_CAP_* from include/linux/ieee80211.h */
1365 .cap = IEEE80211_HT_CAP_GRN_FLD | IEEE80211_HT_CAP_SGI_20 | IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_40MHZ_INTOLERANT, /* No 40 mhz yet */
1366 .ht_supported = true,
1367 .ampdu_factor = AMPDU_RX_FACTOR_64K,
1368 .ampdu_density = AMPDU_DEF_MPDU_DENSITY,
1369 .mcs = {
1370 /* placeholders for now */
1371 .rx_mask = {0xff, 0xff, 0, 0, 0, 0, 0, 0, 0, 0},
1372 .rx_highest = 500,
1373 .tx_params = IEEE80211_HT_MCS_TX_DEFINED}
1374 }
1375};
1376
1377static int ieee_hw_rate_init(struct ieee80211_hw *hw)
1378{
1379 wl_info_t *wl = HW_TO_WL(hw);
1380 int has_5g;
1381 char phy_list[4];
1382
1383 has_5g = 0;
1384
1385 hw->wiphy->bands[IEEE80211_BAND_2GHZ] = NULL;
1386 hw->wiphy->bands[IEEE80211_BAND_5GHZ] = NULL;
1387
1388 if (wlc_get(wl->wlc, WLC_GET_PHYLIST, (int *)&phy_list) < 0) {
1389 WL_ERROR(("Phy list failed\n"));
1390 }
1391 WL_NONE(("%s: phylist = %c\n", __func__, phy_list[0]));
1392
1393#ifndef WLC_HIGH_ONLY
1394 if (phy_list[0] == 'n' || phy_list[0] == 'c') {
1395 if (phy_list[0] == 'c') {
1396 /* Single stream */
1397 wl_band_2GHz_nphy.ht_cap.mcs.rx_mask[1] = 0;
1398 wl_band_2GHz_nphy.ht_cap.mcs.rx_highest = 72;
1399 }
1400#else
1401 if (phy_list[0] == 's') {
1402#endif
1403 hw->wiphy->bands[IEEE80211_BAND_2GHZ] = &wl_band_2GHz_nphy;
1404 } else {
1405 BUG();
90ea2296 1406 return -1;
a9533e7e
HP		 1407 }
1408
1409 /* Assume all bands use the same phy. True for 11n devices. */
1410 if (NBANDS_PUB(wl->pub) > 1) {
1411 has_5g++;
1412#ifndef WLC_HIGH_ONLY
1413 if (phy_list[0] == 'n' || phy_list[0] == 'c') {
1414#else
1415 if (phy_list[0] == 's') {
1416#endif
1417 hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
1418 &wl_band_5GHz_nphy;
1419 } else {
90ea2296 1420 return -1;
a9533e7e
HP		 1421 }
1422 }
1423
1424 WL_NONE(("%s: 2ghz = %d, 5ghz = %d\n", __func__, 1, has_5g));
1425
90ea2296 1426 return 0;
a9533e7e
HP		 1427}
1428
1429static int ieee_hw_init(struct ieee80211_hw *hw)
1430{
1431 hw->flags = IEEE80211_HW_SIGNAL_DBM
1432 /* | IEEE80211_HW_CONNECTION_MONITOR What is this? */
1433 | IEEE80211_HW_REPORTS_TX_ACK_STATUS
1434 | IEEE80211_HW_AMPDU_AGGREGATION;
1435
1436 hw->extra_tx_headroom = wlc_get_header_len();
1437 /* FIXME: should get this from wlc->machwcap */
1438 hw->queues = 4;
1439 /* FIXME: this doesn't seem to be used properly in minstrel_ht.
1440 * mac80211/status.c:ieee80211_tx_status() checks this value,
1441 * but mac80211/rc80211_minstrel_ht.c:minstrel_ht_get_rate()
1442 * appears to always set 3 rates
1443 */
1444 hw->max_rates = 2; /* Primary rate and 1 fallback rate */
1445
1446 hw->channel_change_time = 7 * 1000; /* channel change time is dependant on chip and band */
1447 hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION);
1448
1449 hw->rate_control_algorithm = "minstrel_ht";
1450
1451 hw->sta_data_size = sizeof(struct scb);
90ea2296 1452 return ieee_hw_rate_init(hw);
a9533e7e
HP		 1453}
1454
1455#ifndef BCMSDIO
1456/**
1457 * determines if a device is a WL device, and if so, attaches it.
1458 *
1459 * This function determines if a device pointed to by pdev is a WL device,
1460 * and if so, performs a wl_attach() on it.
1461 *
1462 */
1463int __devinit
1464wl_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
1465{
1466 int rc;
1467 wl_info_t *wl;
1468 struct ieee80211_hw *hw;
1469 uint32 val;
1470
1471 ASSERT(pdev);
1472
1473 WL_TRACE(("%s: bus %d slot %d func %d irq %d\n", __func__,
1474 pdev->bus->number, PCI_SLOT(pdev->devfn),
1475 PCI_FUNC(pdev->devfn), pdev->irq));
1476
1477 if ((pdev->vendor != PCI_VENDOR_ID_BROADCOM) ||
1478 (((pdev->device & 0xff00) != 0x4300) &&
1479 ((pdev->device & 0xff00) != 0x4700) &&
1480 ((pdev->device < 43000) || (pdev->device > 43999))))
90ea2296 1481 return -ENODEV;
a9533e7e
HP		 1482
1483 rc = pci_enable_device(pdev);
1484 if (rc) {
1485 WL_ERROR(("%s: Cannot enable device %d-%d_%d\n", __func__,
1486 pdev->bus->number, PCI_SLOT(pdev->devfn),
1487 PCI_FUNC(pdev->devfn)));
90ea2296 1488 return -ENODEV;
a9533e7e
HP		 1489 }
1490 pci_set_master(pdev);
1491
1492 pci_read_config_dword(pdev, 0x40, &val);
1493 if ((val & 0x0000ff00) != 0)
1494 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
1495
1496 hw = ieee80211_alloc_hw(sizeof(wl_info_t), &wl_ops);
1497 if (!hw) {
1498 WL_ERROR(("%s: ieee80211_alloc_hw failed\n", __func__));
1499 rc = -ENOMEM;
1500 goto err_1;
1501 }
1502
1503 SET_IEEE80211_DEV(hw, &pdev->dev);
1504
1505 pci_set_drvdata(pdev, hw);
1506
1507 bzero(hw->priv, sizeof(*wl));
1508
1509 wl = wl_attach(pdev->vendor, pdev->device, pci_resource_start(pdev, 0),
1510 PCI_BUS, pdev, pdev->irq);
1511
1512 return 0;
1513 err_1:
1514 WL_ERROR(("%s: err_1: Major hoarkage\n", __func__));
1515 return 0;
1516}
1517
1518#ifdef LINUXSTA_PS
1519static int wl_suspend(struct pci_dev *pdev, DRV_SUSPEND_STATE_TYPE state)
1520{
1521 wl_info_t *wl;
1522 struct ieee80211_hw *hw;
1523
1524 WL_TRACE(("wl: wl_suspend\n"));
1525
1526 hw = pci_get_drvdata(pdev);
1527 wl = HW_TO_WL(hw);
1528 if (!wl) {
1529 WL_ERROR(("wl: wl_suspend: pci_get_drvdata failed\n"));
1530 return -ENODEV;
1531 }
1532
1533 WL_LOCK(wl);
1534 wl_down(wl);
1535 wl->pub->hw_up = FALSE;
1536 WL_UNLOCK(wl);
1537 PCI_SAVE_STATE(pdev, wl->pci_psstate);
1538 pci_disable_device(pdev);
1539 return pci_set_power_state(pdev, PCI_D3hot);
1540}
1541
1542static int wl_resume(struct pci_dev *pdev)
1543{
1544 wl_info_t *wl;
1545 struct ieee80211_hw *hw;
1546 int err = 0;
1547 uint32 val;
1548
1549 WL_TRACE(("wl: wl_resume\n"));
1550 hw = pci_get_drvdata(pdev);
1551 wl = HW_TO_WL(hw);
1552 if (!wl) {
1553 WL_ERROR(("wl: wl_resume: pci_get_drvdata failed\n"));
1554 return -ENODEV;
1555 }
1556
1557 err = pci_set_power_state(pdev, PCI_D0);
1558 if (err)
1559 return err;
1560
1561 PCI_RESTORE_STATE(pdev, wl->pci_psstate);
1562
1563 err = pci_enable_device(pdev);
1564 if (err)
1565 return err;
1566
1567 pci_set_master(pdev);
1568
1569 pci_read_config_dword(pdev, 0x40, &val);
1570 if ((val & 0x0000ff00) != 0)
1571 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
1572
1573 WL_LOCK(wl);
1574 err = wl_up(wl);
1575 WL_UNLOCK(wl);
1576
90ea2296 1577 return err;
a9533e7e
HP		 1578}
1579#endif /* LINUXSTA_PS */
1580
1581static void __devexit wl_remove(struct pci_dev *pdev)
1582{
1583 wl_info_t *wl;
1584 struct ieee80211_hw *hw;
1585
1586 hw = pci_get_drvdata(pdev);
1587 wl = HW_TO_WL(hw);
1588 if (!wl) {
1589 WL_ERROR(("wl: wl_remove: pci_get_drvdata failed\n"));
1590 return;
1591 }
1592 if (!wlc_chipmatch(pdev->vendor, pdev->device)) {
1593 WL_ERROR(("wl: wl_remove: wlc_chipmatch failed\n"));
1594 return;
1595 }
1596
1597 ieee80211_unregister_hw(hw);
1598
1599 WL_LOCK(wl);
1600 wl_down(wl);
1601 WL_UNLOCK(wl);
1602 WL_NONE(("%s: Down\n", __func__));
1603
1604 pci_disable_device(pdev);
1605
1606 wl_free(wl);
1607
1608 pci_set_drvdata(pdev, NULL);
1609 ieee80211_free_hw(hw);
1610}
1611
1612static struct pci_driver wl_pci_driver = {
1613 name: "brcm80211",
1614 probe:wl_pci_probe,
1615#ifdef LINUXSTA_PS
1616 suspend:wl_suspend,
1617 resume:wl_resume,
1618#endif /* LINUXSTA_PS */
1619 remove:__devexit_p(wl_remove),
1620 id_table:wl_id_table,
1621};
1622#endif /* !BCMSDIO */
1623
1624/**
1625 * This is the main entry point for the WL driver.
1626 *
1627 * This function determines if a device pointed to by pdev is a WL device,
1628 * and if so, performs a wl_attach() on it.
1629 *
1630 */
1631static int __init wl_module_init(void)
1632{
1633 int error = -ENODEV;
1634
1635#ifdef BCMDBG
1636 if (msglevel != 0xdeadbeef)
1637 wl_msg_level = msglevel;
1638 else {
1639 char *var = getvar(NULL, "wl_msglevel");
1640 if (var)
1641 wl_msg_level = bcm_strtoul(var, NULL, 0);
1642 }
1643#ifndef WLC_HIGH_ONLY
1644 {
1645 extern uint32 phyhal_msg_level;
1646
1647 if (phymsglevel != 0xdeadbeef)
1648 phyhal_msg_level = phymsglevel;
1649 else {
1650 char *var = getvar(NULL, "phy_msglevel");
1651 if (var)
1652 phyhal_msg_level = bcm_strtoul(var, NULL, 0);
1653 }
1654 }
1655#endif /* WLC_HIGH_ONLY */
1656#endif /* BCMDBG */
1657
1658#ifndef BCMSDIO
1659 if (!(error = pci_module_init(&wl_pci_driver)))
90ea2296 1660 return 0;
a9533e7e
HP		 1661
1662#endif /* !BCMSDIO */
1663
1664#ifdef WLC_HIGH_ONLY
1665 /* BMAC_NOTE: define hardcode number, why NODEVICE is ok ? */
1666 error =
1667 dbus_register(BCM_DNGL_VID, 0, wl_dbus_probe_cb,
1668 wl_dbus_disconnect_cb, NULL, NULL, NULL);
1669 if (error == DBUS_ERR_NODEVICE) {
1670 error = DBUS_OK;
1671 }
1672#endif /* WLC_HIGH_ONLY */
1673
90ea2296 1674 return error;
a9533e7e
HP		 1675}
1676
1677/**
1678 * This function unloads the WL driver from the system.
1679 *
1680 * This function unconditionally unloads the WL driver module from the
1681 * system.
1682 *
1683 */
1684static void __exit wl_module_exit(void)
1685{
1686#ifndef BCMSDIO
1687 pci_unregister_driver(&wl_pci_driver);
1688#endif /* !BCMSDIO */
1689
1690#ifdef WLC_HIGH_ONLY
1691 dbus_deregister();
1692#endif /* WLC_HIGH_ONLY */
1693}
1694
1695module_init(wl_module_init);
1696module_exit(wl_module_exit);
1697
1698/**
1699 * This function frees the WL per-device resources.
1700 *
1701 * This function frees resources owned by the WL device pointed to
1702 * by the wl parameter.
1703 *
1704 */
7cc4a4c0 1705void wl_free(wl_info_t *wl)
a9533e7e
HP		 1706{
1707 wl_timer_t *t, *next;
1708 osl_t *osh;
1709
1710 ASSERT(wl);
1711#ifndef WLC_HIGH_ONLY
a9533e7e
HP		 1712 /* free ucode data */
1713 if (wl->fw.fw_cnt)
1714 wl_ucode_data_free();
a9533e7e
HP		 1715 if (wl->irq)
1716 free_irq(wl->irq, wl);
1717#endif
1718
1719 /* kill dpc */
1720 tasklet_kill(&wl->tasklet);
1721
1722 if (wl->pub) {
1723 wlc_module_unregister(wl->pub, "linux", wl);
1724 }
1725
1726 /* free common resources */
1727 if (wl->wlc) {
1728 wlc_detach(wl->wlc);
1729 wl->wlc = NULL;
1730 wl->pub = NULL;
1731 }
1732
1733 /* virtual interface deletion is deferred so we cannot spinwait */
1734
1735 /* wait for all pending callbacks to complete */
1736 while (atomic_read(&wl->callbacks) > 0)
1737 schedule();
1738
1739 /* free timers */
1740 for (t = wl->timers; t; t = next) {
1741 next = t->next;
1742#ifdef BCMDBG
1743 if (t->name)
1744 MFREE(wl->osh, t->name, strlen(t->name) + 1);
1745#endif
1746 MFREE(wl->osh, t, sizeof(wl_timer_t));
1747 }
1748
1749 if (wl->ioctlbuf_sz) {
1750 remove_proc_entry(PROC_ENTRY_NAME, NULL);
1751 vfree(wl->ioctlbuf);
1752 wl->ioctlbuf_sz = 0;
1753 }
1754
1755 osh = wl->osh;
1756
1757 /*
1758 * unregister_netdev() calls get_stats() which may read chip registers
1759 * so we cannot unmap the chip registers until after calling unregister_netdev() .
1760 */
1761 if (wl->regsva && BUSTYPE(wl->bcm_bustype) != SDIO_BUS &&
1762 BUSTYPE(wl->bcm_bustype) != JTAG_BUS) {
1763 iounmap((void *)wl->regsva);
1764 }
1765 wl->regsva = NULL;
1766
1767#ifdef WLC_HIGH_ONLY
1768 wl_rpcq_free(wl);
1769
1770 wl_txq_free(wl);
1771
1772 if (wl->rpc) {
1773 bcm_rpc_detach(wl->rpc);
1774 wl->rpc = NULL;
1775 }
1776
1777 if (wl->rpc_th) {
1778 bcm_rpc_tp_detach(wl->rpc_th);
1779 wl->rpc_th = NULL;
1780 }
1781#endif /* WLC_HIGH_ONLY */
1782
1783 if (osl_malloced(osh)) {
1784 printf("**** Memory leak of bytes %d\n", osl_malloced(osh));
1785 ASSERT(0 && "Memory Leak");
1786 }
1787
1788 osl_detach(osh);
1789}
1790
1791#ifdef WLC_LOW
1792/* transmit a packet */
7cc4a4c0 1793static int BCMFASTPATH wl_start(struct sk_buff *skb, wl_info_t *wl)
a9533e7e
HP		 1794{
1795 if (!wl)
1796 return -ENETDOWN;
1797
1798 return wl_start_int(wl, WL_TO_HW(wl), skb);
1799}
1800#endif /* WLC_LOW */
1801
1802static int BCMFASTPATH
7cc4a4c0 1803wl_start_int(wl_info_t *wl, struct ieee80211_hw *hw, struct sk_buff *skb)
a9533e7e
HP		 1804{
1805#ifdef WLC_HIGH_ONLY
1806 WL_LOCK(wl);
1807#endif
1808 wlc_sendpkt_mac80211(wl->wlc, skb, hw);
1809#ifdef WLC_HIGH_ONLY
1810 WL_UNLOCK(wl);
1811#endif
90ea2296 1812 return NETDEV_TX_OK;
a9533e7e
HP		 1813}
1814
7cc4a4c0 1815void wl_txflowcontrol(wl_info_t *wl, struct wl_if *wlif, bool state, int prio)
a9533e7e
HP		 1816{
1817 WL_ERROR(("Shouldn't be here %s\n", __func__));
1818}
1819
1820#if defined(WLC_HIGH_ONLY)
1821/* Schedule a completion handler to run at safe time */
1822static int
7cc4a4c0 1823wl_schedule_task(wl_info_t *wl, void (*fn) (struct wl_task *task),
a9533e7e
HP		 1824 void *context)
1825{
1826 wl_task_t *task;
1827
1828 WL_TRACE(("wl%d: wl_schedule_task\n", wl->pub->unit));
1829
1830 if (!(task = osl_malloc(wl->osh, sizeof(wl_task_t)))) {
1831 WL_ERROR(("wl%d: wl_schedule_task: out of memory, malloced %d bytes\n", wl->pub->unit, osl_malloced(wl->osh)));
1832 return -ENOMEM;
1833 }
1834
1835 MY_INIT_WORK(&task->work, (work_func_t) fn);
1836 task->context = context;
1837
1838 if (!schedule_work(&task->work)) {
1839 WL_ERROR(("wl%d: schedule_work() failed\n", wl->pub->unit));
1840 MFREE(wl->osh, task, sizeof(wl_task_t));
1841 return -ENOMEM;
1842 }
1843
1844 atomic_inc(&wl->callbacks);
1845
1846 return 0;
1847}
1848#endif /* defined(WLC_HIGH_ONLY) */
1849
7cc4a4c0 1850void wl_init(wl_info_t *wl)
a9533e7e
HP		 1851{
1852 WL_TRACE(("wl%d: wl_init\n", wl->pub->unit));
1853
1854 wl_reset(wl);
1855
1856 wlc_init(wl->wlc);
1857}
1858
7cc4a4c0 1859uint wl_reset(wl_info_t *wl)
a9533e7e
HP		 1860{
1861 WL_TRACE(("wl%d: wl_reset\n", wl->pub->unit));
1862
1863 wlc_reset(wl->wlc);
1864
1865 /* dpc will not be rescheduled */
1866 wl->resched = 0;
1867
90ea2296 1868 return 0;
a9533e7e
HP		 1869}
1870
1871/*
1872 * These are interrupt on/off entry points. Disable interrupts
1873 * during interrupt state transition.
1874 */
7cc4a4c0 1875void BCMFASTPATH wl_intrson(wl_info_t *wl)
a9533e7e
HP		 1876{
1877#if defined(WLC_LOW)
1878 unsigned long flags;
1879
1880 INT_LOCK(wl, flags);
1881 wlc_intrson(wl->wlc);
1882 INT_UNLOCK(wl, flags);
1883#endif /* WLC_LOW */
1884}
1885
7cc4a4c0 1886bool wl_alloc_dma_resources(wl_info_t *wl, uint addrwidth)
a9533e7e
HP		 1887{
1888 return TRUE;
1889}
1890
7cc4a4c0 1891uint32 BCMFASTPATH wl_intrsoff(wl_info_t *wl)
a9533e7e
HP		 1892{
1893#if defined(WLC_LOW)
1894 unsigned long flags;
1895 uint32 status;
1896
1897 INT_LOCK(wl, flags);
1898 status = wlc_intrsoff(wl->wlc);
1899 INT_UNLOCK(wl, flags);
1900 return status;
1901#else
1902 return 0;
1903#endif /* WLC_LOW */
1904}
1905
7cc4a4c0 1906void wl_intrsrestore(wl_info_t *wl, uint32 macintmask)
a9533e7e
HP		 1907{
1908#if defined(WLC_LOW)
1909 unsigned long flags;
1910
1911 INT_LOCK(wl, flags);
1912 wlc_intrsrestore(wl->wlc, macintmask);
1913 INT_UNLOCK(wl, flags);
1914#endif /* WLC_LOW */
1915}
1916
7cc4a4c0 1917int wl_up(wl_info_t *wl)
a9533e7e
HP		 1918{
1919 int error = 0;
1920
1921 if (wl->pub->up)
90ea2296 1922 return 0;
a9533e7e
HP		 1923
1924 error = wlc_up(wl->wlc);
1925
90ea2296 1926 return error;
a9533e7e
HP		 1927}
1928
7cc4a4c0 1929void wl_down(wl_info_t *wl)
a9533e7e
HP		 1930{
1931 uint callbacks, ret_val = 0;
1932
1933 /* call common down function */
1934 ret_val = wlc_down(wl->wlc);
1935 callbacks = atomic_read(&wl->callbacks) - ret_val;
1936
1937 /* wait for down callbacks to complete */
1938 WL_UNLOCK(wl);
1939
1940#ifndef WLC_HIGH_ONLY
1941 /* For HIGH_only driver, it's important to actually schedule other work,
1942 * not just spin wait since everything runs at schedule level
1943 */
1944 SPINWAIT((atomic_read(&wl->callbacks) > callbacks), 100 * 1000);
1945#endif /* WLC_HIGH_ONLY */
1946
1947 WL_LOCK(wl);
1948}
1949
1950irqreturn_t BCMFASTPATH wl_isr(int irq, void *dev_id)
1951{
1952#if defined(WLC_LOW)
1953 wl_info_t *wl;
1954 bool ours, wantdpc;
1955 unsigned long flags;
1956
1957 wl = (wl_info_t *) dev_id;
1958
1959 WL_ISRLOCK(wl, flags);
1960
1961 /* call common first level interrupt handler */
1962 if ((ours = wlc_isr(wl->wlc, &wantdpc))) {
1963 /* if more to do... */
1964 if (wantdpc) {
1965
1966 /* ...and call the second level interrupt handler */
1967 /* schedule dpc */
1968 ASSERT(wl->resched == FALSE);
1969 tasklet_schedule(&wl->tasklet);
1970 }
1971 }
1972
1973 WL_ISRUNLOCK(wl, flags);
1974
1975 return IRQ_RETVAL(ours);
1976#else
1977 return IRQ_RETVAL(0);
1978#endif /* WLC_LOW */
1979}
1980
1981static void BCMFASTPATH wl_dpc(ulong data)
1982{
1983#ifdef WLC_LOW
1984 wl_info_t *wl;
1985
1986 wl = (wl_info_t *) data;
1987
1988 WL_LOCK(wl);
1989
1990 /* call the common second level interrupt handler */
1991 if (wl->pub->up) {
1992 if (wl->resched) {
1993 unsigned long flags;
1994
1995 INT_LOCK(wl, flags);
1996 wlc_intrsupd(wl->wlc);
1997 INT_UNLOCK(wl, flags);
1998 }
1999
2000 wl->resched = wlc_dpc(wl->wlc, TRUE);
2001 }
2002
2003 /* wlc_dpc() may bring the driver down */
2004 if (!wl->pub->up)
2005 goto done;
2006
2007 /* re-schedule dpc */
2008 if (wl->resched)
2009 tasklet_schedule(&wl->tasklet);
2010 else {
2011 /* re-enable interrupts */
2012 wl_intrson(wl);
2013 }
2014
2015 done:
2016 WL_UNLOCK(wl);
2017#endif /* WLC_LOW */
2018}
2019
7cc4a4c0 2020static void wl_link_up(wl_info_t *wl, char *ifname)
a9533e7e
HP		 2021{
2022 WL_ERROR(("wl%d: link up (%s)\n", wl->pub->unit, ifname));
2023}
2024
7cc4a4c0 2025static void wl_link_down(wl_info_t *wl, char *ifname)
a9533e7e
HP		 2026{
2027 WL_ERROR(("wl%d: link down (%s)\n", wl->pub->unit, ifname));
2028}
2029
7cc4a4c0 2030void wl_event(wl_info_t *wl, char *ifname, wlc_event_t *e)
a9533e7e
HP		 2031{
2032
2033 switch (e->event.event_type) {
2034 case WLC_E_LINK:
2035 case WLC_E_NDIS_LINK:
2036 if (e->event.flags & WLC_EVENT_MSG_LINK)
2037 wl_link_up(wl, ifname);
2038 else
2039 wl_link_down(wl, ifname);
2040 break;
2041 case WLC_E_RADIO:
2042 break;
2043 }
2044}
2045
2046static void wl_timer(ulong data)
2047{
2048#ifndef WLC_HIGH_ONLY
2049 _wl_timer((wl_timer_t *) data);
2050#else
2051 wl_timer_t *t = (wl_timer_t *) data;
2052 wl_schedule_task(t->wl, wl_timer_task, t);
2053#endif /* WLC_HIGH_ONLY */
2054}
2055
7cc4a4c0 2056static void _wl_timer(wl_timer_t *t)
a9533e7e
HP		 2057{
2058 WL_LOCK(t->wl);
2059
2060 if (t->set) {
2061 if (t->periodic) {
2062 t->timer.expires = jiffies + t->ms * HZ / 1000;
2063 atomic_inc(&t->wl->callbacks);
2064 add_timer(&t->timer);
2065 t->set = TRUE;
2066 } else
2067 t->set = FALSE;
2068
2069 t->fn(t->arg);
2070 }
2071
2072 atomic_dec(&t->wl->callbacks);
2073
2074 WL_UNLOCK(t->wl);
2075}
2076
7cc4a4c0 2077wl_timer_t *wl_init_timer(wl_info_t *wl, void (*fn) (void *arg), void *arg,
a9533e7e
HP		 2078 const char *name)
2079{
2080 wl_timer_t *t;
2081
2082 if (!(t = osl_malloc(wl->osh, sizeof(wl_timer_t)))) {
2083 WL_ERROR(("wl%d: wl_init_timer: out of memory, malloced %d bytes\n", wl->pub->unit, osl_malloced(wl->osh)));
2084 return 0;
2085 }
2086
2087 bzero(t, sizeof(wl_timer_t));
2088
2089 init_timer(&t->timer);
2090 t->timer.data = (ulong) t;
2091 t->timer.function = wl_timer;
2092 t->wl = wl;
2093 t->fn = fn;
2094 t->arg = arg;
2095 t->next = wl->timers;
2096 wl->timers = t;
2097
2098#ifdef BCMDBG
2099 if ((t->name = osl_malloc(wl->osh, strlen(name) + 1)))
2100 strcpy(t->name, name);
2101#endif
2102
2103 return t;
2104}
2105
2106/* BMAC_NOTE: Add timer adds only the kernel timer since it's going to be more accurate
2107 * as well as it's easier to make it periodic
2108 */
7cc4a4c0 2109void wl_add_timer(wl_info_t *wl, wl_timer_t *t, uint ms, int periodic)
a9533e7e
HP		 2110{
2111#ifdef BCMDBG
2112 if (t->set) {
2113 WL_ERROR(("%s: Already set. Name: %s, per %d\n",
2114 __func__, t->name, periodic));
2115 }
2116#endif
2117 ASSERT(!t->set);
2118
2119 t->ms = ms;
2120 t->periodic = (bool) periodic;
2121 t->set = TRUE;
2122 t->timer.expires = jiffies + ms * HZ / 1000;
2123
2124 atomic_inc(&wl->callbacks);
2125 add_timer(&t->timer);
2126}
2127
2128/* return TRUE if timer successfully deleted, FALSE if still pending */
7cc4a4c0 2129bool wl_del_timer(wl_info_t *wl, wl_timer_t *t)
a9533e7e
HP		 2130{
2131 if (t->set) {
2132 t->set = FALSE;
2133 if (!del_timer(&t->timer)) {
2134 return FALSE;
2135 }
2136 atomic_dec(&wl->callbacks);
2137 }
2138
2139 return TRUE;
2140}
2141
7cc4a4c0 2142void wl_free_timer(wl_info_t *wl, wl_timer_t *t)
a9533e7e
HP		 2143{
2144 wl_timer_t *tmp;
2145
2146 /* delete the timer in case it is active */
2147 wl_del_timer(wl, t);
2148
2149 if (wl->timers == t) {
2150 wl->timers = wl->timers->next;
2151#ifdef BCMDBG
2152 if (t->name)
2153 MFREE(wl->osh, t->name, strlen(t->name) + 1);
2154#endif
2155 MFREE(wl->osh, t, sizeof(wl_timer_t));
2156 return;
2157
2158 }
2159
2160 tmp = wl->timers;
2161 while (tmp) {
2162 if (tmp->next == t) {
2163 tmp->next = t->next;
2164#ifdef BCMDBG
2165 if (t->name)
2166 MFREE(wl->osh, t->name, strlen(t->name) + 1);
2167#endif
2168 MFREE(wl->osh, t, sizeof(wl_timer_t));
2169 return;
2170 }
2171 tmp = tmp->next;
2172 }
2173
2174}
2175
2176static int wl_linux_watchdog(void *ctx)
2177{
2178 wl_info_t *wl = (wl_info_t *) ctx;
2179 struct net_device_stats *stats = NULL;
2180 uint id;
2181 /* refresh stats */
2182 if (wl->pub->up) {
2183 ASSERT(wl->stats_id < 2);
2184
2185 id = 1 - wl->stats_id;
2186
2187 stats = &wl->stats_watchdog[id];
2188 stats->rx_packets = WLCNTVAL(wl->pub->_cnt->rxframe);
2189 stats->tx_packets = WLCNTVAL(wl->pub->_cnt->txframe);
2190 stats->rx_bytes = WLCNTVAL(wl->pub->_cnt->rxbyte);
2191 stats->tx_bytes = WLCNTVAL(wl->pub->_cnt->txbyte);
2192 stats->rx_errors = WLCNTVAL(wl->pub->_cnt->rxerror);
2193 stats->tx_errors = WLCNTVAL(wl->pub->_cnt->txerror);
2194 stats->collisions = 0;
2195
2196 stats->rx_length_errors = 0;
2197 stats->rx_over_errors = WLCNTVAL(wl->pub->_cnt->rxoflo);
2198 stats->rx_crc_errors = WLCNTVAL(wl->pub->_cnt->rxcrc);
2199 stats->rx_frame_errors = 0;
2200 stats->rx_fifo_errors = WLCNTVAL(wl->pub->_cnt->rxoflo);
2201 stats->rx_missed_errors = 0;
2202
2203 stats->tx_fifo_errors = WLCNTVAL(wl->pub->_cnt->txuflo);
2204
2205 wl->stats_id = id;
2206
2207 }
2208
2209 return 0;
2210}
2211
2212struct wl_fw_hdr {
2213 uint32 offset;
2214 uint32 len;
2215 uint32 idx;
2216};
2217
2218#ifdef WLC_HIGH_ONLY
2219static void wl_rpc_down(void *wlh)
2220{
2221 wl_info_t *wl = (wl_info_t *) (wlh);
2222
2223 wlc_device_removed(wl->wlc);
2224
2225 wl_rpcq_free(wl);
2226}
2227
7cc4a4c0 2228static int BCMFASTPATH wl_start(struct sk_buff *skb, wl_info_t *wl)
a9533e7e
HP		 2229{
2230
2231 ulong flags;
2232
2233 skb->prev = NULL;
2234
2235 /* Lock the queue as tasklet could be running at this time */
2236 TXQ_LOCK(wl, flags);
2237 if (wl->txq_head == NULL)
2238 wl->txq_head = skb;
2239 else {
2240 wl->txq_tail->prev = skb;
2241 }
2242 wl->txq_tail = skb;
2243
2244 if (wl->txq_dispatched == FALSE) {
2245 wl->txq_dispatched = TRUE;
2246
2247 if (schedule_work(&wl->txq_task.work)) {
2248 atomic_inc(&wl->callbacks);
2249 } else {
2250 WL_ERROR(("wl%d: wl_start/schedule_work failed\n",
2251 wl->pub->unit));
2252 }
2253 }
2254
2255 TXQ_UNLOCK(wl, flags);
2256
90ea2296 2257 return 0;
a9533e7e
HP		 2258
2259}
2260
2261static void wl_start_txqwork(struct wl_task *task)
2262{
2263 wl_info_t *wl = (wl_info_t *) task->context;
2264 struct sk_buff *skb;
2265 ulong flags;
2266 uint count = 0;
2267
2268 WL_TRACE(("wl%d: wl_start_txqwork\n", wl->pub->unit));
2269
2270 /* First remove an entry then go for execution */
2271 TXQ_LOCK(wl, flags);
2272 while (wl->txq_head) {
2273 skb = wl->txq_head;
2274 wl->txq_head = skb->prev;
2275 skb->prev = NULL;
2276 if (wl->txq_head == NULL)
2277 wl->txq_tail = NULL;
2278 TXQ_UNLOCK(wl, flags);
2279
2280 /* it has WL_LOCK/WL_UNLOCK inside */
2281 wl_start_int(wl, WL_TO_HW(wl), skb);
2282
2283 /* bounded our execution, reshedule ourself next */
2284 if (++count >= 10)
2285 break;
2286
2287 TXQ_LOCK(wl, flags);
2288 }
2289
2290 if (count >= 10) {
2291 if (!schedule_work(&wl->txq_task.work)) {
2292 WL_ERROR(("wl%d: wl_start/schedule_work failed\n",
2293 wl->pub->unit));
2294 atomic_dec(&wl->callbacks);
2295 }
2296 } else {
2297 wl->txq_dispatched = FALSE;
2298 TXQ_UNLOCK(wl, flags);
2299 atomic_dec(&wl->callbacks);
2300 }
2301
2302 return;
2303}
2304
7cc4a4c0 2305static void wl_txq_free(wl_info_t *wl)
a9533e7e
HP		 2306{
2307 struct sk_buff *skb;
2308
2309 if (wl->txq_head == NULL) {
2310 ASSERT(wl->txq_tail == NULL);
2311 return;
2312 }
2313
2314 while (wl->txq_head) {
2315 skb = wl->txq_head;
2316 wl->txq_head = skb->prev;
2317 PKTFREE(wl->osh, skb, TRUE);
2318 }
2319
2320 wl->txq_tail = NULL;
2321}
2322
7cc4a4c0 2323static void wl_rpcq_free(wl_info_t *wl)
a9533e7e
HP		 2324{
2325 rpc_buf_t *buf;
2326
2327 if (wl->rpcq_head == NULL) {
2328 ASSERT(wl->rpcq_tail == NULL);
2329 return;
2330 }
2331
2332 while (wl->rpcq_head) {
2333 buf = wl->rpcq_head;
2334 wl->rpcq_head = bcm_rpc_buf_next_get(wl->rpc_th, buf);
2335 bcm_rpc_buf_free(wl->rpc_dispatch_ctx.rpc, buf);
2336 }
2337
2338 wl->rpcq_tail = NULL;
2339}
2340
2341static void wl_rpcq_dispatch(struct wl_task *task)
2342{
2343 wl_info_t *wl = (wl_info_t *) task->context;
2344 rpc_buf_t *buf;
2345 ulong flags;
2346
2347 /* First remove an entry then go for execution */
2348 RPCQ_LOCK(wl, flags);
2349 while (wl->rpcq_head) {
2350 buf = wl->rpcq_head;
2351 wl->rpcq_head = bcm_rpc_buf_next_get(wl->rpc_th, buf);
2352
2353 if (wl->rpcq_head == NULL)
2354 wl->rpcq_tail = NULL;
2355 RPCQ_UNLOCK(wl, flags);
2356
2357 WL_LOCK(wl);
2358 wlc_rpc_high_dispatch(&wl->rpc_dispatch_ctx, buf);
2359 WL_UNLOCK(wl);
2360
2361 RPCQ_LOCK(wl, flags);
2362 }
2363
2364 wl->rpcq_dispatched = FALSE;
2365
2366 RPCQ_UNLOCK(wl, flags);
2367
2368 MFREE(wl->osh, task, sizeof(wl_task_t));
2369 atomic_dec(&wl->callbacks);
2370}
2371
7cc4a4c0 2372static void wl_rpcq_add(wl_info_t *wl, rpc_buf_t *buf)
a9533e7e
HP		 2373{
2374 ulong flags;
2375
2376 bcm_rpc_buf_next_set(wl->rpc_th, buf, NULL);
2377
2378 /* Lock the queue as tasklet could be running at this time */
2379 RPCQ_LOCK(wl, flags);
2380 if (wl->rpcq_head == NULL)
2381 wl->rpcq_head = buf;
2382 else
2383 bcm_rpc_buf_next_set(wl->rpc_th, wl->rpcq_tail, buf);
2384
2385 wl->rpcq_tail = buf;
2386
2387 if (wl->rpcq_dispatched == FALSE) {
2388 wl->rpcq_dispatched = TRUE;
2389 wl_schedule_task(wl, wl_rpcq_dispatch, wl);
2390 }
2391
2392 RPCQ_UNLOCK(wl, flags);
2393}
2394
2395#if defined(BCMDBG)
2396static const struct name_entry rpc_name_tbl[] = RPC_ID_TABLE;
2397#endif /* BCMDBG */
2398
2399/* dongle-side rpc dispatch routine */
2400static void wl_rpc_dispatch_schedule(void *ctx, struct rpc_buf *buf)
2401{
2402 bcm_xdr_buf_t b;
2403 wl_info_t *wl = (wl_info_t *) ctx;
2404 wlc_rpc_id_t rpc_id;
2405 int err;
2406
2407 bcm_xdr_buf_init(&b, bcm_rpc_buf_data(wl->rpc_th, buf),
2408 bcm_rpc_buf_len_get(wl->rpc_th, buf));
2409
2410 err = bcm_xdr_unpack_uint32(&b, &rpc_id);
2411 ASSERT(!err);
2412 WL_TRACE(("%s: Dispatch id %s\n", __func__,
2413 WLC_RPC_ID_LOOKUP(rpc_name_tbl, rpc_id)));
2414
2415 /* Handle few emergency ones */
2416 switch (rpc_id) {
2417 default:
2418 wl_rpcq_add(wl, buf);
2419 break;
2420 }
2421}
2422
7cc4a4c0 2423static void wl_timer_task(wl_task_t *task)
a9533e7e
HP		 2424{
2425 wl_timer_t *t = (wl_timer_t *) task->context;
2426
2427 _wl_timer(t);
2428 MFREE(t->wl->osh, task, sizeof(wl_task_t));
2429
2430 /* This dec is for the task_schedule. The timer related
2431 * callback is decremented in _wl_timer
2432 */
2433 atomic_dec(&t->wl->callbacks);
2434}
2435#endif /* WLC_HIGH_ONLY */
2436
2437#ifndef WLC_HIGH_ONLY
2438char *wl_firmwares[WL_MAX_FW] = {
2439 "brcm/bcm43xx",
2440 NULL
2441};
2442
2443#ifdef WLC_LOW
7cc4a4c0 2444int wl_ucode_init_buf(wl_info_t *wl, void **pbuf, uint32 idx)
a9533e7e
HP		 2445{
2446 int i, entry;
2447 const uint8 *pdata;
2448 struct wl_fw_hdr *hdr;
2449 for (i = 0; i < wl->fw.fw_cnt; i++) {
2450 hdr = (struct wl_fw_hdr *)wl->fw.fw_hdr[i]->data;
2451 for (entry = 0; entry < wl->fw.hdr_num_entries[i];
2452 entry++, hdr++) {
2453 if (hdr->idx == idx) {
2454 pdata = wl->fw.fw_bin[i]->data + hdr->offset;
2455 *pbuf = kmalloc(hdr->len, GFP_ATOMIC);
2456 if (*pbuf == NULL) {
2457 printf("fail to alloc %d bytes\n",
2458 hdr->len);
2459 }
2460 bcopy(pdata, *pbuf, hdr->len);
2461 return 0;
2462 }
2463 }
2464 }
2465 printf("ERROR: ucode buf tag:%d can not be found!\n", idx);
2466 *pbuf = NULL;
2467 return -1;
2468}
2469
7cc4a4c0 2470int wl_ucode_init_uint(wl_info_t *wl, uint32 *data, uint32 idx)
a9533e7e
HP		 2471{
2472 int i, entry;
2473 const uint8 *pdata;
2474 struct wl_fw_hdr *hdr;
2475 for (i = 0; i < wl->fw.fw_cnt; i++) {
2476 hdr = (struct wl_fw_hdr *)wl->fw.fw_hdr[i]->data;
2477 for (entry = 0; entry < wl->fw.hdr_num_entries[i];
2478 entry++, hdr++) {
2479 if (hdr->idx == idx) {
2480 pdata = wl->fw.fw_bin[i]->data + hdr->offset;
2481 ASSERT(hdr->len == 4);
2482 *data = *((uint32 *) pdata);
2483 return 0;
2484 }
2485 }
2486 }
2487 printf("ERROR: ucode tag:%d can not be found!\n", idx);
2488 return -1;
2489}
2490#endif /* WLC_LOW */
2491
7cc4a4c0 2492static int wl_request_fw(wl_info_t *wl, struct pci_dev *pdev)
a9533e7e
HP		 2493{
2494 int status;
2495 struct device *device = &pdev->dev;
2496 char fw_name[100];
2497 int i;
2498
2499 bzero((void *)&wl->fw, sizeof(struct wl_firmware));
2500 for (i = 0; i < WL_MAX_FW; i++) {
2501 if (wl_firmwares[i] == NULL)
2502 break;
2503 sprintf(fw_name, "%s-%d.fw", wl_firmwares[i],
2504 UCODE_LOADER_API_VER);
2505 WL_NONE(("request fw %s\n", fw_name));
2506 status = request_firmware(&wl->fw.fw_bin[i], fw_name, device);
2507 if (status) {
2508 printf("fail to request firmware %s\n", fw_name);
eb4764c3 2509 wl_release_fw(wl);
a9533e7e
HP		 2510 return status;
2511 }
2512 WL_NONE(("request fw %s\n", fw_name));
2513 sprintf(fw_name, "%s_hdr-%d.fw", wl_firmwares[i],
2514 UCODE_LOADER_API_VER);
2515 status = request_firmware(&wl->fw.fw_hdr[i], fw_name, device);
2516 if (status) {
2517 printf("fail to request firmware %s\n", fw_name);
eb4764c3 2518 wl_release_fw(wl);
a9533e7e
HP		 2519 return status;
2520 }
2521 wl->fw.hdr_num_entries[i] =
2522 wl->fw.fw_hdr[i]->size / (sizeof(struct wl_fw_hdr));
2523 WL_NONE(("request fw %s find: %d entries\n", fw_name,
2524 wl->fw.hdr_num_entries[i]));
2525 }
2526 wl->fw.fw_cnt = i;
2527 wl_ucode_data_init(wl);
2528 return 0;
2529}
2530
2531#ifdef WLC_LOW
2532void wl_ucode_free_buf(void *p)
2533{
2534 kfree(p);
2535}
2536#endif /* WLC_LOW */
2537
7cc4a4c0 2538static void wl_release_fw(wl_info_t *wl)
a9533e7e
HP		 2539{
2540 int i;
eb4764c3 2541 for (i = 0; i < WL_MAX_FW; i++) {
a9533e7e
HP		 2542 release_firmware(wl->fw.fw_bin[i]);
2543 release_firmware(wl->fw.fw_hdr[i]);
2544 }
2545}
2546#endif /* WLC_HIGH_ONLY */
kernel source for telekom puls (alcatel/mediatek)