main.c 26 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000
  1. /*
  2. * Copyright 2002-2005, Instant802 Networks, Inc.
  3. * Copyright 2005-2006, Devicescape Software, Inc.
  4. * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. */
  10. #include <net/mac80211.h>
  11. #include <linux/module.h>
  12. #include <linux/init.h>
  13. #include <linux/netdevice.h>
  14. #include <linux/types.h>
  15. #include <linux/slab.h>
  16. #include <linux/skbuff.h>
  17. #include <linux/etherdevice.h>
  18. #include <linux/if_arp.h>
  19. #include <linux/rtnetlink.h>
  20. #include <linux/bitmap.h>
  21. #include <linux/pm_qos_params.h>
  22. #include <linux/inetdevice.h>
  23. #include <net/net_namespace.h>
  24. #include <net/cfg80211.h>
  25. #include "ieee80211_i.h"
  26. #include "driver-ops.h"
  27. #include "rate.h"
  28. #include "mesh.h"
  29. #include "wep.h"
  30. #include "led.h"
  31. #include "cfg.h"
  32. #include "debugfs.h"
  33. bool ieee80211_disable_40mhz_24ghz;
  34. module_param(ieee80211_disable_40mhz_24ghz, bool, 0644);
  35. MODULE_PARM_DESC(ieee80211_disable_40mhz_24ghz,
  36. "Disable 40MHz support in the 2.4GHz band");
  37. void ieee80211_configure_filter(struct ieee80211_local *local)
  38. {
  39. u64 mc;
  40. unsigned int changed_flags;
  41. unsigned int new_flags = 0;
  42. if (atomic_read(&local->iff_promiscs))
  43. new_flags |= FIF_PROMISC_IN_BSS;
  44. if (atomic_read(&local->iff_allmultis))
  45. new_flags |= FIF_ALLMULTI;
  46. if (local->monitors || local->scanning)
  47. new_flags |= FIF_BCN_PRBRESP_PROMISC;
  48. if (local->fif_probe_req || local->probe_req_reg)
  49. new_flags |= FIF_PROBE_REQ;
  50. if (local->fif_fcsfail)
  51. new_flags |= FIF_FCSFAIL;
  52. if (local->fif_plcpfail)
  53. new_flags |= FIF_PLCPFAIL;
  54. if (local->fif_control)
  55. new_flags |= FIF_CONTROL;
  56. if (local->fif_other_bss)
  57. new_flags |= FIF_OTHER_BSS;
  58. if (local->fif_pspoll)
  59. new_flags |= FIF_PSPOLL;
  60. spin_lock_bh(&local->filter_lock);
  61. changed_flags = local->filter_flags ^ new_flags;
  62. mc = drv_prepare_multicast(local, &local->mc_list);
  63. spin_unlock_bh(&local->filter_lock);
  64. /* be a bit nasty */
  65. new_flags |= (1<<31);
  66. drv_configure_filter(local, changed_flags, &new_flags, mc);
  67. WARN_ON(new_flags & (1<<31));
  68. local->filter_flags = new_flags & ~(1<<31);
  69. }
  70. static void ieee80211_reconfig_filter(struct work_struct *work)
  71. {
  72. struct ieee80211_local *local =
  73. container_of(work, struct ieee80211_local, reconfig_filter);
  74. ieee80211_configure_filter(local);
  75. }
  76. int ieee80211_hw_config(struct ieee80211_local *local, u32 changed)
  77. {
  78. struct ieee80211_channel *chan, *scan_chan;
  79. int ret = 0;
  80. int power;
  81. enum nl80211_channel_type channel_type;
  82. u32 offchannel_flag;
  83. might_sleep();
  84. scan_chan = local->scan_channel;
  85. offchannel_flag = local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL;
  86. if (scan_chan) {
  87. chan = scan_chan;
  88. channel_type = NL80211_CHAN_NO_HT;
  89. local->hw.conf.flags |= IEEE80211_CONF_OFFCHANNEL;
  90. } else if (local->tmp_channel &&
  91. local->oper_channel != local->tmp_channel) {
  92. chan = scan_chan = local->tmp_channel;
  93. channel_type = local->tmp_channel_type;
  94. local->hw.conf.flags |= IEEE80211_CONF_OFFCHANNEL;
  95. } else {
  96. chan = local->oper_channel;
  97. channel_type = local->_oper_channel_type;
  98. local->hw.conf.flags &= ~IEEE80211_CONF_OFFCHANNEL;
  99. }
  100. offchannel_flag ^= local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL;
  101. if (offchannel_flag || chan != local->hw.conf.channel ||
  102. channel_type != local->hw.conf.channel_type) {
  103. local->hw.conf.channel = chan;
  104. local->hw.conf.channel_type = channel_type;
  105. changed |= IEEE80211_CONF_CHANGE_CHANNEL;
  106. }
  107. if (!conf_is_ht(&local->hw.conf)) {
  108. /*
  109. * mac80211.h documents that this is only valid
  110. * when the channel is set to an HT type, and
  111. * that otherwise STATIC is used.
  112. */
  113. local->hw.conf.smps_mode = IEEE80211_SMPS_STATIC;
  114. } else if (local->hw.conf.smps_mode != local->smps_mode) {
  115. local->hw.conf.smps_mode = local->smps_mode;
  116. changed |= IEEE80211_CONF_CHANGE_SMPS;
  117. }
  118. if (scan_chan)
  119. power = chan->max_power;
  120. else
  121. power = local->power_constr_level ?
  122. (chan->max_power - local->power_constr_level) :
  123. chan->max_power;
  124. if (local->user_power_level >= 0)
  125. power = min(power, local->user_power_level);
  126. if (local->hw.conf.power_level != power) {
  127. changed |= IEEE80211_CONF_CHANGE_POWER;
  128. local->hw.conf.power_level = power;
  129. }
  130. if (changed && local->open_count) {
  131. ret = drv_config(local, changed);
  132. /*
  133. * Goal:
  134. * HW reconfiguration should never fail, the driver has told
  135. * us what it can support so it should live up to that promise.
  136. *
  137. * Current status:
  138. * rfkill is not integrated with mac80211 and a
  139. * configuration command can thus fail if hardware rfkill
  140. * is enabled
  141. *
  142. * FIXME: integrate rfkill with mac80211 and then add this
  143. * WARN_ON() back
  144. *
  145. */
  146. /* WARN_ON(ret); */
  147. }
  148. return ret;
  149. }
  150. void ieee80211_bss_info_change_notify(struct ieee80211_sub_if_data *sdata,
  151. u32 changed)
  152. {
  153. struct ieee80211_local *local = sdata->local;
  154. static const u8 zero[ETH_ALEN] = { 0 };
  155. if (!changed)
  156. return;
  157. if (sdata->vif.type == NL80211_IFTYPE_STATION) {
  158. /*
  159. * While not associated, claim a BSSID of all-zeroes
  160. * so that drivers don't do any weird things with the
  161. * BSSID at that time.
  162. */
  163. if (sdata->vif.bss_conf.assoc)
  164. sdata->vif.bss_conf.bssid = sdata->u.mgd.bssid;
  165. else
  166. sdata->vif.bss_conf.bssid = zero;
  167. } else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
  168. sdata->vif.bss_conf.bssid = sdata->u.ibss.bssid;
  169. else if (sdata->vif.type == NL80211_IFTYPE_AP)
  170. sdata->vif.bss_conf.bssid = sdata->vif.addr;
  171. else if (sdata->vif.type == NL80211_IFTYPE_WDS)
  172. sdata->vif.bss_conf.bssid = NULL;
  173. else if (ieee80211_vif_is_mesh(&sdata->vif)) {
  174. sdata->vif.bss_conf.bssid = zero;
  175. } else {
  176. WARN_ON(1);
  177. return;
  178. }
  179. switch (sdata->vif.type) {
  180. case NL80211_IFTYPE_AP:
  181. case NL80211_IFTYPE_ADHOC:
  182. case NL80211_IFTYPE_WDS:
  183. case NL80211_IFTYPE_MESH_POINT:
  184. break;
  185. default:
  186. /* do not warn to simplify caller in scan.c */
  187. changed &= ~BSS_CHANGED_BEACON_ENABLED;
  188. if (WARN_ON(changed & BSS_CHANGED_BEACON))
  189. return;
  190. break;
  191. }
  192. if (changed & BSS_CHANGED_BEACON_ENABLED) {
  193. if (local->quiescing || !ieee80211_sdata_running(sdata) ||
  194. test_bit(SCAN_SW_SCANNING, &local->scanning)) {
  195. sdata->vif.bss_conf.enable_beacon = false;
  196. } else {
  197. /*
  198. * Beacon should be enabled, but AP mode must
  199. * check whether there is a beacon configured.
  200. */
  201. switch (sdata->vif.type) {
  202. case NL80211_IFTYPE_AP:
  203. sdata->vif.bss_conf.enable_beacon =
  204. !!sdata->u.ap.beacon;
  205. break;
  206. case NL80211_IFTYPE_ADHOC:
  207. sdata->vif.bss_conf.enable_beacon =
  208. !!sdata->u.ibss.presp;
  209. break;
  210. #ifdef CONFIG_MAC80211_MESH
  211. case NL80211_IFTYPE_MESH_POINT:
  212. sdata->vif.bss_conf.enable_beacon =
  213. !!sdata->u.mesh.mesh_id_len;
  214. break;
  215. #endif
  216. default:
  217. /* not reached */
  218. WARN_ON(1);
  219. break;
  220. }
  221. }
  222. }
  223. drv_bss_info_changed(local, sdata, &sdata->vif.bss_conf, changed);
  224. }
  225. u32 ieee80211_reset_erp_info(struct ieee80211_sub_if_data *sdata)
  226. {
  227. sdata->vif.bss_conf.use_cts_prot = false;
  228. sdata->vif.bss_conf.use_short_preamble = false;
  229. sdata->vif.bss_conf.use_short_slot = false;
  230. return BSS_CHANGED_ERP_CTS_PROT |
  231. BSS_CHANGED_ERP_PREAMBLE |
  232. BSS_CHANGED_ERP_SLOT;
  233. }
  234. static void ieee80211_tasklet_handler(unsigned long data)
  235. {
  236. struct ieee80211_local *local = (struct ieee80211_local *) data;
  237. struct sk_buff *skb;
  238. while ((skb = skb_dequeue(&local->skb_queue)) ||
  239. (skb = skb_dequeue(&local->skb_queue_unreliable))) {
  240. switch (skb->pkt_type) {
  241. case IEEE80211_RX_MSG:
  242. /* Clear skb->pkt_type in order to not confuse kernel
  243. * netstack. */
  244. skb->pkt_type = 0;
  245. ieee80211_rx(local_to_hw(local), skb);
  246. break;
  247. case IEEE80211_TX_STATUS_MSG:
  248. skb->pkt_type = 0;
  249. ieee80211_tx_status(local_to_hw(local), skb);
  250. break;
  251. default:
  252. WARN(1, "mac80211: Packet is of unknown type %d\n",
  253. skb->pkt_type);
  254. dev_kfree_skb(skb);
  255. break;
  256. }
  257. }
  258. }
  259. static void ieee80211_restart_work(struct work_struct *work)
  260. {
  261. struct ieee80211_local *local =
  262. container_of(work, struct ieee80211_local, restart_work);
  263. /* wait for scan work complete */
  264. flush_workqueue(local->workqueue);
  265. mutex_lock(&local->mtx);
  266. WARN(test_bit(SCAN_HW_SCANNING, &local->scanning),
  267. "%s called with hardware scan in progress\n", __func__);
  268. mutex_unlock(&local->mtx);
  269. rtnl_lock();
  270. ieee80211_scan_cancel(local);
  271. ieee80211_reconfig(local);
  272. rtnl_unlock();
  273. }
  274. void ieee80211_restart_hw(struct ieee80211_hw *hw)
  275. {
  276. struct ieee80211_local *local = hw_to_local(hw);
  277. trace_api_restart_hw(local);
  278. /* use this reason, ieee80211_reconfig will unblock it */
  279. ieee80211_stop_queues_by_reason(hw,
  280. IEEE80211_QUEUE_STOP_REASON_SUSPEND);
  281. schedule_work(&local->restart_work);
  282. }
  283. EXPORT_SYMBOL(ieee80211_restart_hw);
  284. static void ieee80211_recalc_smps_work(struct work_struct *work)
  285. {
  286. struct ieee80211_local *local =
  287. container_of(work, struct ieee80211_local, recalc_smps);
  288. mutex_lock(&local->iflist_mtx);
  289. ieee80211_recalc_smps(local);
  290. mutex_unlock(&local->iflist_mtx);
  291. }
  292. #ifdef CONFIG_INET
  293. static int ieee80211_ifa_changed(struct notifier_block *nb,
  294. unsigned long data, void *arg)
  295. {
  296. struct in_ifaddr *ifa = arg;
  297. struct ieee80211_local *local =
  298. container_of(nb, struct ieee80211_local,
  299. ifa_notifier);
  300. struct net_device *ndev = ifa->ifa_dev->dev;
  301. struct wireless_dev *wdev = ndev->ieee80211_ptr;
  302. struct in_device *idev;
  303. struct ieee80211_sub_if_data *sdata;
  304. struct ieee80211_bss_conf *bss_conf;
  305. struct ieee80211_if_managed *ifmgd;
  306. int c = 0;
  307. /* Make sure it's our interface that got changed */
  308. if (!wdev)
  309. return NOTIFY_DONE;
  310. if (wdev->wiphy != local->hw.wiphy)
  311. return NOTIFY_DONE;
  312. sdata = IEEE80211_DEV_TO_SUB_IF(ndev);
  313. bss_conf = &sdata->vif.bss_conf;
  314. if (!ieee80211_sdata_running(sdata))
  315. return NOTIFY_DONE;
  316. /* ARP filtering is only supported in managed mode */
  317. if (sdata->vif.type != NL80211_IFTYPE_STATION)
  318. return NOTIFY_DONE;
  319. idev = __in_dev_get_rtnl(sdata->dev);
  320. if (!idev)
  321. return NOTIFY_DONE;
  322. ifmgd = &sdata->u.mgd;
  323. mutex_lock(&ifmgd->mtx);
  324. /* Copy the addresses to the bss_conf list */
  325. ifa = idev->ifa_list;
  326. while (c < IEEE80211_BSS_ARP_ADDR_LIST_LEN && ifa) {
  327. bss_conf->arp_addr_list[c] = ifa->ifa_address;
  328. ifa = ifa->ifa_next;
  329. c++;
  330. }
  331. /* If not all addresses fit the list, disable filtering */
  332. if (ifa) {
  333. sdata->arp_filter_state = false;
  334. c = 0;
  335. } else {
  336. sdata->arp_filter_state = true;
  337. }
  338. bss_conf->arp_addr_cnt = c;
  339. /* Configure driver only if associated */
  340. if (ifmgd->associated) {
  341. bss_conf->arp_filter_enabled = sdata->arp_filter_state;
  342. ieee80211_bss_info_change_notify(sdata,
  343. BSS_CHANGED_ARP_FILTER);
  344. }
  345. mutex_unlock(&ifmgd->mtx);
  346. return NOTIFY_DONE;
  347. }
  348. #endif
  349. static int ieee80211_napi_poll(struct napi_struct *napi, int budget)
  350. {
  351. struct ieee80211_local *local =
  352. container_of(napi, struct ieee80211_local, napi);
  353. return local->ops->napi_poll(&local->hw, budget);
  354. }
  355. void ieee80211_napi_schedule(struct ieee80211_hw *hw)
  356. {
  357. struct ieee80211_local *local = hw_to_local(hw);
  358. napi_schedule(&local->napi);
  359. }
  360. EXPORT_SYMBOL(ieee80211_napi_schedule);
  361. void ieee80211_napi_complete(struct ieee80211_hw *hw)
  362. {
  363. struct ieee80211_local *local = hw_to_local(hw);
  364. napi_complete(&local->napi);
  365. }
  366. EXPORT_SYMBOL(ieee80211_napi_complete);
  367. /* There isn't a lot of sense in it, but you can transmit anything you like */
  368. static const struct ieee80211_txrx_stypes
  369. ieee80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = {
  370. [NL80211_IFTYPE_ADHOC] = {
  371. .tx = 0xffff,
  372. .rx = BIT(IEEE80211_STYPE_ACTION >> 4),
  373. },
  374. [NL80211_IFTYPE_STATION] = {
  375. .tx = 0xffff,
  376. .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
  377. BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
  378. },
  379. [NL80211_IFTYPE_AP] = {
  380. .tx = 0xffff,
  381. .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
  382. BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
  383. BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
  384. BIT(IEEE80211_STYPE_DISASSOC >> 4) |
  385. BIT(IEEE80211_STYPE_AUTH >> 4) |
  386. BIT(IEEE80211_STYPE_DEAUTH >> 4) |
  387. BIT(IEEE80211_STYPE_ACTION >> 4),
  388. },
  389. [NL80211_IFTYPE_AP_VLAN] = {
  390. /* copy AP */
  391. .tx = 0xffff,
  392. .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
  393. BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
  394. BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
  395. BIT(IEEE80211_STYPE_DISASSOC >> 4) |
  396. BIT(IEEE80211_STYPE_AUTH >> 4) |
  397. BIT(IEEE80211_STYPE_DEAUTH >> 4) |
  398. BIT(IEEE80211_STYPE_ACTION >> 4),
  399. },
  400. [NL80211_IFTYPE_P2P_CLIENT] = {
  401. .tx = 0xffff,
  402. .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
  403. BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
  404. },
  405. [NL80211_IFTYPE_P2P_GO] = {
  406. .tx = 0xffff,
  407. .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
  408. BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
  409. BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
  410. BIT(IEEE80211_STYPE_DISASSOC >> 4) |
  411. BIT(IEEE80211_STYPE_AUTH >> 4) |
  412. BIT(IEEE80211_STYPE_DEAUTH >> 4) |
  413. BIT(IEEE80211_STYPE_ACTION >> 4),
  414. },
  415. [NL80211_IFTYPE_MESH_POINT] = {
  416. .tx = 0xffff,
  417. .rx = BIT(IEEE80211_STYPE_ACTION >> 4),
  418. },
  419. };
  420. struct ieee80211_hw *ieee80211_alloc_hw(size_t priv_data_len,
  421. const struct ieee80211_ops *ops)
  422. {
  423. struct ieee80211_local *local;
  424. int priv_size, i;
  425. struct wiphy *wiphy;
  426. /* Ensure 32-byte alignment of our private data and hw private data.
  427. * We use the wiphy priv data for both our ieee80211_local and for
  428. * the driver's private data
  429. *
  430. * In memory it'll be like this:
  431. *
  432. * +-------------------------+
  433. * | struct wiphy |
  434. * +-------------------------+
  435. * | struct ieee80211_local |
  436. * +-------------------------+
  437. * | driver's private data |
  438. * +-------------------------+
  439. *
  440. */
  441. priv_size = ALIGN(sizeof(*local), NETDEV_ALIGN) + priv_data_len;
  442. wiphy = wiphy_new(&mac80211_config_ops, priv_size);
  443. if (!wiphy)
  444. return NULL;
  445. wiphy->mgmt_stypes = ieee80211_default_mgmt_stypes;
  446. wiphy->privid = mac80211_wiphy_privid;
  447. wiphy->flags |= WIPHY_FLAG_NETNS_OK |
  448. WIPHY_FLAG_4ADDR_AP |
  449. WIPHY_FLAG_4ADDR_STATION |
  450. WIPHY_FLAG_SUPPORTS_SEPARATE_DEFAULT_KEYS;
  451. if (!ops->set_key)
  452. wiphy->flags |= WIPHY_FLAG_IBSS_RSN;
  453. wiphy->bss_priv_size = sizeof(struct ieee80211_bss);
  454. local = wiphy_priv(wiphy);
  455. local->hw.wiphy = wiphy;
  456. local->hw.priv = (char *)local + ALIGN(sizeof(*local), NETDEV_ALIGN);
  457. BUG_ON(!ops->tx);
  458. BUG_ON(!ops->start);
  459. BUG_ON(!ops->stop);
  460. BUG_ON(!ops->config);
  461. BUG_ON(!ops->add_interface);
  462. BUG_ON(!ops->remove_interface);
  463. BUG_ON(!ops->configure_filter);
  464. local->ops = ops;
  465. /* set up some defaults */
  466. local->hw.queues = 1;
  467. local->hw.max_rates = 1;
  468. local->hw.max_report_rates = 0;
  469. local->hw.max_rx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF;
  470. local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
  471. local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
  472. local->user_power_level = -1;
  473. local->uapsd_queues = IEEE80211_DEFAULT_UAPSD_QUEUES;
  474. local->uapsd_max_sp_len = IEEE80211_DEFAULT_MAX_SP_LEN;
  475. INIT_LIST_HEAD(&local->interfaces);
  476. __hw_addr_init(&local->mc_list);
  477. mutex_init(&local->iflist_mtx);
  478. mutex_init(&local->mtx);
  479. mutex_init(&local->key_mtx);
  480. spin_lock_init(&local->filter_lock);
  481. spin_lock_init(&local->queue_stop_reason_lock);
  482. skb_queue_head_init(&local->rx_skb_queue);
  483. INIT_DELAYED_WORK(&local->scan_work, ieee80211_scan_work);
  484. ieee80211_work_init(local);
  485. INIT_WORK(&local->restart_work, ieee80211_restart_work);
  486. INIT_WORK(&local->reconfig_filter, ieee80211_reconfig_filter);
  487. INIT_WORK(&local->recalc_smps, ieee80211_recalc_smps_work);
  488. local->smps_mode = IEEE80211_SMPS_OFF;
  489. INIT_WORK(&local->dynamic_ps_enable_work,
  490. ieee80211_dynamic_ps_enable_work);
  491. INIT_WORK(&local->dynamic_ps_disable_work,
  492. ieee80211_dynamic_ps_disable_work);
  493. setup_timer(&local->dynamic_ps_timer,
  494. ieee80211_dynamic_ps_timer, (unsigned long) local);
  495. sta_info_init(local);
  496. for (i = 0; i < IEEE80211_MAX_QUEUES; i++) {
  497. skb_queue_head_init(&local->pending[i]);
  498. atomic_set(&local->agg_queue_stop[i], 0);
  499. }
  500. tasklet_init(&local->tx_pending_tasklet, ieee80211_tx_pending,
  501. (unsigned long)local);
  502. tasklet_init(&local->tasklet,
  503. ieee80211_tasklet_handler,
  504. (unsigned long) local);
  505. skb_queue_head_init(&local->skb_queue);
  506. skb_queue_head_init(&local->skb_queue_unreliable);
  507. /* init dummy netdev for use w/ NAPI */
  508. init_dummy_netdev(&local->napi_dev);
  509. ieee80211_led_names(local);
  510. ieee80211_hw_roc_setup(local);
  511. return local_to_hw(local);
  512. }
  513. EXPORT_SYMBOL(ieee80211_alloc_hw);
  514. int ieee80211_register_hw(struct ieee80211_hw *hw)
  515. {
  516. struct ieee80211_local *local = hw_to_local(hw);
  517. int result;
  518. enum ieee80211_band band;
  519. int channels, max_bitrates;
  520. bool supp_ht;
  521. static const u32 cipher_suites[] = {
  522. /* keep WEP first, it may be removed below */
  523. WLAN_CIPHER_SUITE_WEP40,
  524. WLAN_CIPHER_SUITE_WEP104,
  525. WLAN_CIPHER_SUITE_TKIP,
  526. WLAN_CIPHER_SUITE_CCMP,
  527. /* keep last -- depends on hw flags! */
  528. WLAN_CIPHER_SUITE_AES_CMAC
  529. };
  530. if (hw->max_report_rates == 0)
  531. hw->max_report_rates = hw->max_rates;
  532. /*
  533. * generic code guarantees at least one band,
  534. * set this very early because much code assumes
  535. * that hw.conf.channel is assigned
  536. */
  537. channels = 0;
  538. max_bitrates = 0;
  539. supp_ht = false;
  540. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  541. struct ieee80211_supported_band *sband;
  542. sband = local->hw.wiphy->bands[band];
  543. if (!sband)
  544. continue;
  545. if (!local->oper_channel) {
  546. /* init channel we're on */
  547. local->hw.conf.channel =
  548. local->oper_channel = &sband->channels[0];
  549. local->hw.conf.channel_type = NL80211_CHAN_NO_HT;
  550. }
  551. channels += sband->n_channels;
  552. if (max_bitrates < sband->n_bitrates)
  553. max_bitrates = sband->n_bitrates;
  554. supp_ht = supp_ht || sband->ht_cap.ht_supported;
  555. }
  556. local->int_scan_req = kzalloc(sizeof(*local->int_scan_req) +
  557. sizeof(void *) * channels, GFP_KERNEL);
  558. if (!local->int_scan_req)
  559. return -ENOMEM;
  560. /* if low-level driver supports AP, we also support VLAN */
  561. if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_AP))
  562. local->hw.wiphy->interface_modes |= BIT(NL80211_IFTYPE_AP_VLAN);
  563. /* mac80211 always supports monitor */
  564. local->hw.wiphy->interface_modes |= BIT(NL80211_IFTYPE_MONITOR);
  565. #ifndef CONFIG_MAC80211_MESH
  566. /* mesh depends on Kconfig, but drivers should set it if they want */
  567. local->hw.wiphy->interface_modes &= ~BIT(NL80211_IFTYPE_MESH_POINT);
  568. #endif
  569. /* mac80211 supports control port protocol changing */
  570. local->hw.wiphy->flags |= WIPHY_FLAG_CONTROL_PORT_PROTOCOL;
  571. if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
  572. local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
  573. else if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)
  574. local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_UNSPEC;
  575. WARN((local->hw.flags & IEEE80211_HW_SUPPORTS_UAPSD)
  576. && (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK),
  577. "U-APSD not supported with HW_PS_NULLFUNC_STACK\n");
  578. /*
  579. * Calculate scan IE length -- we need this to alloc
  580. * memory and to subtract from the driver limit. It
  581. * includes the DS Params, (extended) supported rates, and HT
  582. * information -- SSID is the driver's responsibility.
  583. */
  584. local->scan_ies_len = 4 + max_bitrates /* (ext) supp rates */ +
  585. 3 /* DS Params */;
  586. if (supp_ht)
  587. local->scan_ies_len += 2 + sizeof(struct ieee80211_ht_cap);
  588. if (!local->ops->hw_scan) {
  589. /* For hw_scan, driver needs to set these up. */
  590. local->hw.wiphy->max_scan_ssids = 4;
  591. local->hw.wiphy->max_scan_ie_len = IEEE80211_MAX_DATA_LEN;
  592. }
  593. /*
  594. * If the driver supports any scan IEs, then assume the
  595. * limit includes the IEs mac80211 will add, otherwise
  596. * leave it at zero and let the driver sort it out; we
  597. * still pass our IEs to the driver but userspace will
  598. * not be allowed to in that case.
  599. */
  600. if (local->hw.wiphy->max_scan_ie_len)
  601. local->hw.wiphy->max_scan_ie_len -= local->scan_ies_len;
  602. /* Set up cipher suites unless driver already did */
  603. if (!local->hw.wiphy->cipher_suites) {
  604. local->hw.wiphy->cipher_suites = cipher_suites;
  605. local->hw.wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
  606. if (!(local->hw.flags & IEEE80211_HW_MFP_CAPABLE))
  607. local->hw.wiphy->n_cipher_suites--;
  608. }
  609. if (IS_ERR(local->wep_tx_tfm) || IS_ERR(local->wep_rx_tfm)) {
  610. if (local->hw.wiphy->cipher_suites == cipher_suites) {
  611. local->hw.wiphy->cipher_suites += 2;
  612. local->hw.wiphy->n_cipher_suites -= 2;
  613. } else {
  614. u32 *suites;
  615. int r, w = 0;
  616. /* Filter out WEP */
  617. suites = kmemdup(
  618. local->hw.wiphy->cipher_suites,
  619. sizeof(u32) * local->hw.wiphy->n_cipher_suites,
  620. GFP_KERNEL);
  621. if (!suites)
  622. return -ENOMEM;
  623. for (r = 0; r < local->hw.wiphy->n_cipher_suites; r++) {
  624. u32 suite = local->hw.wiphy->cipher_suites[r];
  625. if (suite == WLAN_CIPHER_SUITE_WEP40 ||
  626. suite == WLAN_CIPHER_SUITE_WEP104)
  627. continue;
  628. suites[w++] = suite;
  629. }
  630. local->hw.wiphy->cipher_suites = suites;
  631. local->hw.wiphy->n_cipher_suites = w;
  632. local->wiphy_ciphers_allocated = true;
  633. }
  634. }
  635. if (!local->ops->remain_on_channel)
  636. local->hw.wiphy->max_remain_on_channel_duration = 5000;
  637. result = wiphy_register(local->hw.wiphy);
  638. if (result < 0)
  639. goto fail_wiphy_register;
  640. /*
  641. * We use the number of queues for feature tests (QoS, HT) internally
  642. * so restrict them appropriately.
  643. */
  644. if (hw->queues > IEEE80211_MAX_QUEUES)
  645. hw->queues = IEEE80211_MAX_QUEUES;
  646. local->workqueue =
  647. alloc_ordered_workqueue(wiphy_name(local->hw.wiphy), 0);
  648. if (!local->workqueue) {
  649. result = -ENOMEM;
  650. goto fail_workqueue;
  651. }
  652. /*
  653. * The hardware needs headroom for sending the frame,
  654. * and we need some headroom for passing the frame to monitor
  655. * interfaces, but never both at the same time.
  656. */
  657. BUILD_BUG_ON(IEEE80211_TX_STATUS_HEADROOM !=
  658. sizeof(struct ieee80211_tx_status_rtap_hdr));
  659. local->tx_headroom = max_t(unsigned int , local->hw.extra_tx_headroom,
  660. sizeof(struct ieee80211_tx_status_rtap_hdr));
  661. debugfs_hw_add(local);
  662. /*
  663. * if the driver doesn't specify a max listen interval we
  664. * use 5 which should be a safe default
  665. */
  666. if (local->hw.max_listen_interval == 0)
  667. local->hw.max_listen_interval = 5;
  668. local->hw.conf.listen_interval = local->hw.max_listen_interval;
  669. local->dynamic_ps_forced_timeout = -1;
  670. result = sta_info_start(local);
  671. if (result < 0)
  672. goto fail_sta_info;
  673. result = ieee80211_wep_init(local);
  674. if (result < 0)
  675. wiphy_debug(local->hw.wiphy, "Failed to initialize wep: %d\n",
  676. result);
  677. rtnl_lock();
  678. result = ieee80211_init_rate_ctrl_alg(local,
  679. hw->rate_control_algorithm);
  680. if (result < 0) {
  681. wiphy_debug(local->hw.wiphy,
  682. "Failed to initialize rate control algorithm\n");
  683. goto fail_rate;
  684. }
  685. /* add one default STA interface if supported */
  686. if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_STATION)) {
  687. result = ieee80211_if_add(local, "wlan%d", NULL,
  688. NL80211_IFTYPE_STATION, NULL);
  689. if (result)
  690. wiphy_warn(local->hw.wiphy,
  691. "Failed to add default virtual iface\n");
  692. }
  693. rtnl_unlock();
  694. ieee80211_led_init(local);
  695. local->network_latency_notifier.notifier_call =
  696. ieee80211_max_network_latency;
  697. result = pm_qos_add_notifier(PM_QOS_NETWORK_LATENCY,
  698. &local->network_latency_notifier);
  699. if (result) {
  700. rtnl_lock();
  701. goto fail_pm_qos;
  702. }
  703. #ifdef CONFIG_INET
  704. local->ifa_notifier.notifier_call = ieee80211_ifa_changed;
  705. result = register_inetaddr_notifier(&local->ifa_notifier);
  706. if (result)
  707. goto fail_ifa;
  708. #endif
  709. netif_napi_add(&local->napi_dev, &local->napi, ieee80211_napi_poll,
  710. local->hw.napi_weight);
  711. return 0;
  712. #ifdef CONFIG_INET
  713. fail_ifa:
  714. pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY,
  715. &local->network_latency_notifier);
  716. rtnl_lock();
  717. #endif
  718. fail_pm_qos:
  719. ieee80211_led_exit(local);
  720. ieee80211_remove_interfaces(local);
  721. fail_rate:
  722. rtnl_unlock();
  723. ieee80211_wep_free(local);
  724. sta_info_stop(local);
  725. fail_sta_info:
  726. destroy_workqueue(local->workqueue);
  727. fail_workqueue:
  728. wiphy_unregister(local->hw.wiphy);
  729. fail_wiphy_register:
  730. if (local->wiphy_ciphers_allocated)
  731. kfree(local->hw.wiphy->cipher_suites);
  732. kfree(local->int_scan_req);
  733. return result;
  734. }
  735. EXPORT_SYMBOL(ieee80211_register_hw);
  736. void ieee80211_unregister_hw(struct ieee80211_hw *hw)
  737. {
  738. struct ieee80211_local *local = hw_to_local(hw);
  739. tasklet_kill(&local->tx_pending_tasklet);
  740. tasklet_kill(&local->tasklet);
  741. pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY,
  742. &local->network_latency_notifier);
  743. #ifdef CONFIG_INET
  744. unregister_inetaddr_notifier(&local->ifa_notifier);
  745. #endif
  746. rtnl_lock();
  747. /*
  748. * At this point, interface list manipulations are fine
  749. * because the driver cannot be handing us frames any
  750. * more and the tasklet is killed.
  751. */
  752. ieee80211_remove_interfaces(local);
  753. rtnl_unlock();
  754. /*
  755. * Now all work items will be gone, but the
  756. * timer might still be armed, so delete it
  757. */
  758. del_timer_sync(&local->work_timer);
  759. cancel_work_sync(&local->restart_work);
  760. cancel_work_sync(&local->reconfig_filter);
  761. ieee80211_clear_tx_pending(local);
  762. sta_info_stop(local);
  763. rate_control_deinitialize(local);
  764. if (skb_queue_len(&local->skb_queue) ||
  765. skb_queue_len(&local->skb_queue_unreliable))
  766. wiphy_warn(local->hw.wiphy, "skb_queue not empty\n");
  767. skb_queue_purge(&local->skb_queue);
  768. skb_queue_purge(&local->skb_queue_unreliable);
  769. skb_queue_purge(&local->rx_skb_queue);
  770. destroy_workqueue(local->workqueue);
  771. wiphy_unregister(local->hw.wiphy);
  772. ieee80211_wep_free(local);
  773. ieee80211_led_exit(local);
  774. kfree(local->int_scan_req);
  775. }
  776. EXPORT_SYMBOL(ieee80211_unregister_hw);
  777. void ieee80211_free_hw(struct ieee80211_hw *hw)
  778. {
  779. struct ieee80211_local *local = hw_to_local(hw);
  780. mutex_destroy(&local->iflist_mtx);
  781. mutex_destroy(&local->mtx);
  782. if (local->wiphy_ciphers_allocated)
  783. kfree(local->hw.wiphy->cipher_suites);
  784. wiphy_free(local->hw.wiphy);
  785. }
  786. EXPORT_SYMBOL(ieee80211_free_hw);
  787. static int __init ieee80211_init(void)
  788. {
  789. struct sk_buff *skb;
  790. int ret;
  791. BUILD_BUG_ON(sizeof(struct ieee80211_tx_info) > sizeof(skb->cb));
  792. BUILD_BUG_ON(offsetof(struct ieee80211_tx_info, driver_data) +
  793. IEEE80211_TX_INFO_DRIVER_DATA_SIZE > sizeof(skb->cb));
  794. ret = rc80211_minstrel_init();
  795. if (ret)
  796. return ret;
  797. ret = rc80211_minstrel_ht_init();
  798. if (ret)
  799. goto err_minstrel;
  800. ret = rc80211_pid_init();
  801. if (ret)
  802. goto err_pid;
  803. ret = ieee80211_iface_init();
  804. if (ret)
  805. goto err_netdev;
  806. return 0;
  807. err_netdev:
  808. rc80211_pid_exit();
  809. err_pid:
  810. rc80211_minstrel_ht_exit();
  811. err_minstrel:
  812. rc80211_minstrel_exit();
  813. return ret;
  814. }
  815. static void __exit ieee80211_exit(void)
  816. {
  817. rc80211_pid_exit();
  818. rc80211_minstrel_ht_exit();
  819. rc80211_minstrel_exit();
  820. if (mesh_allocated)
  821. ieee80211s_stop();
  822. ieee80211_iface_exit();
  823. }
  824. subsys_initcall(ieee80211_init);
  825. module_exit(ieee80211_exit);
  826. MODULE_DESCRIPTION("IEEE 802.11 subsystem");
  827. MODULE_LICENSE("GPL");