ibss.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Some IBSS support code for cfg80211.
  4. *
  5. * Copyright 2009 Johannes Berg <johannes@sipsolutions.net>
  6. */
  7. #include <linux/etherdevice.h>
  8. #include <linux/if_arp.h>
  9. #include <linux/slab.h>
  10. #include <linux/export.h>
  11. #include <net/cfg80211.h>
  12. #include "wext-compat.h"
  13. #include "nl80211.h"
  14. #include "rdev-ops.h"
  15. void __cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid,
  16. struct ieee80211_channel *channel)
  17. {
  18. struct wireless_dev *wdev = dev->ieee80211_ptr;
  19. struct cfg80211_bss *bss;
  20. #ifdef CONFIG_CFG80211_WEXT
  21. union iwreq_data wrqu;
  22. #endif
  23. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
  24. return;
  25. if (!wdev->ssid_len)
  26. return;
  27. bss = cfg80211_get_bss(wdev->wiphy, channel, bssid, NULL, 0,
  28. IEEE80211_BSS_TYPE_IBSS, IEEE80211_PRIVACY_ANY);
  29. if (WARN_ON(!bss))
  30. return;
  31. if (wdev->current_bss) {
  32. cfg80211_unhold_bss(wdev->current_bss);
  33. cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
  34. }
  35. cfg80211_hold_bss(bss_from_pub(bss));
  36. wdev->current_bss = bss_from_pub(bss);
  37. if (!(wdev->wiphy->flags & WIPHY_FLAG_HAS_STATIC_WEP))
  38. cfg80211_upload_connect_keys(wdev);
  39. nl80211_send_ibss_bssid(wiphy_to_rdev(wdev->wiphy), dev, bssid,
  40. GFP_KERNEL);
  41. #ifdef CONFIG_CFG80211_WEXT
  42. memset(&wrqu, 0, sizeof(wrqu));
  43. memcpy(wrqu.ap_addr.sa_data, bssid, ETH_ALEN);
  44. wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
  45. #endif
  46. }
  47. void cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid,
  48. struct ieee80211_channel *channel, gfp_t gfp)
  49. {
  50. struct wireless_dev *wdev = dev->ieee80211_ptr;
  51. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  52. struct cfg80211_event *ev;
  53. unsigned long flags;
  54. trace_cfg80211_ibss_joined(dev, bssid, channel);
  55. if (WARN_ON(!channel))
  56. return;
  57. ev = kzalloc(sizeof(*ev), gfp);
  58. if (!ev)
  59. return;
  60. ev->type = EVENT_IBSS_JOINED;
  61. memcpy(ev->ij.bssid, bssid, ETH_ALEN);
  62. ev->ij.channel = channel;
  63. spin_lock_irqsave(&wdev->event_lock, flags);
  64. list_add_tail(&ev->list, &wdev->event_list);
  65. spin_unlock_irqrestore(&wdev->event_lock, flags);
  66. queue_work(cfg80211_wq, &rdev->event_work);
  67. }
  68. EXPORT_SYMBOL(cfg80211_ibss_joined);
  69. int __cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
  70. struct net_device *dev,
  71. struct cfg80211_ibss_params *params,
  72. struct cfg80211_cached_keys *connkeys)
  73. {
  74. struct wireless_dev *wdev = dev->ieee80211_ptr;
  75. int err;
  76. ASSERT_RTNL();
  77. ASSERT_WDEV_LOCK(wdev);
  78. if (wdev->ssid_len)
  79. return -EALREADY;
  80. if (!params->basic_rates) {
  81. /*
  82. * If no rates were explicitly configured,
  83. * use the mandatory rate set for 11b or
  84. * 11a for maximum compatibility.
  85. */
  86. struct ieee80211_supported_band *sband;
  87. enum nl80211_band band;
  88. u32 flag;
  89. int j;
  90. band = params->chandef.chan->band;
  91. if (band == NL80211_BAND_5GHZ ||
  92. band == NL80211_BAND_6GHZ)
  93. flag = IEEE80211_RATE_MANDATORY_A;
  94. else
  95. flag = IEEE80211_RATE_MANDATORY_B;
  96. sband = rdev->wiphy.bands[band];
  97. for (j = 0; j < sband->n_bitrates; j++) {
  98. if (sband->bitrates[j].flags & flag)
  99. params->basic_rates |= BIT(j);
  100. }
  101. }
  102. if (WARN_ON(connkeys && connkeys->def < 0))
  103. return -EINVAL;
  104. if (WARN_ON(wdev->connect_keys))
  105. kfree_sensitive(wdev->connect_keys);
  106. wdev->connect_keys = connkeys;
  107. wdev->ibss_fixed = params->channel_fixed;
  108. wdev->ibss_dfs_possible = params->userspace_handles_dfs;
  109. wdev->chandef = params->chandef;
  110. if (connkeys) {
  111. params->wep_keys = connkeys->params;
  112. params->wep_tx_key = connkeys->def;
  113. }
  114. #ifdef CONFIG_CFG80211_WEXT
  115. wdev->wext.ibss.chandef = params->chandef;
  116. #endif
  117. err = rdev_join_ibss(rdev, dev, params);
  118. if (err) {
  119. wdev->connect_keys = NULL;
  120. return err;
  121. }
  122. memcpy(wdev->ssid, params->ssid, params->ssid_len);
  123. wdev->ssid_len = params->ssid_len;
  124. return 0;
  125. }
  126. static void __cfg80211_clear_ibss(struct net_device *dev, bool nowext)
  127. {
  128. struct wireless_dev *wdev = dev->ieee80211_ptr;
  129. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  130. int i;
  131. ASSERT_WDEV_LOCK(wdev);
  132. kfree_sensitive(wdev->connect_keys);
  133. wdev->connect_keys = NULL;
  134. rdev_set_qos_map(rdev, dev, NULL);
  135. /*
  136. * Delete all the keys ... pairwise keys can't really
  137. * exist any more anyway, but default keys might.
  138. */
  139. if (rdev->ops->del_key)
  140. for (i = 0; i < 6; i++)
  141. rdev_del_key(rdev, dev, i, false, NULL);
  142. if (wdev->current_bss) {
  143. cfg80211_unhold_bss(wdev->current_bss);
  144. cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
  145. }
  146. wdev->current_bss = NULL;
  147. wdev->ssid_len = 0;
  148. memset(&wdev->chandef, 0, sizeof(wdev->chandef));
  149. #ifdef CONFIG_CFG80211_WEXT
  150. if (!nowext)
  151. wdev->wext.ibss.ssid_len = 0;
  152. #endif
  153. cfg80211_sched_dfs_chan_update(rdev);
  154. }
  155. void cfg80211_clear_ibss(struct net_device *dev, bool nowext)
  156. {
  157. struct wireless_dev *wdev = dev->ieee80211_ptr;
  158. wdev_lock(wdev);
  159. __cfg80211_clear_ibss(dev, nowext);
  160. wdev_unlock(wdev);
  161. }
  162. int __cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
  163. struct net_device *dev, bool nowext)
  164. {
  165. struct wireless_dev *wdev = dev->ieee80211_ptr;
  166. int err;
  167. ASSERT_WDEV_LOCK(wdev);
  168. if (!wdev->ssid_len)
  169. return -ENOLINK;
  170. err = rdev_leave_ibss(rdev, dev);
  171. if (err)
  172. return err;
  173. wdev->conn_owner_nlportid = 0;
  174. __cfg80211_clear_ibss(dev, nowext);
  175. return 0;
  176. }
  177. int cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
  178. struct net_device *dev, bool nowext)
  179. {
  180. struct wireless_dev *wdev = dev->ieee80211_ptr;
  181. int err;
  182. wdev_lock(wdev);
  183. err = __cfg80211_leave_ibss(rdev, dev, nowext);
  184. wdev_unlock(wdev);
  185. return err;
  186. }
  187. #ifdef CONFIG_CFG80211_WEXT
  188. int cfg80211_ibss_wext_join(struct cfg80211_registered_device *rdev,
  189. struct wireless_dev *wdev)
  190. {
  191. struct cfg80211_cached_keys *ck = NULL;
  192. enum nl80211_band band;
  193. int i, err;
  194. ASSERT_WDEV_LOCK(wdev);
  195. if (!wdev->wext.ibss.beacon_interval)
  196. wdev->wext.ibss.beacon_interval = 100;
  197. /* try to find an IBSS channel if none requested ... */
  198. if (!wdev->wext.ibss.chandef.chan) {
  199. struct ieee80211_channel *new_chan = NULL;
  200. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  201. struct ieee80211_supported_band *sband;
  202. struct ieee80211_channel *chan;
  203. sband = rdev->wiphy.bands[band];
  204. if (!sband)
  205. continue;
  206. for (i = 0; i < sband->n_channels; i++) {
  207. chan = &sband->channels[i];
  208. if (chan->flags & IEEE80211_CHAN_NO_IR)
  209. continue;
  210. if (chan->flags & IEEE80211_CHAN_DISABLED)
  211. continue;
  212. new_chan = chan;
  213. break;
  214. }
  215. if (new_chan)
  216. break;
  217. }
  218. if (!new_chan)
  219. return -EINVAL;
  220. cfg80211_chandef_create(&wdev->wext.ibss.chandef, new_chan,
  221. NL80211_CHAN_NO_HT);
  222. }
  223. /* don't join -- SSID is not there */
  224. if (!wdev->wext.ibss.ssid_len)
  225. return 0;
  226. if (!netif_running(wdev->netdev))
  227. return 0;
  228. if (wdev->wext.keys)
  229. wdev->wext.keys->def = wdev->wext.default_key;
  230. wdev->wext.ibss.privacy = wdev->wext.default_key != -1;
  231. if (wdev->wext.keys && wdev->wext.keys->def != -1) {
  232. ck = kmemdup(wdev->wext.keys, sizeof(*ck), GFP_KERNEL);
  233. if (!ck)
  234. return -ENOMEM;
  235. for (i = 0; i < CFG80211_MAX_WEP_KEYS; i++)
  236. ck->params[i].key = ck->data[i];
  237. }
  238. err = __cfg80211_join_ibss(rdev, wdev->netdev,
  239. &wdev->wext.ibss, ck);
  240. if (err)
  241. kfree(ck);
  242. return err;
  243. }
  244. int cfg80211_ibss_wext_siwfreq(struct net_device *dev,
  245. struct iw_request_info *info,
  246. struct iw_freq *wextfreq, char *extra)
  247. {
  248. struct wireless_dev *wdev = dev->ieee80211_ptr;
  249. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  250. struct ieee80211_channel *chan = NULL;
  251. int err, freq;
  252. /* call only for ibss! */
  253. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
  254. return -EINVAL;
  255. if (!rdev->ops->join_ibss)
  256. return -EOPNOTSUPP;
  257. freq = cfg80211_wext_freq(wextfreq);
  258. if (freq < 0)
  259. return freq;
  260. if (freq) {
  261. chan = ieee80211_get_channel(wdev->wiphy, freq);
  262. if (!chan)
  263. return -EINVAL;
  264. if (chan->flags & IEEE80211_CHAN_NO_IR ||
  265. chan->flags & IEEE80211_CHAN_DISABLED)
  266. return -EINVAL;
  267. }
  268. if (wdev->wext.ibss.chandef.chan == chan)
  269. return 0;
  270. wdev_lock(wdev);
  271. err = 0;
  272. if (wdev->ssid_len)
  273. err = __cfg80211_leave_ibss(rdev, dev, true);
  274. wdev_unlock(wdev);
  275. if (err)
  276. return err;
  277. if (chan) {
  278. cfg80211_chandef_create(&wdev->wext.ibss.chandef, chan,
  279. NL80211_CHAN_NO_HT);
  280. wdev->wext.ibss.channel_fixed = true;
  281. } else {
  282. /* cfg80211_ibss_wext_join will pick one if needed */
  283. wdev->wext.ibss.channel_fixed = false;
  284. }
  285. wdev_lock(wdev);
  286. err = cfg80211_ibss_wext_join(rdev, wdev);
  287. wdev_unlock(wdev);
  288. return err;
  289. }
  290. int cfg80211_ibss_wext_giwfreq(struct net_device *dev,
  291. struct iw_request_info *info,
  292. struct iw_freq *freq, char *extra)
  293. {
  294. struct wireless_dev *wdev = dev->ieee80211_ptr;
  295. struct ieee80211_channel *chan = NULL;
  296. /* call only for ibss! */
  297. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
  298. return -EINVAL;
  299. wdev_lock(wdev);
  300. if (wdev->current_bss)
  301. chan = wdev->current_bss->pub.channel;
  302. else if (wdev->wext.ibss.chandef.chan)
  303. chan = wdev->wext.ibss.chandef.chan;
  304. wdev_unlock(wdev);
  305. if (chan) {
  306. freq->m = chan->center_freq;
  307. freq->e = 6;
  308. return 0;
  309. }
  310. /* no channel if not joining */
  311. return -EINVAL;
  312. }
  313. int cfg80211_ibss_wext_siwessid(struct net_device *dev,
  314. struct iw_request_info *info,
  315. struct iw_point *data, char *ssid)
  316. {
  317. struct wireless_dev *wdev = dev->ieee80211_ptr;
  318. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  319. size_t len = data->length;
  320. int err;
  321. /* call only for ibss! */
  322. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
  323. return -EINVAL;
  324. if (!rdev->ops->join_ibss)
  325. return -EOPNOTSUPP;
  326. wdev_lock(wdev);
  327. err = 0;
  328. if (wdev->ssid_len)
  329. err = __cfg80211_leave_ibss(rdev, dev, true);
  330. wdev_unlock(wdev);
  331. if (err)
  332. return err;
  333. /* iwconfig uses nul termination in SSID.. */
  334. if (len > 0 && ssid[len - 1] == '\0')
  335. len--;
  336. memcpy(wdev->ssid, ssid, len);
  337. wdev->wext.ibss.ssid = wdev->ssid;
  338. wdev->wext.ibss.ssid_len = len;
  339. wdev_lock(wdev);
  340. err = cfg80211_ibss_wext_join(rdev, wdev);
  341. wdev_unlock(wdev);
  342. return err;
  343. }
  344. int cfg80211_ibss_wext_giwessid(struct net_device *dev,
  345. struct iw_request_info *info,
  346. struct iw_point *data, char *ssid)
  347. {
  348. struct wireless_dev *wdev = dev->ieee80211_ptr;
  349. /* call only for ibss! */
  350. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
  351. return -EINVAL;
  352. data->flags = 0;
  353. wdev_lock(wdev);
  354. if (wdev->ssid_len) {
  355. data->flags = 1;
  356. data->length = wdev->ssid_len;
  357. memcpy(ssid, wdev->ssid, data->length);
  358. } else if (wdev->wext.ibss.ssid && wdev->wext.ibss.ssid_len) {
  359. data->flags = 1;
  360. data->length = wdev->wext.ibss.ssid_len;
  361. memcpy(ssid, wdev->wext.ibss.ssid, data->length);
  362. }
  363. wdev_unlock(wdev);
  364. return 0;
  365. }
  366. int cfg80211_ibss_wext_siwap(struct net_device *dev,
  367. struct iw_request_info *info,
  368. struct sockaddr *ap_addr, char *extra)
  369. {
  370. struct wireless_dev *wdev = dev->ieee80211_ptr;
  371. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  372. u8 *bssid = ap_addr->sa_data;
  373. int err;
  374. /* call only for ibss! */
  375. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
  376. return -EINVAL;
  377. if (!rdev->ops->join_ibss)
  378. return -EOPNOTSUPP;
  379. if (ap_addr->sa_family != ARPHRD_ETHER)
  380. return -EINVAL;
  381. /* automatic mode */
  382. if (is_zero_ether_addr(bssid) || is_broadcast_ether_addr(bssid))
  383. bssid = NULL;
  384. if (bssid && !is_valid_ether_addr(bssid))
  385. return -EINVAL;
  386. /* both automatic */
  387. if (!bssid && !wdev->wext.ibss.bssid)
  388. return 0;
  389. /* fixed already - and no change */
  390. if (wdev->wext.ibss.bssid && bssid &&
  391. ether_addr_equal(bssid, wdev->wext.ibss.bssid))
  392. return 0;
  393. wdev_lock(wdev);
  394. err = 0;
  395. if (wdev->ssid_len)
  396. err = __cfg80211_leave_ibss(rdev, dev, true);
  397. wdev_unlock(wdev);
  398. if (err)
  399. return err;
  400. if (bssid) {
  401. memcpy(wdev->wext.bssid, bssid, ETH_ALEN);
  402. wdev->wext.ibss.bssid = wdev->wext.bssid;
  403. } else
  404. wdev->wext.ibss.bssid = NULL;
  405. wdev_lock(wdev);
  406. err = cfg80211_ibss_wext_join(rdev, wdev);
  407. wdev_unlock(wdev);
  408. return err;
  409. }
  410. int cfg80211_ibss_wext_giwap(struct net_device *dev,
  411. struct iw_request_info *info,
  412. struct sockaddr *ap_addr, char *extra)
  413. {
  414. struct wireless_dev *wdev = dev->ieee80211_ptr;
  415. /* call only for ibss! */
  416. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
  417. return -EINVAL;
  418. ap_addr->sa_family = ARPHRD_ETHER;
  419. wdev_lock(wdev);
  420. if (wdev->current_bss)
  421. memcpy(ap_addr->sa_data, wdev->current_bss->pub.bssid, ETH_ALEN);
  422. else if (wdev->wext.ibss.bssid)
  423. memcpy(ap_addr->sa_data, wdev->wext.ibss.bssid, ETH_ALEN);
  424. else
  425. eth_zero_addr(ap_addr->sa_data);
  426. wdev_unlock(wdev);
  427. return 0;
  428. }
  429. #endif