core.c 26 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082
  1. /*
  2. * This is the linux wireless configuration interface.
  3. *
  4. * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
  5. */
  6. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  7. #include <linux/if.h>
  8. #include <linux/module.h>
  9. #include <linux/err.h>
  10. #include <linux/list.h>
  11. #include <linux/slab.h>
  12. #include <linux/nl80211.h>
  13. #include <linux/debugfs.h>
  14. #include <linux/notifier.h>
  15. #include <linux/device.h>
  16. #include <linux/etherdevice.h>
  17. #include <linux/rtnetlink.h>
  18. #include <linux/sched.h>
  19. #include <net/genetlink.h>
  20. #include <net/cfg80211.h>
  21. #include "nl80211.h"
  22. #include "core.h"
  23. #include "sysfs.h"
  24. #include "debugfs.h"
  25. #include "wext-compat.h"
  26. #include "ethtool.h"
  27. /* name for sysfs, %d is appended */
  28. #define PHY_NAME "phy"
  29. MODULE_AUTHOR("Johannes Berg");
  30. MODULE_LICENSE("GPL");
  31. MODULE_DESCRIPTION("wireless configuration support");
  32. /* RCU-protected (and cfg80211_mutex for writers) */
  33. LIST_HEAD(cfg80211_rdev_list);
  34. int cfg80211_rdev_list_generation;
  35. DEFINE_MUTEX(cfg80211_mutex);
  36. /* for debugfs */
  37. static struct dentry *ieee80211_debugfs_dir;
  38. /* for the cleanup, scan and event works */
  39. struct workqueue_struct *cfg80211_wq;
  40. static bool cfg80211_disable_40mhz_24ghz;
  41. module_param(cfg80211_disable_40mhz_24ghz, bool, 0644);
  42. MODULE_PARM_DESC(cfg80211_disable_40mhz_24ghz,
  43. "Disable 40MHz support in the 2.4GHz band");
  44. /* requires cfg80211_mutex to be held! */
  45. struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
  46. {
  47. struct cfg80211_registered_device *result = NULL, *rdev;
  48. if (!wiphy_idx_valid(wiphy_idx))
  49. return NULL;
  50. assert_cfg80211_lock();
  51. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  52. if (rdev->wiphy_idx == wiphy_idx) {
  53. result = rdev;
  54. break;
  55. }
  56. }
  57. return result;
  58. }
  59. int get_wiphy_idx(struct wiphy *wiphy)
  60. {
  61. struct cfg80211_registered_device *rdev;
  62. if (!wiphy)
  63. return WIPHY_IDX_STALE;
  64. rdev = wiphy_to_dev(wiphy);
  65. return rdev->wiphy_idx;
  66. }
  67. /* requires cfg80211_rdev_mutex to be held! */
  68. struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
  69. {
  70. struct cfg80211_registered_device *rdev;
  71. if (!wiphy_idx_valid(wiphy_idx))
  72. return NULL;
  73. assert_cfg80211_lock();
  74. rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
  75. if (!rdev)
  76. return NULL;
  77. return &rdev->wiphy;
  78. }
  79. /* requires cfg80211_mutex to be held! */
  80. struct cfg80211_registered_device *
  81. __cfg80211_rdev_from_info(struct genl_info *info)
  82. {
  83. int ifindex;
  84. struct cfg80211_registered_device *bywiphyidx = NULL, *byifidx = NULL;
  85. struct net_device *dev;
  86. int err = -EINVAL;
  87. assert_cfg80211_lock();
  88. if (info->attrs[NL80211_ATTR_WIPHY]) {
  89. bywiphyidx = cfg80211_rdev_by_wiphy_idx(
  90. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY]));
  91. err = -ENODEV;
  92. }
  93. if (info->attrs[NL80211_ATTR_IFINDEX]) {
  94. ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
  95. dev = dev_get_by_index(genl_info_net(info), ifindex);
  96. if (dev) {
  97. if (dev->ieee80211_ptr)
  98. byifidx =
  99. wiphy_to_dev(dev->ieee80211_ptr->wiphy);
  100. dev_put(dev);
  101. }
  102. err = -ENODEV;
  103. }
  104. if (bywiphyidx && byifidx) {
  105. if (bywiphyidx != byifidx)
  106. return ERR_PTR(-EINVAL);
  107. else
  108. return bywiphyidx; /* == byifidx */
  109. }
  110. if (bywiphyidx)
  111. return bywiphyidx;
  112. if (byifidx)
  113. return byifidx;
  114. return ERR_PTR(err);
  115. }
  116. struct cfg80211_registered_device *
  117. cfg80211_get_dev_from_info(struct genl_info *info)
  118. {
  119. struct cfg80211_registered_device *rdev;
  120. mutex_lock(&cfg80211_mutex);
  121. rdev = __cfg80211_rdev_from_info(info);
  122. /* if it is not an error we grab the lock on
  123. * it to assure it won't be going away while
  124. * we operate on it */
  125. if (!IS_ERR(rdev))
  126. mutex_lock(&rdev->mtx);
  127. mutex_unlock(&cfg80211_mutex);
  128. return rdev;
  129. }
  130. struct cfg80211_registered_device *
  131. cfg80211_get_dev_from_ifindex(struct net *net, int ifindex)
  132. {
  133. struct cfg80211_registered_device *rdev = ERR_PTR(-ENODEV);
  134. struct net_device *dev;
  135. mutex_lock(&cfg80211_mutex);
  136. dev = dev_get_by_index(net, ifindex);
  137. if (!dev)
  138. goto out;
  139. if (dev->ieee80211_ptr) {
  140. rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
  141. mutex_lock(&rdev->mtx);
  142. } else
  143. rdev = ERR_PTR(-ENODEV);
  144. dev_put(dev);
  145. out:
  146. mutex_unlock(&cfg80211_mutex);
  147. return rdev;
  148. }
  149. /* requires cfg80211_mutex to be held */
  150. int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
  151. char *newname)
  152. {
  153. struct cfg80211_registered_device *rdev2;
  154. int wiphy_idx, taken = -1, result, digits;
  155. assert_cfg80211_lock();
  156. /* prohibit calling the thing phy%d when %d is not its number */
  157. sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
  158. if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
  159. /* count number of places needed to print wiphy_idx */
  160. digits = 1;
  161. while (wiphy_idx /= 10)
  162. digits++;
  163. /*
  164. * deny the name if it is phy<idx> where <idx> is printed
  165. * without leading zeroes. taken == strlen(newname) here
  166. */
  167. if (taken == strlen(PHY_NAME) + digits)
  168. return -EINVAL;
  169. }
  170. /* Ignore nop renames */
  171. if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
  172. return 0;
  173. /* Ensure another device does not already have this name. */
  174. list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
  175. if (strcmp(newname, dev_name(&rdev2->wiphy.dev)) == 0)
  176. return -EINVAL;
  177. result = device_rename(&rdev->wiphy.dev, newname);
  178. if (result)
  179. return result;
  180. if (rdev->wiphy.debugfsdir &&
  181. !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
  182. rdev->wiphy.debugfsdir,
  183. rdev->wiphy.debugfsdir->d_parent,
  184. newname))
  185. pr_err("failed to rename debugfs dir to %s!\n", newname);
  186. nl80211_notify_dev_rename(rdev);
  187. return 0;
  188. }
  189. int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
  190. struct net *net)
  191. {
  192. struct wireless_dev *wdev;
  193. int err = 0;
  194. if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
  195. return -EOPNOTSUPP;
  196. list_for_each_entry(wdev, &rdev->netdev_list, list) {
  197. wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
  198. err = dev_change_net_namespace(wdev->netdev, net, "wlan%d");
  199. if (err)
  200. break;
  201. wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
  202. }
  203. if (err) {
  204. /* failed -- clean up to old netns */
  205. net = wiphy_net(&rdev->wiphy);
  206. list_for_each_entry_continue_reverse(wdev, &rdev->netdev_list,
  207. list) {
  208. wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
  209. err = dev_change_net_namespace(wdev->netdev, net,
  210. "wlan%d");
  211. WARN_ON(err);
  212. wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
  213. }
  214. return err;
  215. }
  216. wiphy_net_set(&rdev->wiphy, net);
  217. err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
  218. WARN_ON(err);
  219. return 0;
  220. }
  221. static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
  222. {
  223. struct cfg80211_registered_device *rdev = data;
  224. rdev->ops->rfkill_poll(&rdev->wiphy);
  225. }
  226. static int cfg80211_rfkill_set_block(void *data, bool blocked)
  227. {
  228. struct cfg80211_registered_device *rdev = data;
  229. struct wireless_dev *wdev;
  230. if (!blocked)
  231. return 0;
  232. rtnl_lock();
  233. mutex_lock(&rdev->devlist_mtx);
  234. list_for_each_entry(wdev, &rdev->netdev_list, list)
  235. dev_close(wdev->netdev);
  236. mutex_unlock(&rdev->devlist_mtx);
  237. rtnl_unlock();
  238. return 0;
  239. }
  240. static void cfg80211_rfkill_sync_work(struct work_struct *work)
  241. {
  242. struct cfg80211_registered_device *rdev;
  243. rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
  244. cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
  245. }
  246. static void cfg80211_event_work(struct work_struct *work)
  247. {
  248. struct cfg80211_registered_device *rdev;
  249. rdev = container_of(work, struct cfg80211_registered_device,
  250. event_work);
  251. rtnl_lock();
  252. cfg80211_lock_rdev(rdev);
  253. cfg80211_process_rdev_events(rdev);
  254. cfg80211_unlock_rdev(rdev);
  255. rtnl_unlock();
  256. }
  257. /* exported functions */
  258. struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
  259. {
  260. static int wiphy_counter;
  261. struct cfg80211_registered_device *rdev;
  262. int alloc_size;
  263. WARN_ON(ops->add_key && (!ops->del_key || !ops->set_default_key));
  264. WARN_ON(ops->auth && (!ops->assoc || !ops->deauth || !ops->disassoc));
  265. WARN_ON(ops->connect && !ops->disconnect);
  266. WARN_ON(ops->join_ibss && !ops->leave_ibss);
  267. WARN_ON(ops->add_virtual_intf && !ops->del_virtual_intf);
  268. WARN_ON(ops->add_station && !ops->del_station);
  269. WARN_ON(ops->add_mpath && !ops->del_mpath);
  270. WARN_ON(ops->join_mesh && !ops->leave_mesh);
  271. alloc_size = sizeof(*rdev) + sizeof_priv;
  272. rdev = kzalloc(alloc_size, GFP_KERNEL);
  273. if (!rdev)
  274. return NULL;
  275. rdev->ops = ops;
  276. mutex_lock(&cfg80211_mutex);
  277. rdev->wiphy_idx = wiphy_counter++;
  278. if (unlikely(!wiphy_idx_valid(rdev->wiphy_idx))) {
  279. wiphy_counter--;
  280. mutex_unlock(&cfg80211_mutex);
  281. /* ugh, wrapped! */
  282. kfree(rdev);
  283. return NULL;
  284. }
  285. mutex_unlock(&cfg80211_mutex);
  286. /* give it a proper name */
  287. dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);
  288. mutex_init(&rdev->mtx);
  289. mutex_init(&rdev->devlist_mtx);
  290. mutex_init(&rdev->sched_scan_mtx);
  291. INIT_LIST_HEAD(&rdev->netdev_list);
  292. spin_lock_init(&rdev->bss_lock);
  293. INIT_LIST_HEAD(&rdev->bss_list);
  294. INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
  295. INIT_WORK(&rdev->sched_scan_results_wk, __cfg80211_sched_scan_results);
  296. #ifdef CONFIG_CFG80211_WEXT
  297. rdev->wiphy.wext = &cfg80211_wext_handler;
  298. #endif
  299. device_initialize(&rdev->wiphy.dev);
  300. rdev->wiphy.dev.class = &ieee80211_class;
  301. rdev->wiphy.dev.platform_data = rdev;
  302. #ifdef CONFIG_CFG80211_DEFAULT_PS
  303. rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
  304. #endif
  305. wiphy_net_set(&rdev->wiphy, &init_net);
  306. rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
  307. rdev->rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
  308. &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
  309. &rdev->rfkill_ops, rdev);
  310. if (!rdev->rfkill) {
  311. kfree(rdev);
  312. return NULL;
  313. }
  314. INIT_WORK(&rdev->rfkill_sync, cfg80211_rfkill_sync_work);
  315. INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
  316. INIT_WORK(&rdev->event_work, cfg80211_event_work);
  317. init_waitqueue_head(&rdev->dev_wait);
  318. /*
  319. * Initialize wiphy parameters to IEEE 802.11 MIB default values.
  320. * Fragmentation and RTS threshold are disabled by default with the
  321. * special -1 value.
  322. */
  323. rdev->wiphy.retry_short = 7;
  324. rdev->wiphy.retry_long = 4;
  325. rdev->wiphy.frag_threshold = (u32) -1;
  326. rdev->wiphy.rts_threshold = (u32) -1;
  327. rdev->wiphy.coverage_class = 0;
  328. return &rdev->wiphy;
  329. }
  330. EXPORT_SYMBOL(wiphy_new);
  331. static int wiphy_verify_combinations(struct wiphy *wiphy)
  332. {
  333. const struct ieee80211_iface_combination *c;
  334. int i, j;
  335. /* If we have combinations enforce them */
  336. if (wiphy->n_iface_combinations)
  337. wiphy->flags |= WIPHY_FLAG_ENFORCE_COMBINATIONS;
  338. for (i = 0; i < wiphy->n_iface_combinations; i++) {
  339. u32 cnt = 0;
  340. u16 all_iftypes = 0;
  341. c = &wiphy->iface_combinations[i];
  342. /* Combinations with just one interface aren't real */
  343. if (WARN_ON(c->max_interfaces < 2))
  344. return -EINVAL;
  345. /* Need at least one channel */
  346. if (WARN_ON(!c->num_different_channels))
  347. return -EINVAL;
  348. if (WARN_ON(!c->n_limits))
  349. return -EINVAL;
  350. for (j = 0; j < c->n_limits; j++) {
  351. u16 types = c->limits[j].types;
  352. /*
  353. * interface types shouldn't overlap, this is
  354. * used in cfg80211_can_change_interface()
  355. */
  356. if (WARN_ON(types & all_iftypes))
  357. return -EINVAL;
  358. all_iftypes |= types;
  359. if (WARN_ON(!c->limits[j].max))
  360. return -EINVAL;
  361. /* Shouldn't list software iftypes in combinations! */
  362. if (WARN_ON(wiphy->software_iftypes & types))
  363. return -EINVAL;
  364. cnt += c->limits[j].max;
  365. /*
  366. * Don't advertise an unsupported type
  367. * in a combination.
  368. */
  369. if (WARN_ON((wiphy->interface_modes & types) != types))
  370. return -EINVAL;
  371. }
  372. /* You can't even choose that many! */
  373. if (WARN_ON(cnt < c->max_interfaces))
  374. return -EINVAL;
  375. }
  376. return 0;
  377. }
  378. int wiphy_register(struct wiphy *wiphy)
  379. {
  380. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  381. int res;
  382. enum ieee80211_band band;
  383. struct ieee80211_supported_band *sband;
  384. bool have_band = false;
  385. int i;
  386. u16 ifmodes = wiphy->interface_modes;
  387. if (WARN_ON((wiphy->wowlan.flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
  388. !(wiphy->wowlan.flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
  389. return -EINVAL;
  390. if (WARN_ON(wiphy->ap_sme_capa &&
  391. !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
  392. return -EINVAL;
  393. if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
  394. return -EINVAL;
  395. if (WARN_ON(wiphy->addresses &&
  396. !is_zero_ether_addr(wiphy->perm_addr) &&
  397. memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
  398. ETH_ALEN)))
  399. return -EINVAL;
  400. if (WARN_ON(wiphy->max_acl_mac_addrs &&
  401. (!(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME) ||
  402. !rdev->ops->set_mac_acl)))
  403. return -EINVAL;
  404. if (wiphy->addresses)
  405. memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
  406. /* sanity check ifmodes */
  407. WARN_ON(!ifmodes);
  408. ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
  409. if (WARN_ON(ifmodes != wiphy->interface_modes))
  410. wiphy->interface_modes = ifmodes;
  411. res = wiphy_verify_combinations(wiphy);
  412. if (res)
  413. return res;
  414. /* sanity check supported bands/channels */
  415. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  416. sband = wiphy->bands[band];
  417. if (!sband)
  418. continue;
  419. sband->band = band;
  420. if (WARN_ON(!sband->n_channels || !sband->n_bitrates))
  421. return -EINVAL;
  422. /*
  423. * Since cfg80211_disable_40mhz_24ghz is global, we can
  424. * modify the sband's ht data even if the driver uses a
  425. * global structure for that.
  426. */
  427. if (cfg80211_disable_40mhz_24ghz &&
  428. band == IEEE80211_BAND_2GHZ &&
  429. sband->ht_cap.ht_supported) {
  430. sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
  431. sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
  432. }
  433. /*
  434. * Since we use a u32 for rate bitmaps in
  435. * ieee80211_get_response_rate, we cannot
  436. * have more than 32 legacy rates.
  437. */
  438. if (WARN_ON(sband->n_bitrates > 32))
  439. return -EINVAL;
  440. for (i = 0; i < sband->n_channels; i++) {
  441. sband->channels[i].orig_flags =
  442. sband->channels[i].flags;
  443. sband->channels[i].orig_mag = INT_MAX;
  444. sband->channels[i].orig_mpwr =
  445. sband->channels[i].max_power;
  446. sband->channels[i].band = band;
  447. }
  448. have_band = true;
  449. }
  450. if (!have_band) {
  451. WARN_ON(1);
  452. return -EINVAL;
  453. }
  454. if (rdev->wiphy.wowlan.n_patterns) {
  455. if (WARN_ON(!rdev->wiphy.wowlan.pattern_min_len ||
  456. rdev->wiphy.wowlan.pattern_min_len >
  457. rdev->wiphy.wowlan.pattern_max_len))
  458. return -EINVAL;
  459. }
  460. /* check and set up bitrates */
  461. ieee80211_set_bitrate_flags(wiphy);
  462. mutex_lock(&cfg80211_mutex);
  463. res = device_add(&rdev->wiphy.dev);
  464. if (res) {
  465. mutex_unlock(&cfg80211_mutex);
  466. return res;
  467. }
  468. /* set up regulatory info */
  469. regulatory_update(wiphy, NL80211_REGDOM_SET_BY_CORE);
  470. list_add_rcu(&rdev->list, &cfg80211_rdev_list);
  471. cfg80211_rdev_list_generation++;
  472. /* add to debugfs */
  473. rdev->wiphy.debugfsdir =
  474. debugfs_create_dir(wiphy_name(&rdev->wiphy),
  475. ieee80211_debugfs_dir);
  476. if (IS_ERR(rdev->wiphy.debugfsdir))
  477. rdev->wiphy.debugfsdir = NULL;
  478. if (wiphy->flags & WIPHY_FLAG_CUSTOM_REGULATORY) {
  479. struct regulatory_request request;
  480. request.wiphy_idx = get_wiphy_idx(wiphy);
  481. request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
  482. request.alpha2[0] = '9';
  483. request.alpha2[1] = '9';
  484. nl80211_send_reg_change_event(&request);
  485. }
  486. cfg80211_debugfs_rdev_add(rdev);
  487. mutex_unlock(&cfg80211_mutex);
  488. /*
  489. * due to a locking dependency this has to be outside of the
  490. * cfg80211_mutex lock
  491. */
  492. res = rfkill_register(rdev->rfkill);
  493. if (res)
  494. goto out_rm_dev;
  495. rtnl_lock();
  496. rdev->wiphy.registered = true;
  497. rtnl_unlock();
  498. return 0;
  499. out_rm_dev:
  500. device_del(&rdev->wiphy.dev);
  501. return res;
  502. }
  503. EXPORT_SYMBOL(wiphy_register);
  504. void wiphy_rfkill_start_polling(struct wiphy *wiphy)
  505. {
  506. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  507. if (!rdev->ops->rfkill_poll)
  508. return;
  509. rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
  510. rfkill_resume_polling(rdev->rfkill);
  511. }
  512. EXPORT_SYMBOL(wiphy_rfkill_start_polling);
  513. void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
  514. {
  515. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  516. rfkill_pause_polling(rdev->rfkill);
  517. }
  518. EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
  519. void wiphy_unregister(struct wiphy *wiphy)
  520. {
  521. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  522. rtnl_lock();
  523. rdev->wiphy.registered = false;
  524. rtnl_unlock();
  525. rfkill_unregister(rdev->rfkill);
  526. /* protect the device list */
  527. mutex_lock(&cfg80211_mutex);
  528. wait_event(rdev->dev_wait, ({
  529. int __count;
  530. mutex_lock(&rdev->devlist_mtx);
  531. __count = rdev->opencount;
  532. mutex_unlock(&rdev->devlist_mtx);
  533. __count == 0;}));
  534. mutex_lock(&rdev->devlist_mtx);
  535. BUG_ON(!list_empty(&rdev->netdev_list));
  536. mutex_unlock(&rdev->devlist_mtx);
  537. /*
  538. * First remove the hardware from everywhere, this makes
  539. * it impossible to find from userspace.
  540. */
  541. debugfs_remove_recursive(rdev->wiphy.debugfsdir);
  542. list_del_rcu(&rdev->list);
  543. synchronize_rcu();
  544. /*
  545. * Try to grab rdev->mtx. If a command is still in progress,
  546. * hopefully the driver will refuse it since it's tearing
  547. * down the device already. We wait for this command to complete
  548. * before unlinking the item from the list.
  549. * Note: as codified by the BUG_ON above we cannot get here if
  550. * a virtual interface is still present. Hence, we can only get
  551. * to lock contention here if userspace issues a command that
  552. * identified the hardware by wiphy index.
  553. */
  554. cfg80211_lock_rdev(rdev);
  555. /* nothing */
  556. cfg80211_unlock_rdev(rdev);
  557. /* If this device got a regulatory hint tell core its
  558. * free to listen now to a new shiny device regulatory hint */
  559. reg_device_remove(wiphy);
  560. cfg80211_rdev_list_generation++;
  561. device_del(&rdev->wiphy.dev);
  562. mutex_unlock(&cfg80211_mutex);
  563. flush_work(&rdev->scan_done_wk);
  564. cancel_work_sync(&rdev->conn_work);
  565. flush_work(&rdev->event_work);
  566. }
  567. EXPORT_SYMBOL(wiphy_unregister);
  568. void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
  569. {
  570. struct cfg80211_internal_bss *scan, *tmp;
  571. rfkill_destroy(rdev->rfkill);
  572. mutex_destroy(&rdev->mtx);
  573. mutex_destroy(&rdev->devlist_mtx);
  574. mutex_destroy(&rdev->sched_scan_mtx);
  575. list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
  576. cfg80211_put_bss(&scan->pub);
  577. cfg80211_rdev_free_wowlan(rdev);
  578. kfree(rdev);
  579. }
  580. void wiphy_free(struct wiphy *wiphy)
  581. {
  582. put_device(&wiphy->dev);
  583. }
  584. EXPORT_SYMBOL(wiphy_free);
  585. void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
  586. {
  587. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  588. if (rfkill_set_hw_state(rdev->rfkill, blocked))
  589. schedule_work(&rdev->rfkill_sync);
  590. }
  591. EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
  592. static void wdev_cleanup_work(struct work_struct *work)
  593. {
  594. struct wireless_dev *wdev;
  595. struct cfg80211_registered_device *rdev;
  596. wdev = container_of(work, struct wireless_dev, cleanup_work);
  597. rdev = wiphy_to_dev(wdev->wiphy);
  598. cfg80211_lock_rdev(rdev);
  599. if (WARN_ON(rdev->scan_req && rdev->scan_req->dev == wdev->netdev)) {
  600. rdev->scan_req->aborted = true;
  601. ___cfg80211_scan_done(rdev, true);
  602. }
  603. cfg80211_unlock_rdev(rdev);
  604. mutex_lock(&rdev->sched_scan_mtx);
  605. if (WARN_ON(rdev->sched_scan_req &&
  606. rdev->sched_scan_req->dev == wdev->netdev)) {
  607. __cfg80211_stop_sched_scan(rdev, false);
  608. }
  609. mutex_unlock(&rdev->sched_scan_mtx);
  610. mutex_lock(&rdev->devlist_mtx);
  611. rdev->opencount--;
  612. mutex_unlock(&rdev->devlist_mtx);
  613. wake_up(&rdev->dev_wait);
  614. dev_put(wdev->netdev);
  615. }
  616. static struct device_type wiphy_type = {
  617. .name = "wlan",
  618. };
  619. static int cfg80211_netdev_notifier_call(struct notifier_block * nb,
  620. unsigned long state,
  621. void *ndev)
  622. {
  623. struct net_device *dev = ndev;
  624. struct wireless_dev *wdev = dev->ieee80211_ptr;
  625. struct cfg80211_registered_device *rdev;
  626. int ret;
  627. if (!wdev)
  628. return NOTIFY_DONE;
  629. rdev = wiphy_to_dev(wdev->wiphy);
  630. WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
  631. switch (state) {
  632. case NETDEV_POST_INIT:
  633. SET_NETDEV_DEVTYPE(dev, &wiphy_type);
  634. break;
  635. case NETDEV_REGISTER:
  636. /*
  637. * NB: cannot take rdev->mtx here because this may be
  638. * called within code protected by it when interfaces
  639. * are added with nl80211.
  640. */
  641. mutex_init(&wdev->mtx);
  642. INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
  643. INIT_LIST_HEAD(&wdev->event_list);
  644. spin_lock_init(&wdev->event_lock);
  645. INIT_LIST_HEAD(&wdev->mgmt_registrations);
  646. spin_lock_init(&wdev->mgmt_registrations_lock);
  647. mutex_lock(&rdev->devlist_mtx);
  648. list_add_rcu(&wdev->list, &rdev->netdev_list);
  649. rdev->devlist_generation++;
  650. /* can only change netns with wiphy */
  651. dev->features |= NETIF_F_NETNS_LOCAL;
  652. if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
  653. "phy80211")) {
  654. pr_err("failed to add phy80211 symlink to netdev!\n");
  655. }
  656. wdev->netdev = dev;
  657. wdev->sme_state = CFG80211_SME_IDLE;
  658. mutex_unlock(&rdev->devlist_mtx);
  659. #ifdef CONFIG_CFG80211_WEXT
  660. wdev->wext.default_key = -1;
  661. wdev->wext.default_mgmt_key = -1;
  662. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  663. #endif
  664. if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
  665. wdev->ps = true;
  666. else
  667. wdev->ps = false;
  668. /* allow mac80211 to determine the timeout */
  669. wdev->ps_timeout = -1;
  670. if (!dev->ethtool_ops)
  671. dev->ethtool_ops = &cfg80211_ethtool_ops;
  672. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  673. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
  674. wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
  675. dev->priv_flags |= IFF_DONT_BRIDGE;
  676. break;
  677. case NETDEV_GOING_DOWN:
  678. switch (wdev->iftype) {
  679. case NL80211_IFTYPE_ADHOC:
  680. cfg80211_leave_ibss(rdev, dev, true);
  681. break;
  682. case NL80211_IFTYPE_P2P_CLIENT:
  683. case NL80211_IFTYPE_STATION:
  684. mutex_lock(&rdev->sched_scan_mtx);
  685. __cfg80211_stop_sched_scan(rdev, false);
  686. mutex_unlock(&rdev->sched_scan_mtx);
  687. wdev_lock(wdev);
  688. #ifdef CONFIG_CFG80211_WEXT
  689. kfree(wdev->wext.ie);
  690. wdev->wext.ie = NULL;
  691. wdev->wext.ie_len = 0;
  692. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  693. #endif
  694. __cfg80211_disconnect(rdev, dev,
  695. WLAN_REASON_DEAUTH_LEAVING, true);
  696. cfg80211_mlme_down(rdev, dev);
  697. wdev_unlock(wdev);
  698. break;
  699. case NL80211_IFTYPE_MESH_POINT:
  700. cfg80211_leave_mesh(rdev, dev);
  701. break;
  702. default:
  703. break;
  704. }
  705. wdev->beacon_interval = 0;
  706. break;
  707. case NETDEV_DOWN:
  708. dev_hold(dev);
  709. queue_work(cfg80211_wq, &wdev->cleanup_work);
  710. break;
  711. case NETDEV_UP:
  712. /*
  713. * If we have a really quick DOWN/UP succession we may
  714. * have this work still pending ... cancel it and see
  715. * if it was pending, in which case we need to account
  716. * for some of the work it would have done.
  717. */
  718. if (cancel_work_sync(&wdev->cleanup_work)) {
  719. mutex_lock(&rdev->devlist_mtx);
  720. rdev->opencount--;
  721. mutex_unlock(&rdev->devlist_mtx);
  722. dev_put(dev);
  723. }
  724. cfg80211_lock_rdev(rdev);
  725. mutex_lock(&rdev->devlist_mtx);
  726. wdev_lock(wdev);
  727. switch (wdev->iftype) {
  728. #ifdef CONFIG_CFG80211_WEXT
  729. case NL80211_IFTYPE_ADHOC:
  730. cfg80211_ibss_wext_join(rdev, wdev);
  731. break;
  732. case NL80211_IFTYPE_STATION:
  733. cfg80211_mgd_wext_connect(rdev, wdev);
  734. break;
  735. #endif
  736. #ifdef CONFIG_MAC80211_MESH
  737. case NL80211_IFTYPE_MESH_POINT:
  738. {
  739. /* backward compat code... */
  740. struct mesh_setup setup;
  741. memcpy(&setup, &default_mesh_setup,
  742. sizeof(setup));
  743. /* back compat only needed for mesh_id */
  744. setup.mesh_id = wdev->ssid;
  745. setup.mesh_id_len = wdev->mesh_id_up_len;
  746. if (wdev->mesh_id_up_len)
  747. __cfg80211_join_mesh(rdev, dev,
  748. &setup,
  749. &default_mesh_config);
  750. break;
  751. }
  752. #endif
  753. default:
  754. break;
  755. }
  756. wdev_unlock(wdev);
  757. rdev->opencount++;
  758. mutex_unlock(&rdev->devlist_mtx);
  759. cfg80211_unlock_rdev(rdev);
  760. /*
  761. * Configure power management to the driver here so that its
  762. * correctly set also after interface type changes etc.
  763. */
  764. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  765. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
  766. rdev->ops->set_power_mgmt)
  767. if (rdev->ops->set_power_mgmt(wdev->wiphy, dev,
  768. wdev->ps,
  769. wdev->ps_timeout)) {
  770. /* assume this means it's off */
  771. wdev->ps = false;
  772. }
  773. break;
  774. case NETDEV_UNREGISTER:
  775. /*
  776. * NB: cannot take rdev->mtx here because this may be
  777. * called within code protected by it when interfaces
  778. * are removed with nl80211.
  779. */
  780. mutex_lock(&rdev->devlist_mtx);
  781. /*
  782. * It is possible to get NETDEV_UNREGISTER
  783. * multiple times. To detect that, check
  784. * that the interface is still on the list
  785. * of registered interfaces, and only then
  786. * remove and clean it up.
  787. */
  788. if (!list_empty(&wdev->list)) {
  789. sysfs_remove_link(&dev->dev.kobj, "phy80211");
  790. list_del_rcu(&wdev->list);
  791. rdev->devlist_generation++;
  792. cfg80211_mlme_purge_registrations(wdev);
  793. #ifdef CONFIG_CFG80211_WEXT
  794. kfree(wdev->wext.keys);
  795. #endif
  796. }
  797. mutex_unlock(&rdev->devlist_mtx);
  798. /*
  799. * synchronise (so that we won't find this netdev
  800. * from other code any more) and then clear the list
  801. * head so that the above code can safely check for
  802. * !list_empty() to avoid double-cleanup.
  803. */
  804. synchronize_rcu();
  805. INIT_LIST_HEAD(&wdev->list);
  806. /*
  807. * Ensure that all events have been processed and
  808. * freed.
  809. */
  810. cfg80211_process_wdev_events(wdev);
  811. break;
  812. case NETDEV_PRE_UP:
  813. if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
  814. return notifier_from_errno(-EOPNOTSUPP);
  815. if (rfkill_blocked(rdev->rfkill))
  816. return notifier_from_errno(-ERFKILL);
  817. ret = cfg80211_can_add_interface(rdev, wdev->iftype);
  818. if (ret)
  819. return notifier_from_errno(ret);
  820. break;
  821. }
  822. return NOTIFY_DONE;
  823. }
  824. static struct notifier_block cfg80211_netdev_notifier = {
  825. .notifier_call = cfg80211_netdev_notifier_call,
  826. };
  827. static void __net_exit cfg80211_pernet_exit(struct net *net)
  828. {
  829. struct cfg80211_registered_device *rdev;
  830. rtnl_lock();
  831. mutex_lock(&cfg80211_mutex);
  832. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  833. if (net_eq(wiphy_net(&rdev->wiphy), net))
  834. WARN_ON(cfg80211_switch_netns(rdev, &init_net));
  835. }
  836. mutex_unlock(&cfg80211_mutex);
  837. rtnl_unlock();
  838. }
  839. static struct pernet_operations cfg80211_pernet_ops = {
  840. .exit = cfg80211_pernet_exit,
  841. };
  842. static int __init cfg80211_init(void)
  843. {
  844. int err;
  845. err = register_pernet_device(&cfg80211_pernet_ops);
  846. if (err)
  847. goto out_fail_pernet;
  848. err = wiphy_sysfs_init();
  849. if (err)
  850. goto out_fail_sysfs;
  851. err = register_netdevice_notifier(&cfg80211_netdev_notifier);
  852. if (err)
  853. goto out_fail_notifier;
  854. err = nl80211_init();
  855. if (err)
  856. goto out_fail_nl80211;
  857. ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
  858. err = regulatory_init();
  859. if (err)
  860. goto out_fail_reg;
  861. cfg80211_wq = create_singlethread_workqueue("cfg80211");
  862. if (!cfg80211_wq)
  863. goto out_fail_wq;
  864. return 0;
  865. out_fail_wq:
  866. regulatory_exit();
  867. out_fail_reg:
  868. debugfs_remove(ieee80211_debugfs_dir);
  869. out_fail_nl80211:
  870. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  871. out_fail_notifier:
  872. wiphy_sysfs_exit();
  873. out_fail_sysfs:
  874. unregister_pernet_device(&cfg80211_pernet_ops);
  875. out_fail_pernet:
  876. return err;
  877. }
  878. subsys_initcall(cfg80211_init);
  879. static void __exit cfg80211_exit(void)
  880. {
  881. debugfs_remove(ieee80211_debugfs_dir);
  882. nl80211_exit();
  883. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  884. wiphy_sysfs_exit();
  885. regulatory_exit();
  886. unregister_pernet_device(&cfg80211_pernet_ops);
  887. destroy_workqueue(cfg80211_wq);
  888. }
  889. module_exit(cfg80211_exit);