Commit | Line | Data |
---|---|---|
bb9f8692 ZY |
1 | /* |
2 | * Intel Wireless Multicomm 3200 WiFi driver | |
3 | * | |
4 | * Copyright (C) 2009 Intel Corporation <ilw@linux.intel.com> | |
5 | * Samuel Ortiz <samuel.ortiz@intel.com> | |
6 | * Zhu Yi <yi.zhu@intel.com> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or | |
9 | * modify it under the terms of the GNU General Public License version | |
10 | * 2 as published by the Free Software Foundation. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | * GNU General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | |
20 | * 02110-1301, USA. | |
21 | * | |
22 | */ | |
23 | ||
24 | /* | |
25 | * This is the netdev related hooks for iwm. | |
26 | * | |
27 | * Some interesting code paths: | |
28 | * | |
29 | * iwm_open() (Called at netdev interface bringup time) | |
30 | * -> iwm_up() (main.c) | |
31 | * -> iwm_bus_enable() | |
32 | * -> if_sdio_enable() (In case of an SDIO bus) | |
33 | * -> sdio_enable_func() | |
34 | * -> iwm_notif_wait(BARKER_REBOOT) (wait for reboot barker) | |
35 | * -> iwm_notif_wait(ACK_BARKER) (wait for ACK barker) | |
36 | * -> iwm_load_fw() (fw.c) | |
37 | * -> iwm_load_umac() | |
38 | * -> iwm_load_lmac() (Calibration LMAC) | |
39 | * -> iwm_load_lmac() (Operational LMAC) | |
40 | * -> iwm_send_umac_config() | |
41 | * | |
42 | * iwm_stop() (Called at netdev interface bringdown time) | |
43 | * -> iwm_down() | |
44 | * -> iwm_bus_disable() | |
45 | * -> if_sdio_disable() (In case of an SDIO bus) | |
46 | * -> sdio_disable_func() | |
47 | */ | |
48 | #include <linux/netdevice.h> | |
49 | ||
50 | #include "iwm.h" | |
51 | #include "cfg80211.h" | |
52 | #include "debug.h" | |
53 | ||
54 | static int iwm_open(struct net_device *ndev) | |
55 | { | |
56 | struct iwm_priv *iwm = ndev_to_iwm(ndev); | |
57 | int ret = 0; | |
58 | ||
59 | if (!test_bit(IWM_RADIO_RFKILL_SW, &iwm->radio)) | |
60 | ret = iwm_up(iwm); | |
61 | ||
62 | return ret; | |
63 | } | |
64 | ||
65 | static int iwm_stop(struct net_device *ndev) | |
66 | { | |
67 | struct iwm_priv *iwm = ndev_to_iwm(ndev); | |
68 | int ret = 0; | |
69 | ||
70 | if (!test_bit(IWM_RADIO_RFKILL_SW, &iwm->radio)) | |
71 | ret = iwm_down(iwm); | |
72 | ||
73 | return ret; | |
74 | } | |
75 | ||
76 | /* | |
77 | * iwm AC to queue mapping | |
78 | * | |
79 | * AC_VO -> queue 3 | |
80 | * AC_VI -> queue 2 | |
81 | * AC_BE -> queue 1 | |
82 | * AC_BK -> queue 0 | |
83 | */ | |
84 | static const u16 iwm_1d_to_queue[8] = { 1, 0, 0, 1, 2, 2, 3, 3 }; | |
85 | ||
86 | static u16 iwm_select_queue(struct net_device *dev, struct sk_buff *skb) | |
87 | { | |
88 | skb->priority = cfg80211_classify8021d(skb); | |
89 | ||
90 | return iwm_1d_to_queue[skb->priority]; | |
91 | } | |
92 | ||
93 | static const struct net_device_ops iwm_netdev_ops = { | |
94 | .ndo_open = iwm_open, | |
95 | .ndo_stop = iwm_stop, | |
96 | .ndo_start_xmit = iwm_xmit_frame, | |
97 | .ndo_select_queue = iwm_select_queue, | |
98 | }; | |
99 | ||
100 | void *iwm_if_alloc(int sizeof_bus, struct device *dev, | |
101 | struct iwm_if_ops *if_ops) | |
102 | { | |
103 | struct net_device *ndev; | |
104 | struct wireless_dev *wdev; | |
105 | struct iwm_priv *iwm; | |
106 | int ret = 0; | |
107 | ||
108 | wdev = iwm_wdev_alloc(sizeof_bus, dev); | |
2a21f869 DC |
109 | if (IS_ERR(wdev)) |
110 | return wdev; | |
bb9f8692 ZY |
111 | |
112 | iwm = wdev_to_iwm(wdev); | |
113 | iwm->bus_ops = if_ops; | |
114 | iwm->wdev = wdev; | |
8d96e796 ZY |
115 | |
116 | ret = iwm_priv_init(iwm); | |
117 | if (ret) { | |
118 | dev_err(dev, "failed to init iwm_priv\n"); | |
119 | goto out_wdev; | |
120 | } | |
121 | ||
bb9f8692 ZY |
122 | wdev->iftype = iwm_mode_to_nl80211_iftype(iwm->conf.mode); |
123 | ||
d7e057dc | 124 | ndev = alloc_netdev_mq(0, "wlan%d", ether_setup, IWM_TX_QUEUES); |
bb9f8692 ZY |
125 | if (!ndev) { |
126 | dev_err(dev, "no memory for network device instance\n"); | |
8d96e796 | 127 | goto out_priv; |
bb9f8692 ZY |
128 | } |
129 | ||
130 | ndev->netdev_ops = &iwm_netdev_ops; | |
131 | ndev->wireless_handlers = &iwm_iw_handler_def; | |
132 | ndev->ieee80211_ptr = wdev; | |
133 | SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy)); | |
bb9f8692 ZY |
134 | wdev->netdev = ndev; |
135 | ||
bb9f8692 ZY |
136 | return iwm; |
137 | ||
8d96e796 ZY |
138 | out_priv: |
139 | iwm_priv_deinit(iwm); | |
140 | ||
bb9f8692 ZY |
141 | out_wdev: |
142 | iwm_wdev_free(iwm); | |
143 | return ERR_PTR(ret); | |
144 | } | |
145 | ||
146 | void iwm_if_free(struct iwm_priv *iwm) | |
147 | { | |
bb9f8692 ZY |
148 | if (!iwm_to_ndev(iwm)) |
149 | return; | |
150 | ||
bb9f8692 | 151 | free_netdev(iwm_to_ndev(iwm)); |
8d96e796 | 152 | iwm_priv_deinit(iwm); |
513a2396 | 153 | iwm_wdev_free(iwm); |
bb9f8692 | 154 | } |
d7e057dc ZY |
155 | |
156 | int iwm_if_add(struct iwm_priv *iwm) | |
157 | { | |
158 | struct net_device *ndev = iwm_to_ndev(iwm); | |
159 | int ret; | |
160 | ||
161 | ret = register_netdev(ndev); | |
162 | if (ret < 0) { | |
163 | dev_err(&ndev->dev, "Failed to register netdev: %d\n", ret); | |
164 | return ret; | |
165 | } | |
166 | ||
167 | return 0; | |
168 | } | |
169 | ||
170 | void iwm_if_remove(struct iwm_priv *iwm) | |
171 | { | |
172 | unregister_netdev(iwm_to_ndev(iwm)); | |
173 | } |