Commit | Line | Data |
---|---|---|
c5c77ba1 | 1 | #include "wilc_wfi_cfgoperations.h" |
c5c77ba1 JK |
2 | #include "wilc_wlan_if.h" |
3 | #include "wilc_wlan.h" | |
c5c77ba1 JK |
4 | |
5 | #include <linux/slab.h> | |
6 | #include <linux/sched.h> | |
7 | #include <linux/delay.h> | |
8 | #include <linux/workqueue.h> | |
9 | #include <linux/interrupt.h> | |
10 | #include <linux/irq.h> | |
f1a99830 | 11 | #include <linux/gpio.h> |
c5c77ba1 JK |
12 | |
13 | #include <linux/kthread.h> | |
14 | #include <linux/firmware.h> | |
c5c77ba1 JK |
15 | |
16 | #include <linux/init.h> | |
17 | #include <linux/netdevice.h> | |
c5c77ba1 | 18 | #include <linux/inetdevice.h> |
c5c77ba1 JK |
19 | #include <linux/etherdevice.h> |
20 | #include <linux/module.h> | |
21 | #include <linux/kernel.h> | |
22 | #include <linux/skbuff.h> | |
334bed08 | 23 | #include <linux/mutex.h> |
11a54b3f | 24 | #include <linux/completion.h> |
c5c77ba1 | 25 | |
885cabcc LK |
26 | static int dev_state_ev_handler(struct notifier_block *this, |
27 | unsigned long event, void *ptr); | |
c5c77ba1 JK |
28 | |
29 | static struct notifier_block g_dev_notifier = { | |
30 | .notifier_call = dev_state_ev_handler | |
31 | }; | |
c5c77ba1 | 32 | |
7c67c053 | 33 | static int wlan_deinit_locks(struct net_device *dev); |
32dd51bc | 34 | static void wlan_deinitialize_threads(struct net_device *dev); |
c5c77ba1 | 35 | |
c5c77ba1 | 36 | static void linux_wlan_tx_complete(void *priv, int status); |
c5c77ba1 | 37 | static int mac_init_fn(struct net_device *ndev); |
c5c77ba1 JK |
38 | static struct net_device_stats *mac_stats(struct net_device *dev); |
39 | static int mac_ioctl(struct net_device *ndev, struct ifreq *req, int cmd); | |
68a30a63 EL |
40 | static int wilc_mac_open(struct net_device *ndev); |
41 | static int wilc_mac_close(struct net_device *ndev); | |
c5c77ba1 | 42 | static void wilc_set_multicast_list(struct net_device *dev); |
750ffe9b | 43 | |
0e1af73d | 44 | bool wilc_enable_ps = true; |
c5c77ba1 | 45 | |
c5c77ba1 JK |
46 | static const struct net_device_ops wilc_netdev_ops = { |
47 | .ndo_init = mac_init_fn, | |
0e1af73d AB |
48 | .ndo_open = wilc_mac_open, |
49 | .ndo_stop = wilc_mac_close, | |
50 | .ndo_start_xmit = wilc_mac_xmit, | |
c5c77ba1 JK |
51 | .ndo_do_ioctl = mac_ioctl, |
52 | .ndo_get_stats = mac_stats, | |
53 | .ndo_set_rx_mode = wilc_set_multicast_list, | |
54 | ||
55 | }; | |
c5c77ba1 | 56 | |
885cabcc LK |
57 | static int dev_state_ev_handler(struct notifier_block *this, |
58 | unsigned long event, void *ptr) | |
c5c77ba1 | 59 | { |
d5c89442 | 60 | struct in_ifaddr *dev_iface = ptr; |
2726887c | 61 | struct wilc_priv *priv; |
f24374aa | 62 | struct host_if_drv *hif_drv; |
c5c77ba1 | 63 | struct net_device *dev; |
eac3e8f6 | 64 | u8 *ip_addr_buf; |
a4cac481 | 65 | struct wilc_vif *vif; |
63d03e47 | 66 | u8 null_ip[4] = {0}; |
c5c77ba1 JK |
67 | char wlan_dev_name[5] = "wlan0"; |
68 | ||
1408603c | 69 | if (!dev_iface || !dev_iface->ifa_dev || !dev_iface->ifa_dev->dev) |
c5c77ba1 | 70 | return NOTIFY_DONE; |
c5c77ba1 | 71 | |
582f8a27 | 72 | if (memcmp(dev_iface->ifa_label, "wlan0", 5) && |
1408603c | 73 | memcmp(dev_iface->ifa_label, "p2p0", 4)) |
c5c77ba1 | 74 | return NOTIFY_DONE; |
c5c77ba1 JK |
75 | |
76 | dev = (struct net_device *)dev_iface->ifa_dev->dev; | |
1408603c | 77 | if (!dev->ieee80211_ptr || !dev->ieee80211_ptr->wiphy) |
c5c77ba1 | 78 | return NOTIFY_DONE; |
1408603c | 79 | |
c5c77ba1 | 80 | priv = wiphy_priv(dev->ieee80211_ptr->wiphy); |
1408603c | 81 | if (!priv) |
c5c77ba1 | 82 | return NOTIFY_DONE; |
1408603c | 83 | |
48b28df9 | 84 | hif_drv = (struct host_if_drv *)priv->hif_drv; |
a4cac481 | 85 | vif = netdev_priv(dev); |
1408603c | 86 | if (!vif || !hif_drv) |
c5c77ba1 | 87 | return NOTIFY_DONE; |
c5c77ba1 JK |
88 | |
89 | switch (event) { | |
90 | case NETDEV_UP: | |
a4cac481 | 91 | if (vif->iftype == STATION_MODE || vif->iftype == CLIENT_MODE) { |
f24374aa | 92 | hif_drv->IFC_UP = 1; |
0e1af73d AB |
93 | wilc_optaining_ip = false; |
94 | del_timer(&wilc_during_ip_timer); | |
c5c77ba1 JK |
95 | } |
96 | ||
0e1af73d | 97 | if (wilc_enable_ps) |
fbf5379b | 98 | wilc_set_power_mgmt(vif, 1, 0); |
c5c77ba1 | 99 | |
5ac24427 | 100 | netdev_dbg(dev, "[%s] Up IP\n", dev_iface->ifa_label); |
c5c77ba1 | 101 | |
eac3e8f6 | 102 | ip_addr_buf = (char *)&dev_iface->ifa_address; |
5ac24427 LK |
103 | netdev_dbg(dev, "IP add=%d:%d:%d:%d\n", |
104 | ip_addr_buf[0], ip_addr_buf[1], | |
105 | ip_addr_buf[2], ip_addr_buf[3]); | |
6750140d | 106 | wilc_setup_ipaddress(vif, ip_addr_buf, vif->idx); |
c5c77ba1 JK |
107 | |
108 | break; | |
109 | ||
110 | case NETDEV_DOWN: | |
a4cac481 | 111 | if (vif->iftype == STATION_MODE || vif->iftype == CLIENT_MODE) { |
f24374aa | 112 | hif_drv->IFC_UP = 0; |
0e1af73d | 113 | wilc_optaining_ip = false; |
c5c77ba1 JK |
114 | } |
115 | ||
116 | if (memcmp(dev_iface->ifa_label, wlan_dev_name, 5) == 0) | |
fbf5379b | 117 | wilc_set_power_mgmt(vif, 0, 0); |
c5c77ba1 | 118 | |
fbf5379b | 119 | wilc_resolve_disconnect_aberration(vif); |
c5c77ba1 | 120 | |
5ac24427 | 121 | netdev_dbg(dev, "[%s] Down IP\n", dev_iface->ifa_label); |
c5c77ba1 | 122 | |
eac3e8f6 | 123 | ip_addr_buf = null_ip; |
5ac24427 LK |
124 | netdev_dbg(dev, "IP add=%d:%d:%d:%d\n", |
125 | ip_addr_buf[0], ip_addr_buf[1], | |
126 | ip_addr_buf[2], ip_addr_buf[3]); | |
c5c77ba1 | 127 | |
6750140d | 128 | wilc_setup_ipaddress(vif, ip_addr_buf, vif->idx); |
c5c77ba1 JK |
129 | |
130 | break; | |
131 | ||
132 | default: | |
c5c77ba1 JK |
133 | break; |
134 | } | |
135 | ||
136 | return NOTIFY_DONE; | |
c5c77ba1 | 137 | } |
c5c77ba1 | 138 | |
c5c77ba1 JK |
139 | static irqreturn_t isr_uh_routine(int irq, void *user_data) |
140 | { | |
a4cac481 | 141 | struct wilc_vif *vif; |
3948362d | 142 | struct wilc *wilc; |
d5c89442 | 143 | struct net_device *dev = user_data; |
3948362d | 144 | |
a4cac481 GL |
145 | vif = netdev_priv(dev); |
146 | wilc = vif->wilc; | |
c5c77ba1 | 147 | |
3948362d | 148 | if (wilc->close) { |
5ac24427 | 149 | netdev_err(dev, "Can't handle UH interrupt\n"); |
c5c77ba1 | 150 | return IRQ_HANDLED; |
c5c77ba1 | 151 | } |
c5c77ba1 | 152 | return IRQ_WAKE_THREAD; |
c5c77ba1 | 153 | } |
c5c77ba1 | 154 | |
1608c403 | 155 | static irqreturn_t isr_bh_routine(int irq, void *userdata) |
c5c77ba1 | 156 | { |
a4cac481 | 157 | struct wilc_vif *vif; |
2e7933d0 | 158 | struct wilc *wilc; |
d5c89442 | 159 | struct net_device *dev = userdata; |
2e7933d0 | 160 | |
a4cac481 GL |
161 | vif = netdev_priv(userdata); |
162 | wilc = vif->wilc; | |
2e7933d0 | 163 | |
2e7933d0 | 164 | if (wilc->close) { |
5ac24427 | 165 | netdev_err(dev, "Can't handle BH interrupt\n"); |
c5c77ba1 | 166 | return IRQ_HANDLED; |
c5c77ba1 JK |
167 | } |
168 | ||
50b929e0 | 169 | wilc_handle_isr(wilc); |
c5c77ba1 | 170 | |
c5c77ba1 | 171 | return IRQ_HANDLED; |
c5c77ba1 | 172 | } |
c5c77ba1 | 173 | |
2c1d05d1 | 174 | static int init_irq(struct net_device *dev) |
c5c77ba1 JK |
175 | { |
176 | int ret = 0; | |
a4cac481 | 177 | struct wilc_vif *vif; |
2c1d05d1 GL |
178 | struct wilc *wl; |
179 | ||
a4cac481 GL |
180 | vif = netdev_priv(dev); |
181 | wl = vif->wilc; | |
c5c77ba1 | 182 | |
c4d139cb AB |
183 | if ((gpio_request(wl->gpio, "WILC_INTR") == 0) && |
184 | (gpio_direction_input(wl->gpio) == 0)) { | |
185 | wl->dev_irq_num = gpio_to_irq(wl->gpio); | |
c5c77ba1 JK |
186 | } else { |
187 | ret = -1; | |
5ac24427 | 188 | netdev_err(dev, "could not obtain gpio for WILC_INTR\n"); |
c5c77ba1 JK |
189 | } |
190 | ||
83231b72 LK |
191 | if (ret != -1 && request_threaded_irq(wl->dev_irq_num, |
192 | isr_uh_routine, | |
193 | isr_bh_routine, | |
194 | IRQF_TRIGGER_LOW | IRQF_ONESHOT, | |
195 | "WILC_IRQ", dev) < 0) { | |
5ac24427 | 196 | netdev_err(dev, "Failed to request IRQ GPIO: %d\n", wl->gpio); |
c4d139cb | 197 | gpio_free(wl->gpio); |
c5c77ba1 JK |
198 | ret = -1; |
199 | } else { | |
5ac24427 LK |
200 | netdev_dbg(dev, |
201 | "IRQ request succeeded IRQ-NUM= %d on GPIO: %d\n", | |
202 | wl->dev_irq_num, wl->gpio); | |
c5c77ba1 JK |
203 | } |
204 | ||
205 | return ret; | |
206 | } | |
c5c77ba1 | 207 | |
ec5cc750 | 208 | static void deinit_irq(struct net_device *dev) |
c5c77ba1 | 209 | { |
a4cac481 | 210 | struct wilc_vif *vif; |
ec5cc750 GL |
211 | struct wilc *wilc; |
212 | ||
a4cac481 GL |
213 | vif = netdev_priv(dev); |
214 | wilc = vif->wilc; | |
ec5cc750 | 215 | |
1cce2000 | 216 | /* Deinitialize IRQ */ |
c4d139cb | 217 | if (wilc->dev_irq_num) { |
ec5cc750 | 218 | free_irq(wilc->dev_irq_num, wilc); |
c4d139cb | 219 | gpio_free(wilc->gpio); |
c5c77ba1 | 220 | } |
c5c77ba1 JK |
221 | } |
222 | ||
562ed3f1 | 223 | void wilc_mac_indicate(struct wilc *wilc, int flag) |
c5c77ba1 | 224 | { |
c5c77ba1 JK |
225 | int status; |
226 | ||
227 | if (flag == WILC_MAC_INDICATE_STATUS) { | |
582f8a27 LK |
228 | wilc_wlan_cfg_get_val(WID_STATUS, |
229 | (unsigned char *)&status, 4); | |
64f2b71b GL |
230 | if (wilc->mac_status == WILC_MAC_STATUS_INIT) { |
231 | wilc->mac_status = status; | |
04247e7d | 232 | complete(&wilc->sync_event); |
c5c77ba1 | 233 | } else { |
64f2b71b | 234 | wilc->mac_status = status; |
c5c77ba1 | 235 | } |
c5c77ba1 | 236 | } |
c5c77ba1 JK |
237 | } |
238 | ||
1608c403 | 239 | static struct net_device *get_if_handler(struct wilc *wilc, u8 *mac_header) |
c5c77ba1 | 240 | { |
660786ea | 241 | u8 *bssid, *bssid1; |
c5c77ba1 JK |
242 | int i = 0; |
243 | ||
d239222e | 244 | bssid = mac_header + 10; |
660786ea | 245 | bssid1 = mac_header + 4; |
c5c77ba1 | 246 | |
ba615f1e GL |
247 | for (i = 0; i < wilc->vif_num; i++) { |
248 | if (wilc->vif[i]->mode == STATION_MODE) | |
fa633941 LK |
249 | if (ether_addr_equal_unaligned(bssid, |
250 | wilc->vif[i]->bssid)) | |
ba615f1e GL |
251 | return wilc->vif[i]->ndev; |
252 | if (wilc->vif[i]->mode == AP_MODE) | |
fa633941 LK |
253 | if (ether_addr_equal_unaligned(bssid1, |
254 | wilc->vif[i]->bssid)) | |
ba615f1e GL |
255 | return wilc->vif[i]->ndev; |
256 | } | |
8259a53e | 257 | |
c5c77ba1 JK |
258 | return NULL; |
259 | } | |
260 | ||
ba615f1e | 261 | int wilc_wlan_set_bssid(struct net_device *wilc_netdev, u8 *bssid, u8 mode) |
c5c77ba1 | 262 | { |
735bb39c | 263 | struct wilc_vif *vif = netdev_priv(wilc_netdev); |
472791a9 | 264 | |
735bb39c AB |
265 | memcpy(vif->bssid, bssid, 6); |
266 | vif->mode = mode; | |
8259a53e | 267 | |
735bb39c | 268 | return 0; |
c5c77ba1 JK |
269 | } |
270 | ||
562ed3f1 | 271 | int wilc_wlan_get_num_conn_ifcs(struct wilc *wilc) |
c5c77ba1 | 272 | { |
51e825f7 CL |
273 | u8 i = 0; |
274 | u8 null_bssid[6] = {0}; | |
275 | u8 ret_val = 0; | |
c5c77ba1 | 276 | |
562ed3f1 | 277 | for (i = 0; i < wilc->vif_num; i++) |
1f435d2e | 278 | if (memcmp(wilc->vif[i]->bssid, null_bssid, 6)) |
c5c77ba1 | 279 | ret_val++; |
8259a53e | 280 | |
c5c77ba1 JK |
281 | return ret_val; |
282 | } | |
283 | ||
c5c77ba1 JK |
284 | static int linux_wlan_txq_task(void *vp) |
285 | { | |
286 | int ret, txq_count; | |
a4cac481 | 287 | struct wilc_vif *vif; |
88687584 GL |
288 | struct wilc *wl; |
289 | struct net_device *dev = vp; | |
c5c77ba1 | 290 | |
a4cac481 GL |
291 | vif = netdev_priv(dev); |
292 | wl = vif->wilc; | |
88687584 | 293 | |
11a54b3f | 294 | complete(&wl->txq_thread_started); |
c5c77ba1 | 295 | while (1) { |
b27a6d5e | 296 | wait_for_completion(&wl->txq_event); |
c5c77ba1 | 297 | |
88687584 | 298 | if (wl->close) { |
11a54b3f | 299 | complete(&wl->txq_thread_started); |
c5c77ba1 JK |
300 | |
301 | while (!kthread_should_stop()) | |
302 | schedule(); | |
c5c77ba1 JK |
303 | break; |
304 | } | |
c5c77ba1 | 305 | do { |
a1332cad | 306 | ret = wilc_wlan_handle_txq(dev, &txq_count); |
98b89847 | 307 | if (txq_count < FLOW_CONTROL_LOWER_THRESHOLD) { |
1f435d2e GL |
308 | if (netif_queue_stopped(wl->vif[0]->ndev)) |
309 | netif_wake_queue(wl->vif[0]->ndev); | |
310 | if (netif_queue_stopped(wl->vif[1]->ndev)) | |
311 | netif_wake_queue(wl->vif[1]->ndev); | |
c5c77ba1 | 312 | } |
98b89847 | 313 | } while (ret == WILC_TX_ERR_NO_BUF && !wl->close); |
c5c77ba1 JK |
314 | } |
315 | return 0; | |
316 | } | |
317 | ||
0e1af73d | 318 | int wilc_wlan_get_firmware(struct net_device *dev) |
c5c77ba1 | 319 | { |
a4cac481 | 320 | struct wilc_vif *vif; |
65c8adcf | 321 | struct wilc *wilc; |
14823bf2 | 322 | int chip_id, ret = 0; |
c5c77ba1 JK |
323 | const struct firmware *wilc_firmware; |
324 | char *firmware; | |
325 | ||
a4cac481 GL |
326 | vif = netdev_priv(dev); |
327 | wilc = vif->wilc; | |
65c8adcf | 328 | |
65c3f000 | 329 | chip_id = wilc_get_chipid(wilc, false); |
14823bf2 GL |
330 | |
331 | if (chip_id < 0x1003a0) | |
332 | firmware = FIRMWARE_1002; | |
333 | else | |
334 | firmware = FIRMWARE_1003; | |
335 | ||
336 | netdev_info(dev, "loading firmware %s\n", firmware); | |
c5c77ba1 | 337 | |
1408603c | 338 | if (!(&vif->ndev->dev)) |
c5c77ba1 | 339 | goto _fail_; |
c5c77ba1 | 340 | |
b03314e2 | 341 | if (request_firmware(&wilc_firmware, firmware, wilc->dev) != 0) { |
b9811891 | 342 | netdev_err(dev, "%s - firmware not available\n", firmware); |
c5c77ba1 JK |
343 | ret = -1; |
344 | goto _fail_; | |
345 | } | |
65c8adcf | 346 | wilc->firmware = wilc_firmware; |
c5c77ba1 JK |
347 | |
348 | _fail_: | |
349 | ||
350 | return ret; | |
c5c77ba1 JK |
351 | } |
352 | ||
9bf3d727 | 353 | static int linux_wlan_start_firmware(struct net_device *dev) |
c5c77ba1 | 354 | { |
a4cac481 | 355 | struct wilc_vif *vif; |
9bf3d727 | 356 | struct wilc *wilc; |
c5c77ba1 | 357 | int ret = 0; |
9bf3d727 | 358 | |
a4cac481 GL |
359 | vif = netdev_priv(dev); |
360 | wilc = vif->wilc; | |
9bf3d727 | 361 | |
562ed3f1 | 362 | ret = wilc_wlan_start(wilc); |
1408603c | 363 | if (ret < 0) |
0aeea1ad | 364 | return ret; |
c5c77ba1 | 365 | |
04247e7d | 366 | if (!wait_for_completion_timeout(&wilc->sync_event, |
36190caa | 367 | msecs_to_jiffies(5000))) |
04247e7d | 368 | return -ETIME; |
c5c77ba1 | 369 | |
0aeea1ad | 370 | return 0; |
c5c77ba1 | 371 | } |
a40b22c5 | 372 | |
562ed3f1 | 373 | static int wilc1000_firmware_download(struct net_device *dev) |
c5c77ba1 | 374 | { |
a4cac481 | 375 | struct wilc_vif *vif; |
ed760b67 | 376 | struct wilc *wilc; |
c5c77ba1 JK |
377 | int ret = 0; |
378 | ||
a4cac481 GL |
379 | vif = netdev_priv(dev); |
380 | wilc = vif->wilc; | |
ed760b67 GL |
381 | |
382 | if (!wilc->firmware) { | |
5ac24427 | 383 | netdev_err(dev, "Firmware buffer is NULL\n"); |
14b1821d | 384 | return -ENOBUFS; |
c5c77ba1 | 385 | } |
1408603c | 386 | |
562ed3f1 | 387 | ret = wilc_wlan_firmware_download(wilc, wilc->firmware->data, |
ed760b67 | 388 | wilc->firmware->size); |
fc4b95d6 | 389 | if (ret < 0) |
14b1821d | 390 | return ret; |
c5c77ba1 | 391 | |
ed760b67 | 392 | release_firmware(wilc->firmware); |
6f72ed75 | 393 | wilc->firmware = NULL; |
c5c77ba1 | 394 | |
5ac24427 | 395 | netdev_dbg(dev, "Download Succeeded\n"); |
c5c77ba1 | 396 | |
14b1821d | 397 | return 0; |
c5c77ba1 JK |
398 | } |
399 | ||
00215dde | 400 | static int linux_wlan_init_test_config(struct net_device *dev, |
b8f6ca0b | 401 | struct wilc_vif *vif) |
c5c77ba1 | 402 | { |
c5c77ba1 | 403 | unsigned char c_val[64]; |
b8f6ca0b | 404 | struct wilc *wilc = vif->wilc; |
2726887c | 405 | struct wilc_priv *priv; |
0fa66c71 | 406 | struct host_if_drv *hif_drv; |
c5c77ba1 | 407 | |
5ac24427 | 408 | netdev_dbg(dev, "Start configuring Firmware\n"); |
c5c77ba1 | 409 | priv = wiphy_priv(dev->ieee80211_ptr->wiphy); |
48b28df9 | 410 | hif_drv = (struct host_if_drv *)priv->hif_drv; |
5ac24427 | 411 | netdev_dbg(dev, "Host = %p\n", hif_drv); |
65c3f000 | 412 | wilc_get_chipid(wilc, false); |
c5c77ba1 | 413 | |
e5d57e91 | 414 | *(int *)c_val = 1; |
c5c77ba1 | 415 | |
79df6a49 | 416 | if (!wilc_wlan_cfg_set(vif, 1, WID_SET_DRV_HANDLER, c_val, 4, 0, 0)) |
c5c77ba1 JK |
417 | goto _fail_; |
418 | ||
c5c77ba1 | 419 | c_val[0] = 0; |
79df6a49 | 420 | if (!wilc_wlan_cfg_set(vif, 0, WID_PC_TEST_MODE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
421 | goto _fail_; |
422 | ||
423 | c_val[0] = INFRASTRUCTURE; | |
79df6a49 | 424 | if (!wilc_wlan_cfg_set(vif, 0, WID_BSS_TYPE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
425 | goto _fail_; |
426 | ||
c5c77ba1 | 427 | c_val[0] = RATE_AUTO; |
79df6a49 | 428 | if (!wilc_wlan_cfg_set(vif, 0, WID_CURRENT_TX_RATE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
429 | goto _fail_; |
430 | ||
431 | c_val[0] = G_MIXED_11B_2_MODE; | |
79df6a49 | 432 | if (!wilc_wlan_cfg_set(vif, 0, WID_11G_OPERATING_MODE, c_val, 1, 0, |
89758e13 | 433 | 0)) |
c5c77ba1 JK |
434 | goto _fail_; |
435 | ||
436 | c_val[0] = 1; | |
79df6a49 | 437 | if (!wilc_wlan_cfg_set(vif, 0, WID_CURRENT_CHANNEL, c_val, 1, 0, 0)) |
c5c77ba1 JK |
438 | goto _fail_; |
439 | ||
440 | c_val[0] = G_SHORT_PREAMBLE; | |
79df6a49 | 441 | if (!wilc_wlan_cfg_set(vif, 0, WID_PREAMBLE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
442 | goto _fail_; |
443 | ||
444 | c_val[0] = AUTO_PROT; | |
79df6a49 | 445 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_PROT_MECH, c_val, 1, 0, 0)) |
c5c77ba1 JK |
446 | goto _fail_; |
447 | ||
c5c77ba1 | 448 | c_val[0] = ACTIVE_SCAN; |
79df6a49 | 449 | if (!wilc_wlan_cfg_set(vif, 0, WID_SCAN_TYPE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
450 | goto _fail_; |
451 | ||
452 | c_val[0] = SITE_SURVEY_OFF; | |
79df6a49 | 453 | if (!wilc_wlan_cfg_set(vif, 0, WID_SITE_SURVEY, c_val, 1, 0, 0)) |
c5c77ba1 JK |
454 | goto _fail_; |
455 | ||
98b89847 | 456 | *((int *)c_val) = 0xffff; |
79df6a49 | 457 | if (!wilc_wlan_cfg_set(vif, 0, WID_RTS_THRESHOLD, c_val, 2, 0, 0)) |
c5c77ba1 JK |
458 | goto _fail_; |
459 | ||
460 | *((int *)c_val) = 2346; | |
79df6a49 | 461 | if (!wilc_wlan_cfg_set(vif, 0, WID_FRAG_THRESHOLD, c_val, 2, 0, 0)) |
c5c77ba1 JK |
462 | goto _fail_; |
463 | ||
c5c77ba1 | 464 | c_val[0] = 0; |
79df6a49 | 465 | if (!wilc_wlan_cfg_set(vif, 0, WID_BCAST_SSID, c_val, 1, 0, 0)) |
c5c77ba1 JK |
466 | goto _fail_; |
467 | ||
468 | c_val[0] = 1; | |
79df6a49 | 469 | if (!wilc_wlan_cfg_set(vif, 0, WID_QOS_ENABLE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
470 | goto _fail_; |
471 | ||
472 | c_val[0] = NO_POWERSAVE; | |
79df6a49 | 473 | if (!wilc_wlan_cfg_set(vif, 0, WID_POWER_MANAGEMENT, c_val, 1, 0, 0)) |
c5c77ba1 JK |
474 | goto _fail_; |
475 | ||
b4d04c15 | 476 | c_val[0] = NO_SECURITY; /* NO_ENCRYPT, 0x79 */ |
79df6a49 | 477 | if (!wilc_wlan_cfg_set(vif, 0, WID_11I_MODE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
478 | goto _fail_; |
479 | ||
480 | c_val[0] = OPEN_SYSTEM; | |
79df6a49 | 481 | if (!wilc_wlan_cfg_set(vif, 0, WID_AUTH_TYPE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
482 | goto _fail_; |
483 | ||
c5c77ba1 | 484 | strcpy(c_val, "123456790abcdef1234567890"); |
79df6a49 | 485 | if (!wilc_wlan_cfg_set(vif, 0, WID_WEP_KEY_VALUE, c_val, |
89758e13 | 486 | (strlen(c_val) + 1), 0, 0)) |
c5c77ba1 JK |
487 | goto _fail_; |
488 | ||
c5c77ba1 | 489 | strcpy(c_val, "12345678"); |
79df6a49 | 490 | if (!wilc_wlan_cfg_set(vif, 0, WID_11I_PSK, c_val, (strlen(c_val)), 0, |
89758e13 | 491 | 0)) |
c5c77ba1 JK |
492 | goto _fail_; |
493 | ||
c5c77ba1 | 494 | strcpy(c_val, "password"); |
79df6a49 | 495 | if (!wilc_wlan_cfg_set(vif, 0, WID_1X_KEY, c_val, (strlen(c_val) + 1), |
89758e13 | 496 | 0, 0)) |
c5c77ba1 JK |
497 | goto _fail_; |
498 | ||
c5c77ba1 JK |
499 | c_val[0] = 192; |
500 | c_val[1] = 168; | |
501 | c_val[2] = 1; | |
502 | c_val[3] = 112; | |
79df6a49 | 503 | if (!wilc_wlan_cfg_set(vif, 0, WID_1X_SERV_ADDR, c_val, 4, 0, 0)) |
c5c77ba1 JK |
504 | goto _fail_; |
505 | ||
506 | c_val[0] = 3; | |
79df6a49 | 507 | if (!wilc_wlan_cfg_set(vif, 0, WID_LISTEN_INTERVAL, c_val, 1, 0, 0)) |
c5c77ba1 JK |
508 | goto _fail_; |
509 | ||
510 | c_val[0] = 3; | |
79df6a49 | 511 | if (!wilc_wlan_cfg_set(vif, 0, WID_DTIM_PERIOD, c_val, 1, 0, 0)) |
c5c77ba1 JK |
512 | goto _fail_; |
513 | ||
514 | c_val[0] = NORMAL_ACK; | |
79df6a49 | 515 | if (!wilc_wlan_cfg_set(vif, 0, WID_ACK_POLICY, c_val, 1, 0, 0)) |
c5c77ba1 JK |
516 | goto _fail_; |
517 | ||
518 | c_val[0] = 0; | |
79df6a49 | 519 | if (!wilc_wlan_cfg_set(vif, 0, WID_USER_CONTROL_ON_TX_POWER, c_val, 1, |
89758e13 | 520 | 0, 0)) |
c5c77ba1 JK |
521 | goto _fail_; |
522 | ||
523 | c_val[0] = 48; | |
79df6a49 | 524 | if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11A, c_val, 1, 0, |
89758e13 | 525 | 0)) |
c5c77ba1 JK |
526 | goto _fail_; |
527 | ||
528 | c_val[0] = 28; | |
79df6a49 | 529 | if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11B, c_val, 1, 0, |
89758e13 | 530 | 0)) |
c5c77ba1 JK |
531 | goto _fail_; |
532 | ||
c5c77ba1 | 533 | *((int *)c_val) = 100; |
79df6a49 | 534 | if (!wilc_wlan_cfg_set(vif, 0, WID_BEACON_INTERVAL, c_val, 2, 0, 0)) |
c5c77ba1 JK |
535 | goto _fail_; |
536 | ||
537 | c_val[0] = REKEY_DISABLE; | |
79df6a49 | 538 | if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_POLICY, c_val, 1, 0, 0)) |
c5c77ba1 JK |
539 | goto _fail_; |
540 | ||
c5c77ba1 | 541 | *((int *)c_val) = 84600; |
79df6a49 | 542 | if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PERIOD, c_val, 4, 0, 0)) |
c5c77ba1 JK |
543 | goto _fail_; |
544 | ||
c5c77ba1 | 545 | *((int *)c_val) = 500; |
79df6a49 | 546 | if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PACKET_COUNT, c_val, 4, 0, |
89758e13 | 547 | 0)) |
c5c77ba1 JK |
548 | goto _fail_; |
549 | ||
550 | c_val[0] = 1; | |
79df6a49 | 551 | if (!wilc_wlan_cfg_set(vif, 0, WID_SHORT_SLOT_ALLOWED, c_val, 1, 0, |
89758e13 | 552 | 0)) |
c5c77ba1 JK |
553 | goto _fail_; |
554 | ||
555 | c_val[0] = G_SELF_CTS_PROT; | |
79df6a49 | 556 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ERP_PROT_TYPE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
557 | goto _fail_; |
558 | ||
98b89847 | 559 | c_val[0] = 1; |
79df6a49 | 560 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ENABLE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
561 | goto _fail_; |
562 | ||
563 | c_val[0] = HT_MIXED_MODE; | |
79df6a49 | 564 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OPERATING_MODE, c_val, 1, 0, |
89758e13 | 565 | 0)) |
c5c77ba1 JK |
566 | goto _fail_; |
567 | ||
98b89847 | 568 | c_val[0] = 1; |
79df6a49 | 569 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_TXOP_PROT_DISABLE, c_val, 1, 0, |
89758e13 | 570 | 0)) |
c5c77ba1 JK |
571 | goto _fail_; |
572 | ||
c5c77ba1 | 573 | c_val[0] = DETECT_PROTECT_REPORT; |
79df6a49 | 574 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OBSS_NONHT_DETECTION, c_val, 1, |
89758e13 | 575 | 0, 0)) |
c5c77ba1 JK |
576 | goto _fail_; |
577 | ||
578 | c_val[0] = RTS_CTS_NONHT_PROT; | |
79df6a49 | 579 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_HT_PROT_TYPE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
580 | goto _fail_; |
581 | ||
582 | c_val[0] = 0; | |
79df6a49 | 583 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_RIFS_PROT_ENABLE, c_val, 1, 0, |
89758e13 | 584 | 0)) |
c5c77ba1 JK |
585 | goto _fail_; |
586 | ||
587 | c_val[0] = MIMO_MODE; | |
79df6a49 | 588 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_SMPS_MODE, c_val, 1, 0, 0)) |
c5c77ba1 JK |
589 | goto _fail_; |
590 | ||
591 | c_val[0] = 7; | |
79df6a49 | 592 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_CURRENT_TX_MCS, c_val, 1, 0, |
89758e13 | 593 | 0)) |
c5c77ba1 JK |
594 | goto _fail_; |
595 | ||
98b89847 | 596 | c_val[0] = 1; |
79df6a49 | 597 | if (!wilc_wlan_cfg_set(vif, 0, WID_11N_IMMEDIATE_BA_ENABLED, c_val, 1, |
89758e13 | 598 | 1, 1)) |
c5c77ba1 JK |
599 | goto _fail_; |
600 | ||
601 | return 0; | |
602 | ||
603 | _fail_: | |
604 | return -1; | |
605 | } | |
606 | ||
53dc0cfe | 607 | void wilc1000_wlan_deinit(struct net_device *dev) |
c5c77ba1 | 608 | { |
a4cac481 | 609 | struct wilc_vif *vif; |
53dc0cfe | 610 | struct wilc *wl; |
c5c77ba1 | 611 | |
a4cac481 GL |
612 | vif = netdev_priv(dev); |
613 | wl = vif->wilc; | |
53dc0cfe GL |
614 | |
615 | if (!wl) { | |
616 | netdev_err(dev, "wl is NULL\n"); | |
617 | return; | |
618 | } | |
619 | ||
620 | if (wl->initialized) { | |
621 | netdev_info(dev, "Deinitializing wilc1000...\n"); | |
c5c77ba1 | 622 | |
5547c1f0 | 623 | if (!wl->dev_irq_num && |
af9ae09a | 624 | wl->hif_func->disable_interrupt) { |
c4d139cb | 625 | mutex_lock(&wl->hif_cs); |
af9ae09a | 626 | wl->hif_func->disable_interrupt(wl); |
c4d139cb AB |
627 | mutex_unlock(&wl->hif_cs); |
628 | } | |
3a147c07 | 629 | if (&wl->txq_event) |
23535c13 | 630 | complete(&wl->txq_event); |
c5c77ba1 | 631 | |
32dd51bc | 632 | wlan_deinitialize_threads(dev); |
ec5cc750 | 633 | deinit_irq(dev); |
c5c77ba1 | 634 | |
562ed3f1 | 635 | wilc_wlan_stop(wl); |
2de7cbec | 636 | wilc_wlan_cleanup(dev); |
7c67c053 | 637 | wlan_deinit_locks(dev); |
c5c77ba1 | 638 | |
53dc0cfe | 639 | wl->initialized = false; |
c5c77ba1 | 640 | |
5ac24427 | 641 | netdev_dbg(dev, "wilc1000 deinitialization Done\n"); |
c5c77ba1 | 642 | } else { |
5ac24427 | 643 | netdev_dbg(dev, "wilc1000 is not initialized\n"); |
c5c77ba1 | 644 | } |
c5c77ba1 JK |
645 | } |
646 | ||
1608c403 | 647 | static int wlan_init_locks(struct net_device *dev) |
c5c77ba1 | 648 | { |
a4cac481 | 649 | struct wilc_vif *vif; |
38afb390 GL |
650 | struct wilc *wl; |
651 | ||
a4cac481 GL |
652 | vif = netdev_priv(dev); |
653 | wl = vif->wilc; | |
c5c77ba1 | 654 | |
38afb390 GL |
655 | mutex_init(&wl->hif_cs); |
656 | mutex_init(&wl->rxq_cs); | |
c5c77ba1 | 657 | |
38afb390 | 658 | spin_lock_init(&wl->txq_spinlock); |
334bed08 | 659 | mutex_init(&wl->txq_add_to_head_cs); |
c5c77ba1 | 660 | |
b27a6d5e | 661 | init_completion(&wl->txq_event); |
c5c77ba1 | 662 | |
fa659698 | 663 | init_completion(&wl->cfg_event); |
04247e7d | 664 | init_completion(&wl->sync_event); |
11a54b3f | 665 | init_completion(&wl->txq_thread_started); |
c5c77ba1 | 666 | |
c5c77ba1 JK |
667 | return 0; |
668 | } | |
669 | ||
7c67c053 | 670 | static int wlan_deinit_locks(struct net_device *dev) |
c5c77ba1 | 671 | { |
a4cac481 | 672 | struct wilc_vif *vif; |
7c67c053 GL |
673 | struct wilc *wilc; |
674 | ||
a4cac481 GL |
675 | vif = netdev_priv(dev); |
676 | wilc = vif->wilc; | |
7c67c053 | 677 | |
3a147c07 | 678 | if (&wilc->hif_cs) |
7c67c053 | 679 | mutex_destroy(&wilc->hif_cs); |
c5c77ba1 | 680 | |
3a147c07 | 681 | if (&wilc->rxq_cs) |
7c67c053 | 682 | mutex_destroy(&wilc->rxq_cs); |
c5c77ba1 | 683 | |
c5c77ba1 JK |
684 | return 0; |
685 | } | |
a40b22c5 | 686 | |
1608c403 | 687 | static int wlan_initialize_threads(struct net_device *dev) |
c5c77ba1 | 688 | { |
a4cac481 | 689 | struct wilc_vif *vif; |
75a94665 | 690 | struct wilc *wilc; |
8dfaafd6 | 691 | |
a4cac481 GL |
692 | vif = netdev_priv(dev); |
693 | wilc = vif->wilc; | |
75a94665 | 694 | |
88687584 | 695 | wilc->txq_thread = kthread_run(linux_wlan_txq_task, (void *)dev, |
75a94665 | 696 | "K_TXQ_TASK"); |
b3e6916d | 697 | if (IS_ERR(wilc->txq_thread)) { |
5ac24427 | 698 | netdev_err(dev, "couldn't create TXQ thread\n"); |
6bc72c5a | 699 | wilc->close = 0; |
b3e6916d | 700 | return PTR_ERR(wilc->txq_thread); |
c5c77ba1 | 701 | } |
11a54b3f | 702 | wait_for_completion(&wilc->txq_thread_started); |
c5c77ba1 JK |
703 | |
704 | return 0; | |
c5c77ba1 JK |
705 | } |
706 | ||
32dd51bc | 707 | static void wlan_deinitialize_threads(struct net_device *dev) |
c5c77ba1 | 708 | { |
a4cac481 | 709 | struct wilc_vif *vif; |
32dd51bc | 710 | struct wilc *wl; |
fa8b23c6 | 711 | |
a4cac481 GL |
712 | vif = netdev_priv(dev); |
713 | wl = vif->wilc; | |
c5c77ba1 | 714 | |
32dd51bc | 715 | wl->close = 1; |
c5c77ba1 | 716 | |
3a147c07 | 717 | if (&wl->txq_event) |
b27a6d5e | 718 | complete(&wl->txq_event); |
c5c77ba1 | 719 | |
3a147c07 | 720 | if (wl->txq_thread) { |
32dd51bc GL |
721 | kthread_stop(wl->txq_thread); |
722 | wl->txq_thread = NULL; | |
c5c77ba1 | 723 | } |
c5c77ba1 JK |
724 | } |
725 | ||
a4cac481 | 726 | int wilc1000_wlan_init(struct net_device *dev, struct wilc_vif *vif) |
c5c77ba1 | 727 | { |
c5c77ba1 | 728 | int ret = 0; |
a4cac481 | 729 | struct wilc *wl = vif->wilc; |
c5c77ba1 | 730 | |
0fa683b6 GL |
731 | if (!wl->initialized) { |
732 | wl->mac_status = WILC_MAC_STATUS_INIT; | |
733 | wl->close = 0; | |
c5c77ba1 | 734 | |
38afb390 | 735 | wlan_init_locks(dev); |
c5c77ba1 | 736 | |
4bd7baf0 | 737 | ret = wilc_wlan_init(dev); |
c5c77ba1 | 738 | if (ret < 0) { |
c5c77ba1 JK |
739 | ret = -EIO; |
740 | goto _fail_locks_; | |
741 | } | |
c5c77ba1 | 742 | |
c4d139cb | 743 | if (wl->gpio >= 0 && init_irq(dev)) { |
c5c77ba1 | 744 | ret = -EIO; |
b46d6882 | 745 | goto _fail_locks_; |
c5c77ba1 | 746 | } |
c5c77ba1 | 747 | |
75a94665 | 748 | ret = wlan_initialize_threads(dev); |
b46d6882 | 749 | if (ret < 0) { |
b46d6882 TC |
750 | ret = -EIO; |
751 | goto _fail_wilc_wlan_; | |
752 | } | |
753 | ||
5547c1f0 | 754 | if (!wl->dev_irq_num && |
af9ae09a GL |
755 | wl->hif_func->enable_interrupt && |
756 | wl->hif_func->enable_interrupt(wl)) { | |
c5c77ba1 JK |
757 | ret = -EIO; |
758 | goto _fail_irq_init_; | |
759 | } | |
c5c77ba1 | 760 | |
0e1af73d | 761 | if (wilc_wlan_get_firmware(dev)) { |
c5c77ba1 JK |
762 | ret = -EIO; |
763 | goto _fail_irq_enable_; | |
764 | } | |
765 | ||
562ed3f1 | 766 | ret = wilc1000_firmware_download(dev); |
c5c77ba1 | 767 | if (ret < 0) { |
c5c77ba1 JK |
768 | ret = -EIO; |
769 | goto _fail_irq_enable_; | |
770 | } | |
771 | ||
9bf3d727 | 772 | ret = linux_wlan_start_firmware(dev); |
c5c77ba1 | 773 | if (ret < 0) { |
c5c77ba1 JK |
774 | ret = -EIO; |
775 | goto _fail_irq_enable_; | |
776 | } | |
777 | ||
79df6a49 | 778 | if (wilc_wlan_cfg_get(vif, 1, WID_FIRMWARE_VERSION, 1, 0)) { |
c5c77ba1 | 779 | int size; |
5ac24427 | 780 | char firmware_ver[20]; |
8dfaafd6 | 781 | |
5ac24427 LK |
782 | size = wilc_wlan_cfg_get_val(WID_FIRMWARE_VERSION, |
783 | firmware_ver, | |
784 | sizeof(firmware_ver)); | |
785 | firmware_ver[size] = '\0'; | |
786 | netdev_dbg(dev, "Firmware Ver = %s\n", firmware_ver); | |
c5c77ba1 | 787 | } |
b8f6ca0b | 788 | ret = linux_wlan_init_test_config(dev, vif); |
c5c77ba1 JK |
789 | |
790 | if (ret < 0) { | |
5ac24427 | 791 | netdev_err(dev, "Failed to configure firmware\n"); |
c5c77ba1 JK |
792 | ret = -EIO; |
793 | goto _fail_fw_start_; | |
794 | } | |
795 | ||
0fa683b6 | 796 | wl->initialized = true; |
98b89847 | 797 | return 0; |
c5c77ba1 | 798 | |
c5c77ba1 | 799 | _fail_fw_start_: |
562ed3f1 | 800 | wilc_wlan_stop(wl); |
c5c77ba1 JK |
801 | |
802 | _fail_irq_enable_: | |
5547c1f0 | 803 | if (!wl->dev_irq_num && |
af9ae09a GL |
804 | wl->hif_func->disable_interrupt) |
805 | wl->hif_func->disable_interrupt(wl); | |
c5c77ba1 | 806 | _fail_irq_init_: |
c4d139cb AB |
807 | if (wl->dev_irq_num) |
808 | deinit_irq(dev); | |
c5c77ba1 | 809 | |
32dd51bc | 810 | wlan_deinitialize_threads(dev); |
c5c77ba1 | 811 | _fail_wilc_wlan_: |
2de7cbec | 812 | wilc_wlan_cleanup(dev); |
c5c77ba1 | 813 | _fail_locks_: |
7c67c053 | 814 | wlan_deinit_locks(dev); |
5ac24427 | 815 | netdev_err(dev, "WLAN Iinitialization FAILED\n"); |
c5c77ba1 | 816 | } else { |
5ac24427 | 817 | netdev_dbg(dev, "wilc1000 already initialized\n"); |
c5c77ba1 JK |
818 | } |
819 | return ret; | |
820 | } | |
821 | ||
1608c403 | 822 | static int mac_init_fn(struct net_device *ndev) |
c5c77ba1 | 823 | { |
98b89847 LK |
824 | netif_start_queue(ndev); |
825 | netif_stop_queue(ndev); | |
c5c77ba1 JK |
826 | |
827 | return 0; | |
828 | } | |
c5c77ba1 | 829 | |
68a30a63 | 830 | static int wilc_mac_open(struct net_device *ndev) |
c5c77ba1 | 831 | { |
a4cac481 | 832 | struct wilc_vif *vif; |
c5c77ba1 | 833 | |
c5c77ba1 | 834 | unsigned char mac_add[ETH_ALEN] = {0}; |
c5c77ba1 JK |
835 | int ret = 0; |
836 | int i = 0; | |
f3c1366e GL |
837 | struct wilc *wl; |
838 | ||
a4cac481 GL |
839 | vif = netdev_priv(ndev); |
840 | wl = vif->wilc; | |
c5c77ba1 | 841 | |
40095ad9 | 842 | if (!wl || !wl->dev) { |
90fd4cc5 | 843 | netdev_err(ndev, "device not ready\n"); |
7d05652c CG |
844 | return -ENODEV; |
845 | } | |
b03314e2 | 846 | |
5ac24427 | 847 | netdev_dbg(ndev, "MAC OPEN[%p]\n", ndev); |
c5c77ba1 | 848 | |
dd4b6a83 | 849 | ret = wilc_init_host_int(ndev); |
1408603c | 850 | if (ret < 0) |
c5c77ba1 | 851 | return ret; |
c5c77ba1 | 852 | |
a4cac481 | 853 | ret = wilc1000_wlan_init(ndev, vif); |
c5c77ba1 | 854 | if (ret < 0) { |
a9a16823 | 855 | wilc_deinit_host_int(ndev); |
c5c77ba1 JK |
856 | return ret; |
857 | } | |
858 | ||
f3c1366e | 859 | for (i = 0; i < wl->vif_num; i++) { |
1f435d2e | 860 | if (ndev == wl->vif[i]->ndev) { |
b3306865 GL |
861 | if (vif->iftype == AP_MODE) { |
862 | wilc_set_wfi_drv_handler(vif, | |
863 | wilc_get_vif_idx(vif), | |
864 | 0); | |
ba750473 | 865 | } else if (!wilc_wlan_get_num_conn_ifcs(wl)) { |
b3306865 GL |
866 | wilc_set_wfi_drv_handler(vif, |
867 | wilc_get_vif_idx(vif), | |
ba750473 | 868 | wl->open_ifcs); |
b3306865 | 869 | } else { |
ba750473 LK |
870 | if (memcmp(wl->vif[i ^ 1]->bssid, |
871 | wl->vif[i ^ 1]->src_addr, 6)) | |
b3306865 GL |
872 | wilc_set_wfi_drv_handler(vif, |
873 | wilc_get_vif_idx(vif), | |
874 | 0); | |
875 | else | |
876 | wilc_set_wfi_drv_handler(vif, | |
877 | wilc_get_vif_idx(vif), | |
878 | 1); | |
879 | } | |
e32737e9 | 880 | wilc_set_operation_mode(vif, vif->iftype); |
32cee999 GL |
881 | |
882 | wilc_get_mac_address(vif, mac_add); | |
883 | netdev_dbg(ndev, "Mac address: %pM\n", mac_add); | |
884 | memcpy(wl->vif[i]->src_addr, mac_add, ETH_ALEN); | |
885 | ||
c5c77ba1 JK |
886 | break; |
887 | } | |
888 | } | |
889 | ||
1f435d2e | 890 | memcpy(ndev->dev_addr, wl->vif[i]->src_addr, ETH_ALEN); |
c5c77ba1 JK |
891 | |
892 | if (!is_valid_ether_addr(ndev->dev_addr)) { | |
5ac24427 | 893 | netdev_err(ndev, "Wrong MAC address\n"); |
339d244a LK |
894 | wilc_deinit_host_int(ndev); |
895 | wilc1000_wlan_deinit(ndev); | |
896 | return -EINVAL; | |
c5c77ba1 JK |
897 | } |
898 | ||
1006b5c7 GL |
899 | wilc_mgmt_frame_register(vif->ndev->ieee80211_ptr->wiphy, |
900 | vif->ndev->ieee80211_ptr, | |
340a84ff | 901 | vif->frame_reg[0].type, |
89febb21 | 902 | vif->frame_reg[0].reg); |
1006b5c7 GL |
903 | wilc_mgmt_frame_register(vif->ndev->ieee80211_ptr->wiphy, |
904 | vif->ndev->ieee80211_ptr, | |
340a84ff | 905 | vif->frame_reg[1].type, |
89febb21 | 906 | vif->frame_reg[1].reg); |
c5c77ba1 | 907 | netif_wake_queue(ndev); |
f3c1366e | 908 | wl->open_ifcs++; |
a4cac481 | 909 | vif->mac_opened = 1; |
c5c77ba1 | 910 | return 0; |
c5c77ba1 | 911 | } |
c5c77ba1 | 912 | |
1608c403 | 913 | static struct net_device_stats *mac_stats(struct net_device *dev) |
c5c77ba1 | 914 | { |
40095ad9 | 915 | struct wilc_vif *vif = netdev_priv(dev); |
c5c77ba1 | 916 | |
a4cac481 | 917 | return &vif->netstats; |
c5c77ba1 JK |
918 | } |
919 | ||
c5c77ba1 JK |
920 | static void wilc_set_multicast_list(struct net_device *dev) |
921 | { | |
c5c77ba1 | 922 | struct netdev_hw_addr *ha; |
cf60106b | 923 | struct wilc_vif *vif; |
c5c77ba1 | 924 | int i = 0; |
8dfaafd6 | 925 | |
cf60106b | 926 | vif = netdev_priv(dev); |
c5c77ba1 | 927 | |
1408603c | 928 | if (dev->flags & IFF_PROMISC) |
c5c77ba1 | 929 | return; |
c5c77ba1 | 930 | |
582f8a27 LK |
931 | if ((dev->flags & IFF_ALLMULTI) || |
932 | (dev->mc.count) > WILC_MULTICAST_TABLE_SIZE) { | |
fbf5379b | 933 | wilc_setup_multicast_filter(vif, false, 0); |
c5c77ba1 JK |
934 | return; |
935 | } | |
936 | ||
c5c77ba1 | 937 | if ((dev->mc.count) == 0) { |
fbf5379b | 938 | wilc_setup_multicast_filter(vif, true, 0); |
c5c77ba1 JK |
939 | return; |
940 | } | |
941 | ||
c8537e6d | 942 | netdev_for_each_mc_addr(ha, dev) { |
0e1af73d | 943 | memcpy(wilc_multicast_mac_addr_list[i], ha->addr, ETH_ALEN); |
5ac24427 LK |
944 | netdev_dbg(dev, "Entry[%d]: %x:%x:%x:%x:%x:%x\n", i, |
945 | wilc_multicast_mac_addr_list[i][0], | |
946 | wilc_multicast_mac_addr_list[i][1], | |
947 | wilc_multicast_mac_addr_list[i][2], | |
948 | wilc_multicast_mac_addr_list[i][3], | |
949 | wilc_multicast_mac_addr_list[i][4], | |
950 | wilc_multicast_mac_addr_list[i][5]); | |
c5c77ba1 JK |
951 | i++; |
952 | } | |
953 | ||
fbf5379b | 954 | wilc_setup_multicast_filter(vif, true, (dev->mc.count)); |
c5c77ba1 JK |
955 | } |
956 | ||
c5c77ba1 JK |
957 | static void linux_wlan_tx_complete(void *priv, int status) |
958 | { | |
d5c89442 | 959 | struct tx_complete_data *pv_data = priv; |
8dfaafd6 | 960 | |
c5c77ba1 | 961 | dev_kfree_skb(pv_data->skb); |
a18dd630 | 962 | kfree(pv_data); |
c5c77ba1 JK |
963 | } |
964 | ||
0e1af73d | 965 | int wilc_mac_xmit(struct sk_buff *skb, struct net_device *ndev) |
c5c77ba1 | 966 | { |
a4cac481 | 967 | struct wilc_vif *vif; |
c5c77ba1 | 968 | struct tx_complete_data *tx_data = NULL; |
44ec3b75 | 969 | int queue_count; |
fd8f0367 | 970 | char *udp_buf; |
c5c77ba1 JK |
971 | struct iphdr *ih; |
972 | struct ethhdr *eth_h; | |
b7495be5 | 973 | struct wilc *wilc; |
8dfaafd6 | 974 | |
a4cac481 GL |
975 | vif = netdev_priv(ndev); |
976 | wilc = vif->wilc; | |
c5c77ba1 | 977 | |
c5c77ba1 | 978 | if (skb->dev != ndev) { |
5ac24427 | 979 | netdev_err(ndev, "Packet not destined to this device\n"); |
c5c77ba1 JK |
980 | return 0; |
981 | } | |
982 | ||
b38e9030 | 983 | tx_data = kmalloc(sizeof(*tx_data), GFP_ATOMIC); |
3a147c07 | 984 | if (!tx_data) { |
c5c77ba1 JK |
985 | dev_kfree_skb(skb); |
986 | netif_wake_queue(ndev); | |
987 | return 0; | |
988 | } | |
989 | ||
990 | tx_data->buff = skb->data; | |
991 | tx_data->size = skb->len; | |
992 | tx_data->skb = skb; | |
993 | ||
994 | eth_h = (struct ethhdr *)(skb->data); | |
94500d56 | 995 | if (eth_h->h_proto == cpu_to_be16(0x8e88)) |
5ac24427 | 996 | netdev_dbg(ndev, "EAPOL transmitted\n"); |
c5c77ba1 | 997 | |
c5c77ba1 JK |
998 | ih = (struct iphdr *)(skb->data + sizeof(struct ethhdr)); |
999 | ||
fd8f0367 LK |
1000 | udp_buf = (char *)ih + sizeof(struct iphdr); |
1001 | if ((udp_buf[1] == 68 && udp_buf[3] == 67) || | |
1002 | (udp_buf[1] == 67 && udp_buf[3] == 68)) | |
5ac24427 LK |
1003 | netdev_dbg(ndev, "DHCP Message transmitted, type:%x %x %x\n", |
1004 | udp_buf[248], udp_buf[249], udp_buf[250]); | |
c5c77ba1 | 1005 | |
a4cac481 GL |
1006 | vif->netstats.tx_packets++; |
1007 | vif->netstats.tx_bytes += tx_data->size; | |
6750140d | 1008 | tx_data->bssid = wilc->vif[vif->idx]->bssid; |
44ec3b75 LK |
1009 | queue_count = wilc_wlan_txq_add_net_pkt(ndev, (void *)tx_data, |
1010 | tx_data->buff, tx_data->size, | |
1011 | linux_wlan_tx_complete); | |
c5c77ba1 | 1012 | |
44ec3b75 | 1013 | if (queue_count > FLOW_CONTROL_UPPER_THRESHOLD) { |
1f435d2e GL |
1014 | netif_stop_queue(wilc->vif[0]->ndev); |
1015 | netif_stop_queue(wilc->vif[1]->ndev); | |
c5c77ba1 JK |
1016 | } |
1017 | ||
1018 | return 0; | |
1019 | } | |
1020 | ||
68a30a63 | 1021 | static int wilc_mac_close(struct net_device *ndev) |
c5c77ba1 | 1022 | { |
2726887c | 1023 | struct wilc_priv *priv; |
a4cac481 | 1024 | struct wilc_vif *vif; |
2db2c8a7 | 1025 | struct host_if_drv *hif_drv; |
ca64ad6e | 1026 | struct wilc *wl; |
c5c77ba1 | 1027 | |
a4cac481 | 1028 | vif = netdev_priv(ndev); |
c5c77ba1 | 1029 | |
1006b5c7 | 1030 | if (!vif || !vif->ndev || !vif->ndev->ieee80211_ptr || |
1408603c | 1031 | !vif->ndev->ieee80211_ptr->wiphy) |
c5c77ba1 | 1032 | return 0; |
c5c77ba1 | 1033 | |
1006b5c7 | 1034 | priv = wiphy_priv(vif->ndev->ieee80211_ptr->wiphy); |
a4cac481 | 1035 | wl = vif->wilc; |
c5c77ba1 | 1036 | |
1408603c | 1037 | if (!priv) |
c5c77ba1 | 1038 | return 0; |
c5c77ba1 | 1039 | |
48b28df9 | 1040 | hif_drv = (struct host_if_drv *)priv->hif_drv; |
c5c77ba1 | 1041 | |
5ac24427 | 1042 | netdev_dbg(ndev, "Mac close\n"); |
c5c77ba1 | 1043 | |
1408603c | 1044 | if (!wl) |
c5c77ba1 | 1045 | return 0; |
c5c77ba1 | 1046 | |
1408603c | 1047 | if (!hif_drv) |
c5c77ba1 | 1048 | return 0; |
c5c77ba1 | 1049 | |
1408603c | 1050 | if ((wl->open_ifcs) > 0) |
ca64ad6e | 1051 | wl->open_ifcs--; |
1408603c | 1052 | else |
c5c77ba1 | 1053 | return 0; |
c5c77ba1 | 1054 | |
1006b5c7 GL |
1055 | if (vif->ndev) { |
1056 | netif_stop_queue(vif->ndev); | |
c5c77ba1 | 1057 | |
1006b5c7 | 1058 | wilc_deinit_host_int(vif->ndev); |
c5c77ba1 JK |
1059 | } |
1060 | ||
ca64ad6e | 1061 | if (wl->open_ifcs == 0) { |
5ac24427 | 1062 | netdev_dbg(ndev, "Deinitializing wilc1000\n"); |
ca64ad6e | 1063 | wl->close = 1; |
53dc0cfe | 1064 | wilc1000_wlan_deinit(ndev); |
c5c77ba1 | 1065 | WILC_WFI_deinit_mon_interface(); |
c5c77ba1 JK |
1066 | } |
1067 | ||
a4cac481 | 1068 | vif->mac_opened = 0; |
c5c77ba1 JK |
1069 | |
1070 | return 0; | |
1071 | } | |
1072 | ||
1608c403 | 1073 | static int mac_ioctl(struct net_device *ndev, struct ifreq *req, int cmd) |
c5c77ba1 | 1074 | { |
63d03e47 | 1075 | u8 *buff = NULL; |
ca356ada | 1076 | s8 rssi; |
4e4467fd | 1077 | u32 size = 0, length = 0; |
a4cac481 | 1078 | struct wilc_vif *vif; |
9457b05e | 1079 | s32 ret = 0; |
07320b6b | 1080 | struct wilc *wilc; |
c5c77ba1 | 1081 | |
a4cac481 GL |
1082 | vif = netdev_priv(ndev); |
1083 | wilc = vif->wilc; | |
c5c77ba1 | 1084 | |
07320b6b | 1085 | if (!wilc->initialized) |
c5c77ba1 JK |
1086 | return 0; |
1087 | ||
c5c77ba1 | 1088 | switch (cmd) { |
c5c77ba1 JK |
1089 | case SIOCSIWPRIV: |
1090 | { | |
f05ab249 | 1091 | struct iwreq *wrq = (struct iwreq *)req; |
c5c77ba1 JK |
1092 | |
1093 | size = wrq->u.data.length; | |
1094 | ||
1095 | if (size && wrq->u.data.pointer) { | |
582f8a27 LK |
1096 | buff = memdup_user(wrq->u.data.pointer, |
1097 | wrq->u.data.length); | |
360e27a9 SM |
1098 | if (IS_ERR(buff)) |
1099 | return PTR_ERR(buff); | |
c5c77ba1 JK |
1100 | |
1101 | if (strncasecmp(buff, "RSSI", length) == 0) { | |
fbf5379b | 1102 | ret = wilc_get_rssi(vif, &rssi); |
5ac24427 | 1103 | netdev_info(ndev, "RSSI :%d\n", rssi); |
c5c77ba1 | 1104 | |
c5c77ba1 JK |
1105 | rssi += 5; |
1106 | ||
1107 | snprintf(buff, size, "rssi %d", rssi); | |
1108 | ||
1109 | if (copy_to_user(wrq->u.data.pointer, buff, size)) { | |
5ac24427 | 1110 | netdev_err(ndev, "failed to copy\n"); |
9457b05e | 1111 | ret = -EFAULT; |
c5c77ba1 JK |
1112 | goto done; |
1113 | } | |
1114 | } | |
1115 | } | |
1116 | } | |
1117 | break; | |
1118 | ||
1119 | default: | |
1120 | { | |
5ac24427 | 1121 | netdev_info(ndev, "Command - %d - has been received\n", cmd); |
9457b05e | 1122 | ret = -EOPNOTSUPP; |
c5c77ba1 JK |
1123 | goto done; |
1124 | } | |
1125 | } | |
1126 | ||
1127 | done: | |
1128 | ||
642ac6c0 | 1129 | kfree(buff); |
c5c77ba1 | 1130 | |
9457b05e | 1131 | return ret; |
c5c77ba1 JK |
1132 | } |
1133 | ||
562ed3f1 | 1134 | void wilc_frmw_to_linux(struct wilc *wilc, u8 *buff, u32 size, u32 pkt_offset) |
c5c77ba1 | 1135 | { |
c5c77ba1 JK |
1136 | unsigned int frame_len = 0; |
1137 | int stats; | |
1138 | unsigned char *buff_to_send = NULL; | |
1139 | struct sk_buff *skb; | |
c5c77ba1 | 1140 | struct net_device *wilc_netdev; |
a4cac481 | 1141 | struct wilc_vif *vif; |
c5c77ba1 | 1142 | |
0953a2e3 LK |
1143 | if (!wilc) |
1144 | return; | |
1145 | ||
7e725b47 | 1146 | wilc_netdev = get_if_handler(wilc, buff); |
3a147c07 | 1147 | if (!wilc_netdev) |
c5c77ba1 JK |
1148 | return; |
1149 | ||
1150 | buff += pkt_offset; | |
a4cac481 | 1151 | vif = netdev_priv(wilc_netdev); |
c5c77ba1 JK |
1152 | |
1153 | if (size > 0) { | |
c5c77ba1 JK |
1154 | frame_len = size; |
1155 | buff_to_send = buff; | |
1156 | ||
c5c77ba1 | 1157 | skb = dev_alloc_skb(frame_len); |
1408603c | 1158 | if (!skb) |
c5c77ba1 | 1159 | return; |
1408603c | 1160 | |
c5c77ba1 JK |
1161 | skb->dev = wilc_netdev; |
1162 | ||
c5c77ba1 JK |
1163 | memcpy(skb_put(skb, frame_len), buff_to_send, frame_len); |
1164 | ||
c5c77ba1 | 1165 | skb->protocol = eth_type_trans(skb, wilc_netdev); |
a4cac481 GL |
1166 | vif->netstats.rx_packets++; |
1167 | vif->netstats.rx_bytes += frame_len; | |
c5c77ba1 JK |
1168 | skb->ip_summed = CHECKSUM_UNNECESSARY; |
1169 | stats = netif_rx(skb); | |
5ac24427 | 1170 | netdev_dbg(wilc_netdev, "netif_rx ret value is: %d\n", stats); |
c5c77ba1 | 1171 | } |
c5c77ba1 JK |
1172 | } |
1173 | ||
11f4b2ee | 1174 | void WILC_WFI_mgmt_rx(struct wilc *wilc, u8 *buff, u32 size) |
c5c77ba1 JK |
1175 | { |
1176 | int i = 0; | |
a4cac481 | 1177 | struct wilc_vif *vif; |
c5c77ba1 | 1178 | |
11f4b2ee | 1179 | for (i = 0; i < wilc->vif_num; i++) { |
1f435d2e | 1180 | vif = netdev_priv(wilc->vif[i]->ndev); |
a4cac481 | 1181 | if (vif->monitor_flag) { |
c5c77ba1 JK |
1182 | WILC_WFI_monitor_rx(buff, size); |
1183 | return; | |
1184 | } | |
1185 | } | |
1186 | ||
1f435d2e | 1187 | vif = netdev_priv(wilc->vif[1]->ndev); |
340a84ff LK |
1188 | if ((buff[0] == vif->frame_reg[0].type && vif->frame_reg[0].reg) || |
1189 | (buff[0] == vif->frame_reg[1].type && vif->frame_reg[1].reg)) | |
1f435d2e | 1190 | WILC_WFI_p2p_rx(wilc->vif[1]->ndev, buff, size); |
c5c77ba1 JK |
1191 | } |
1192 | ||
857c7b00 | 1193 | void wilc_netdev_cleanup(struct wilc *wilc) |
4875c499 | 1194 | { |
735bb39c | 1195 | int i; |
4875c499 | 1196 | |
735bb39c | 1197 | if (wilc && (wilc->vif[0]->ndev || wilc->vif[1]->ndev)) |
4875c499 TC |
1198 | unregister_inetaddr_notifier(&g_dev_notifier); |
1199 | ||
3f626cf4 | 1200 | if (wilc && wilc->firmware) { |
90b984c8 | 1201 | release_firmware(wilc->firmware); |
3f626cf4 LK |
1202 | wilc->firmware = NULL; |
1203 | } | |
4875c499 | 1204 | |
1f435d2e | 1205 | if (wilc && (wilc->vif[0]->ndev || wilc->vif[1]->ndev)) { |
4875c499 | 1206 | for (i = 0; i < NUM_CONCURRENT_IFC; i++) |
1f435d2e | 1207 | if (wilc->vif[i]->ndev) |
735bb39c | 1208 | if (wilc->vif[i]->mac_opened) |
1f435d2e | 1209 | wilc_mac_close(wilc->vif[i]->ndev); |
4875c499 TC |
1210 | |
1211 | for (i = 0; i < NUM_CONCURRENT_IFC; i++) { | |
1f435d2e GL |
1212 | unregister_netdev(wilc->vif[i]->ndev); |
1213 | wilc_free_wiphy(wilc->vif[i]->ndev); | |
1214 | free_netdev(wilc->vif[i]->ndev); | |
4875c499 TC |
1215 | } |
1216 | } | |
1217 | ||
90b984c8 | 1218 | kfree(wilc); |
4875c499 | 1219 | } |
750ffe9b | 1220 | EXPORT_SYMBOL_GPL(wilc_netdev_cleanup); |
4875c499 | 1221 | |
7d37a4a1 AB |
1222 | int wilc_netdev_init(struct wilc **wilc, struct device *dev, int io_type, |
1223 | int gpio, const struct wilc_hif_func *ops) | |
c5c77ba1 | 1224 | { |
fe747f0f | 1225 | int i, ret; |
a4cac481 | 1226 | struct wilc_vif *vif; |
c5c77ba1 | 1227 | struct net_device *ndev; |
562ed3f1 | 1228 | struct wilc *wl; |
c5c77ba1 | 1229 | |
825b966f | 1230 | wl = kzalloc(sizeof(*wl), GFP_KERNEL); |
562ed3f1 | 1231 | if (!wl) |
ac61ef86 | 1232 | return -ENOMEM; |
c5c77ba1 | 1233 | |
562ed3f1 AB |
1234 | *wilc = wl; |
1235 | wl->io_type = io_type; | |
1236 | wl->gpio = gpio; | |
af9ae09a | 1237 | wl->hif_func = ops; |
c4d139cb | 1238 | |
c5c77ba1 | 1239 | register_inetaddr_notifier(&g_dev_notifier); |
c5c77ba1 JK |
1240 | |
1241 | for (i = 0; i < NUM_CONCURRENT_IFC; i++) { | |
a4cac481 | 1242 | ndev = alloc_etherdev(sizeof(struct wilc_vif)); |
1408603c | 1243 | if (!ndev) |
fe747f0f | 1244 | return -ENOMEM; |
c5c77ba1 | 1245 | |
a4cac481 GL |
1246 | vif = netdev_priv(ndev); |
1247 | memset(vif, 0, sizeof(struct wilc_vif)); | |
c5c77ba1 | 1248 | |
84d3b87e | 1249 | if (i == 0) |
c5c77ba1 | 1250 | strcpy(ndev->name, "wlan%d"); |
84d3b87e | 1251 | else |
c5c77ba1 JK |
1252 | strcpy(ndev->name, "p2p%d"); |
1253 | ||
a4cac481 | 1254 | vif->wilc = *wilc; |
735bb39c | 1255 | vif->ndev = ndev; |
1f435d2e | 1256 | wl->vif[i] = vif; |
735bb39c | 1257 | wl->vif_num = i; |
0e490657 AS |
1258 | vif->idx = wl->vif_num; |
1259 | ||
e5af0561 | 1260 | ndev->netdev_ops = &wilc_netdev_ops; |
c5c77ba1 | 1261 | |
c5c77ba1 JK |
1262 | { |
1263 | struct wireless_dev *wdev; | |
fa8b23c6 | 1264 | |
2e7d5377 | 1265 | wdev = wilc_create_wiphy(ndev, dev); |
c5c77ba1 | 1266 | |
67039928 AB |
1267 | if (dev) |
1268 | SET_NETDEV_DEV(ndev, dev); | |
c5c77ba1 | 1269 | |
3a147c07 | 1270 | if (!wdev) { |
5ac24427 | 1271 | netdev_err(ndev, "Can't register WILC Wiphy\n"); |
c5c77ba1 JK |
1272 | return -1; |
1273 | } | |
1274 | ||
1006b5c7 GL |
1275 | vif->ndev->ieee80211_ptr = wdev; |
1276 | vif->ndev->ml_priv = vif; | |
1277 | wdev->netdev = vif->ndev; | |
a4cac481 GL |
1278 | vif->netstats.rx_packets = 0; |
1279 | vif->netstats.tx_packets = 0; | |
1280 | vif->netstats.rx_bytes = 0; | |
1281 | vif->netstats.tx_bytes = 0; | |
c5c77ba1 | 1282 | } |
c5c77ba1 | 1283 | |
fe747f0f AKC |
1284 | ret = register_netdev(ndev); |
1285 | if (ret) | |
1286 | return ret; | |
c5c77ba1 | 1287 | |
a4cac481 GL |
1288 | vif->iftype = STATION_MODE; |
1289 | vif->mac_opened = 0; | |
c5c77ba1 JK |
1290 | } |
1291 | ||
c5c77ba1 JK |
1292 | return 0; |
1293 | } | |
750ffe9b | 1294 | EXPORT_SYMBOL_GPL(wilc_netdev_init); |
c94f05ee AB |
1295 | |
1296 | MODULE_LICENSE("GPL"); |