e94e96955b99ba2268a0f0f3e3343125298eb676
[linux-2.6.git] / drivers / net / wireless / iwmc3200wifi / netdev.c
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 "commands.h"
52 #include "cfg80211.h"
53 #include "debug.h"
54
55 static int iwm_open(struct net_device *ndev)
56 {
57         struct iwm_priv *iwm = ndev_to_iwm(ndev);
58
59         return iwm_up(iwm);
60 }
61
62 static int iwm_stop(struct net_device *ndev)
63 {
64         struct iwm_priv *iwm = ndev_to_iwm(ndev);
65
66         return iwm_down(iwm);
67 }
68
69 /*
70  * iwm AC to queue mapping
71  *
72  * AC_VO -> queue 3
73  * AC_VI -> queue 2
74  * AC_BE -> queue 1
75  * AC_BK -> queue 0
76  */
77 static const u16 iwm_1d_to_queue[8] = { 1, 0, 0, 1, 2, 2, 3, 3 };
78
79 static u16 iwm_select_queue(struct net_device *dev, struct sk_buff *skb)
80 {
81         skb->priority = cfg80211_classify8021d(skb);
82
83         return iwm_1d_to_queue[skb->priority];
84 }
85
86 static const struct net_device_ops iwm_netdev_ops = {
87         .ndo_open               = iwm_open,
88         .ndo_stop               = iwm_stop,
89         .ndo_start_xmit         = iwm_xmit_frame,
90         .ndo_select_queue       = iwm_select_queue,
91 };
92
93 void *iwm_if_alloc(int sizeof_bus, struct device *dev,
94                    struct iwm_if_ops *if_ops)
95 {
96         struct net_device *ndev;
97         struct wireless_dev *wdev;
98         struct iwm_priv *iwm;
99         int ret = 0;
100
101         wdev = iwm_wdev_alloc(sizeof_bus, dev);
102         if (!wdev) {
103                 dev_err(dev, "no memory for wireless device instance\n");
104                 return ERR_PTR(-ENOMEM);
105         }
106
107         iwm = wdev_to_iwm(wdev);
108         iwm->bus_ops = if_ops;
109         iwm->wdev = wdev;
110
111         ret = iwm_priv_init(iwm);
112         if (ret) {
113                 dev_err(dev, "failed to init iwm_priv\n");
114                 goto out_wdev;
115         }
116
117         wdev->iftype = iwm_mode_to_nl80211_iftype(iwm->conf.mode);
118
119         ndev = alloc_netdev_mq(0, "wlan%d", ether_setup, IWM_TX_QUEUES);
120         if (!ndev) {
121                 dev_err(dev, "no memory for network device instance\n");
122                 goto out_priv;
123         }
124
125         ndev->netdev_ops = &iwm_netdev_ops;
126         ndev->wireless_handlers = &iwm_iw_handler_def;
127         ndev->ieee80211_ptr = wdev;
128         SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy));
129         wdev->netdev = ndev;
130
131         iwm->umac_profile = kmalloc(sizeof(struct iwm_umac_profile),
132                                     GFP_KERNEL);
133         if (!iwm->umac_profile) {
134                 dev_err(dev, "Couldn't alloc memory for profile\n");
135                 goto out_profile;
136         }
137
138         iwm_init_default_profile(iwm, iwm->umac_profile);
139
140         return iwm;
141
142  out_profile:
143         free_netdev(ndev);
144
145  out_priv:
146         iwm_priv_deinit(iwm);
147
148  out_wdev:
149         iwm_wdev_free(iwm);
150         return ERR_PTR(ret);
151 }
152
153 void iwm_if_free(struct iwm_priv *iwm)
154 {
155         if (!iwm_to_ndev(iwm))
156                 return;
157
158         free_netdev(iwm_to_ndev(iwm));
159         iwm_wdev_free(iwm);
160         iwm_priv_deinit(iwm);
161         kfree(iwm->umac_profile);
162         iwm->umac_profile = NULL;
163 }
164
165 int iwm_if_add(struct iwm_priv *iwm)
166 {
167         struct net_device *ndev = iwm_to_ndev(iwm);
168         int ret;
169
170         ret = register_netdev(ndev);
171         if (ret < 0) {
172                 dev_err(&ndev->dev, "Failed to register netdev: %d\n", ret);
173                 return ret;
174         }
175
176         return 0;
177 }
178
179 void iwm_if_remove(struct iwm_priv *iwm)
180 {
181         unregister_netdev(iwm_to_ndev(iwm));
182 }