wext-core.c 32 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198
  1. /*
  2. * This file implement the Wireless Extensions core API.
  3. *
  4. * Authors : Jean Tourrilhes - HPL - <[email protected]>
  5. * Copyright (c) 1997-2007 Jean Tourrilhes, All Rights Reserved.
  6. * Copyright 2009 Johannes Berg <[email protected]>
  7. *
  8. * (As all part of the Linux kernel, this file is GPL)
  9. */
  10. #include <linux/kernel.h>
  11. #include <linux/netdevice.h>
  12. #include <linux/rtnetlink.h>
  13. #include <linux/slab.h>
  14. #include <linux/wireless.h>
  15. #include <linux/uaccess.h>
  16. #include <linux/export.h>
  17. #include <net/cfg80211.h>
  18. #include <net/iw_handler.h>
  19. #include <net/netlink.h>
  20. #include <net/wext.h>
  21. #include <net/net_namespace.h>
  22. typedef int (*wext_ioctl_func)(struct net_device *, struct iwreq *,
  23. unsigned int, struct iw_request_info *,
  24. iw_handler);
  25. /*
  26. * Meta-data about all the standard Wireless Extension request we
  27. * know about.
  28. */
  29. static const struct iw_ioctl_description standard_ioctl[] = {
  30. [IW_IOCTL_IDX(SIOCSIWCOMMIT)] = {
  31. .header_type = IW_HEADER_TYPE_NULL,
  32. },
  33. [IW_IOCTL_IDX(SIOCGIWNAME)] = {
  34. .header_type = IW_HEADER_TYPE_CHAR,
  35. .flags = IW_DESCR_FLAG_DUMP,
  36. },
  37. [IW_IOCTL_IDX(SIOCSIWNWID)] = {
  38. .header_type = IW_HEADER_TYPE_PARAM,
  39. .flags = IW_DESCR_FLAG_EVENT,
  40. },
  41. [IW_IOCTL_IDX(SIOCGIWNWID)] = {
  42. .header_type = IW_HEADER_TYPE_PARAM,
  43. .flags = IW_DESCR_FLAG_DUMP,
  44. },
  45. [IW_IOCTL_IDX(SIOCSIWFREQ)] = {
  46. .header_type = IW_HEADER_TYPE_FREQ,
  47. .flags = IW_DESCR_FLAG_EVENT,
  48. },
  49. [IW_IOCTL_IDX(SIOCGIWFREQ)] = {
  50. .header_type = IW_HEADER_TYPE_FREQ,
  51. .flags = IW_DESCR_FLAG_DUMP,
  52. },
  53. [IW_IOCTL_IDX(SIOCSIWMODE)] = {
  54. .header_type = IW_HEADER_TYPE_UINT,
  55. .flags = IW_DESCR_FLAG_EVENT,
  56. },
  57. [IW_IOCTL_IDX(SIOCGIWMODE)] = {
  58. .header_type = IW_HEADER_TYPE_UINT,
  59. .flags = IW_DESCR_FLAG_DUMP,
  60. },
  61. [IW_IOCTL_IDX(SIOCSIWSENS)] = {
  62. .header_type = IW_HEADER_TYPE_PARAM,
  63. },
  64. [IW_IOCTL_IDX(SIOCGIWSENS)] = {
  65. .header_type = IW_HEADER_TYPE_PARAM,
  66. },
  67. [IW_IOCTL_IDX(SIOCSIWRANGE)] = {
  68. .header_type = IW_HEADER_TYPE_NULL,
  69. },
  70. [IW_IOCTL_IDX(SIOCGIWRANGE)] = {
  71. .header_type = IW_HEADER_TYPE_POINT,
  72. .token_size = 1,
  73. .max_tokens = sizeof(struct iw_range),
  74. .flags = IW_DESCR_FLAG_DUMP,
  75. },
  76. [IW_IOCTL_IDX(SIOCSIWPRIV)] = {
  77. .header_type = IW_HEADER_TYPE_NULL,
  78. },
  79. [IW_IOCTL_IDX(SIOCGIWPRIV)] = { /* (handled directly by us) */
  80. .header_type = IW_HEADER_TYPE_POINT,
  81. .token_size = sizeof(struct iw_priv_args),
  82. .max_tokens = 16,
  83. .flags = IW_DESCR_FLAG_NOMAX,
  84. },
  85. [IW_IOCTL_IDX(SIOCSIWSTATS)] = {
  86. .header_type = IW_HEADER_TYPE_NULL,
  87. },
  88. [IW_IOCTL_IDX(SIOCGIWSTATS)] = { /* (handled directly by us) */
  89. .header_type = IW_HEADER_TYPE_POINT,
  90. .token_size = 1,
  91. .max_tokens = sizeof(struct iw_statistics),
  92. .flags = IW_DESCR_FLAG_DUMP,
  93. },
  94. [IW_IOCTL_IDX(SIOCSIWSPY)] = {
  95. .header_type = IW_HEADER_TYPE_POINT,
  96. .token_size = sizeof(struct sockaddr),
  97. .max_tokens = IW_MAX_SPY,
  98. },
  99. [IW_IOCTL_IDX(SIOCGIWSPY)] = {
  100. .header_type = IW_HEADER_TYPE_POINT,
  101. .token_size = sizeof(struct sockaddr) +
  102. sizeof(struct iw_quality),
  103. .max_tokens = IW_MAX_SPY,
  104. },
  105. [IW_IOCTL_IDX(SIOCSIWTHRSPY)] = {
  106. .header_type = IW_HEADER_TYPE_POINT,
  107. .token_size = sizeof(struct iw_thrspy),
  108. .min_tokens = 1,
  109. .max_tokens = 1,
  110. },
  111. [IW_IOCTL_IDX(SIOCGIWTHRSPY)] = {
  112. .header_type = IW_HEADER_TYPE_POINT,
  113. .token_size = sizeof(struct iw_thrspy),
  114. .min_tokens = 1,
  115. .max_tokens = 1,
  116. },
  117. [IW_IOCTL_IDX(SIOCSIWAP)] = {
  118. .header_type = IW_HEADER_TYPE_ADDR,
  119. },
  120. [IW_IOCTL_IDX(SIOCGIWAP)] = {
  121. .header_type = IW_HEADER_TYPE_ADDR,
  122. .flags = IW_DESCR_FLAG_DUMP,
  123. },
  124. [IW_IOCTL_IDX(SIOCSIWMLME)] = {
  125. .header_type = IW_HEADER_TYPE_POINT,
  126. .token_size = 1,
  127. .min_tokens = sizeof(struct iw_mlme),
  128. .max_tokens = sizeof(struct iw_mlme),
  129. },
  130. [IW_IOCTL_IDX(SIOCGIWAPLIST)] = {
  131. .header_type = IW_HEADER_TYPE_POINT,
  132. .token_size = sizeof(struct sockaddr) +
  133. sizeof(struct iw_quality),
  134. .max_tokens = IW_MAX_AP,
  135. .flags = IW_DESCR_FLAG_NOMAX,
  136. },
  137. [IW_IOCTL_IDX(SIOCSIWSCAN)] = {
  138. .header_type = IW_HEADER_TYPE_POINT,
  139. .token_size = 1,
  140. .min_tokens = 0,
  141. .max_tokens = sizeof(struct iw_scan_req),
  142. },
  143. [IW_IOCTL_IDX(SIOCGIWSCAN)] = {
  144. .header_type = IW_HEADER_TYPE_POINT,
  145. .token_size = 1,
  146. .max_tokens = IW_SCAN_MAX_DATA,
  147. .flags = IW_DESCR_FLAG_NOMAX,
  148. },
  149. [IW_IOCTL_IDX(SIOCSIWESSID)] = {
  150. .header_type = IW_HEADER_TYPE_POINT,
  151. .token_size = 1,
  152. .max_tokens = IW_ESSID_MAX_SIZE,
  153. .flags = IW_DESCR_FLAG_EVENT,
  154. },
  155. [IW_IOCTL_IDX(SIOCGIWESSID)] = {
  156. .header_type = IW_HEADER_TYPE_POINT,
  157. .token_size = 1,
  158. .max_tokens = IW_ESSID_MAX_SIZE,
  159. .flags = IW_DESCR_FLAG_DUMP,
  160. },
  161. [IW_IOCTL_IDX(SIOCSIWNICKN)] = {
  162. .header_type = IW_HEADER_TYPE_POINT,
  163. .token_size = 1,
  164. .max_tokens = IW_ESSID_MAX_SIZE,
  165. },
  166. [IW_IOCTL_IDX(SIOCGIWNICKN)] = {
  167. .header_type = IW_HEADER_TYPE_POINT,
  168. .token_size = 1,
  169. .max_tokens = IW_ESSID_MAX_SIZE,
  170. },
  171. [IW_IOCTL_IDX(SIOCSIWRATE)] = {
  172. .header_type = IW_HEADER_TYPE_PARAM,
  173. },
  174. [IW_IOCTL_IDX(SIOCGIWRATE)] = {
  175. .header_type = IW_HEADER_TYPE_PARAM,
  176. },
  177. [IW_IOCTL_IDX(SIOCSIWRTS)] = {
  178. .header_type = IW_HEADER_TYPE_PARAM,
  179. },
  180. [IW_IOCTL_IDX(SIOCGIWRTS)] = {
  181. .header_type = IW_HEADER_TYPE_PARAM,
  182. },
  183. [IW_IOCTL_IDX(SIOCSIWFRAG)] = {
  184. .header_type = IW_HEADER_TYPE_PARAM,
  185. },
  186. [IW_IOCTL_IDX(SIOCGIWFRAG)] = {
  187. .header_type = IW_HEADER_TYPE_PARAM,
  188. },
  189. [IW_IOCTL_IDX(SIOCSIWTXPOW)] = {
  190. .header_type = IW_HEADER_TYPE_PARAM,
  191. },
  192. [IW_IOCTL_IDX(SIOCGIWTXPOW)] = {
  193. .header_type = IW_HEADER_TYPE_PARAM,
  194. },
  195. [IW_IOCTL_IDX(SIOCSIWRETRY)] = {
  196. .header_type = IW_HEADER_TYPE_PARAM,
  197. },
  198. [IW_IOCTL_IDX(SIOCGIWRETRY)] = {
  199. .header_type = IW_HEADER_TYPE_PARAM,
  200. },
  201. [IW_IOCTL_IDX(SIOCSIWENCODE)] = {
  202. .header_type = IW_HEADER_TYPE_POINT,
  203. .token_size = 1,
  204. .max_tokens = IW_ENCODING_TOKEN_MAX,
  205. .flags = IW_DESCR_FLAG_EVENT | IW_DESCR_FLAG_RESTRICT,
  206. },
  207. [IW_IOCTL_IDX(SIOCGIWENCODE)] = {
  208. .header_type = IW_HEADER_TYPE_POINT,
  209. .token_size = 1,
  210. .max_tokens = IW_ENCODING_TOKEN_MAX,
  211. .flags = IW_DESCR_FLAG_DUMP | IW_DESCR_FLAG_RESTRICT,
  212. },
  213. [IW_IOCTL_IDX(SIOCSIWPOWER)] = {
  214. .header_type = IW_HEADER_TYPE_PARAM,
  215. },
  216. [IW_IOCTL_IDX(SIOCGIWPOWER)] = {
  217. .header_type = IW_HEADER_TYPE_PARAM,
  218. },
  219. [IW_IOCTL_IDX(SIOCSIWGENIE)] = {
  220. .header_type = IW_HEADER_TYPE_POINT,
  221. .token_size = 1,
  222. .max_tokens = IW_GENERIC_IE_MAX,
  223. },
  224. [IW_IOCTL_IDX(SIOCGIWGENIE)] = {
  225. .header_type = IW_HEADER_TYPE_POINT,
  226. .token_size = 1,
  227. .max_tokens = IW_GENERIC_IE_MAX,
  228. },
  229. [IW_IOCTL_IDX(SIOCSIWAUTH)] = {
  230. .header_type = IW_HEADER_TYPE_PARAM,
  231. },
  232. [IW_IOCTL_IDX(SIOCGIWAUTH)] = {
  233. .header_type = IW_HEADER_TYPE_PARAM,
  234. },
  235. [IW_IOCTL_IDX(SIOCSIWENCODEEXT)] = {
  236. .header_type = IW_HEADER_TYPE_POINT,
  237. .token_size = 1,
  238. .min_tokens = sizeof(struct iw_encode_ext),
  239. .max_tokens = sizeof(struct iw_encode_ext) +
  240. IW_ENCODING_TOKEN_MAX,
  241. },
  242. [IW_IOCTL_IDX(SIOCGIWENCODEEXT)] = {
  243. .header_type = IW_HEADER_TYPE_POINT,
  244. .token_size = 1,
  245. .min_tokens = sizeof(struct iw_encode_ext),
  246. .max_tokens = sizeof(struct iw_encode_ext) +
  247. IW_ENCODING_TOKEN_MAX,
  248. },
  249. [IW_IOCTL_IDX(SIOCSIWPMKSA)] = {
  250. .header_type = IW_HEADER_TYPE_POINT,
  251. .token_size = 1,
  252. .min_tokens = sizeof(struct iw_pmksa),
  253. .max_tokens = sizeof(struct iw_pmksa),
  254. },
  255. };
  256. static const unsigned int standard_ioctl_num = ARRAY_SIZE(standard_ioctl);
  257. /*
  258. * Meta-data about all the additional standard Wireless Extension events
  259. * we know about.
  260. */
  261. static const struct iw_ioctl_description standard_event[] = {
  262. [IW_EVENT_IDX(IWEVTXDROP)] = {
  263. .header_type = IW_HEADER_TYPE_ADDR,
  264. },
  265. [IW_EVENT_IDX(IWEVQUAL)] = {
  266. .header_type = IW_HEADER_TYPE_QUAL,
  267. },
  268. [IW_EVENT_IDX(IWEVCUSTOM)] = {
  269. .header_type = IW_HEADER_TYPE_POINT,
  270. .token_size = 1,
  271. .max_tokens = IW_CUSTOM_MAX,
  272. },
  273. [IW_EVENT_IDX(IWEVREGISTERED)] = {
  274. .header_type = IW_HEADER_TYPE_ADDR,
  275. },
  276. [IW_EVENT_IDX(IWEVEXPIRED)] = {
  277. .header_type = IW_HEADER_TYPE_ADDR,
  278. },
  279. [IW_EVENT_IDX(IWEVGENIE)] = {
  280. .header_type = IW_HEADER_TYPE_POINT,
  281. .token_size = 1,
  282. .max_tokens = IW_GENERIC_IE_MAX,
  283. },
  284. [IW_EVENT_IDX(IWEVMICHAELMICFAILURE)] = {
  285. .header_type = IW_HEADER_TYPE_POINT,
  286. .token_size = 1,
  287. .max_tokens = sizeof(struct iw_michaelmicfailure),
  288. },
  289. [IW_EVENT_IDX(IWEVASSOCREQIE)] = {
  290. .header_type = IW_HEADER_TYPE_POINT,
  291. .token_size = 1,
  292. .max_tokens = IW_GENERIC_IE_MAX,
  293. },
  294. [IW_EVENT_IDX(IWEVASSOCRESPIE)] = {
  295. .header_type = IW_HEADER_TYPE_POINT,
  296. .token_size = 1,
  297. .max_tokens = IW_GENERIC_IE_MAX,
  298. },
  299. [IW_EVENT_IDX(IWEVPMKIDCAND)] = {
  300. .header_type = IW_HEADER_TYPE_POINT,
  301. .token_size = 1,
  302. .max_tokens = sizeof(struct iw_pmkid_cand),
  303. },
  304. };
  305. static const unsigned int standard_event_num = ARRAY_SIZE(standard_event);
  306. /* Size (in bytes) of various events */
  307. static const int event_type_size[] = {
  308. IW_EV_LCP_LEN, /* IW_HEADER_TYPE_NULL */
  309. 0,
  310. IW_EV_CHAR_LEN, /* IW_HEADER_TYPE_CHAR */
  311. 0,
  312. IW_EV_UINT_LEN, /* IW_HEADER_TYPE_UINT */
  313. IW_EV_FREQ_LEN, /* IW_HEADER_TYPE_FREQ */
  314. IW_EV_ADDR_LEN, /* IW_HEADER_TYPE_ADDR */
  315. 0,
  316. IW_EV_POINT_LEN, /* Without variable payload */
  317. IW_EV_PARAM_LEN, /* IW_HEADER_TYPE_PARAM */
  318. IW_EV_QUAL_LEN, /* IW_HEADER_TYPE_QUAL */
  319. };
  320. #ifdef CONFIG_COMPAT
  321. static const int compat_event_type_size[] = {
  322. IW_EV_COMPAT_LCP_LEN, /* IW_HEADER_TYPE_NULL */
  323. 0,
  324. IW_EV_COMPAT_CHAR_LEN, /* IW_HEADER_TYPE_CHAR */
  325. 0,
  326. IW_EV_COMPAT_UINT_LEN, /* IW_HEADER_TYPE_UINT */
  327. IW_EV_COMPAT_FREQ_LEN, /* IW_HEADER_TYPE_FREQ */
  328. IW_EV_COMPAT_ADDR_LEN, /* IW_HEADER_TYPE_ADDR */
  329. 0,
  330. IW_EV_COMPAT_POINT_LEN, /* Without variable payload */
  331. IW_EV_COMPAT_PARAM_LEN, /* IW_HEADER_TYPE_PARAM */
  332. IW_EV_COMPAT_QUAL_LEN, /* IW_HEADER_TYPE_QUAL */
  333. };
  334. #endif
  335. /* IW event code */
  336. void wireless_nlevent_flush(void)
  337. {
  338. struct sk_buff *skb;
  339. struct net *net;
  340. down_read(&net_rwsem);
  341. for_each_net(net) {
  342. while ((skb = skb_dequeue(&net->wext_nlevents)))
  343. rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL,
  344. GFP_KERNEL);
  345. }
  346. up_read(&net_rwsem);
  347. }
  348. EXPORT_SYMBOL_GPL(wireless_nlevent_flush);
  349. static int wext_netdev_notifier_call(struct notifier_block *nb,
  350. unsigned long state, void *ptr)
  351. {
  352. /*
  353. * When a netdev changes state in any way, flush all pending messages
  354. * to avoid them going out in a strange order, e.g. RTM_NEWLINK after
  355. * RTM_DELLINK, or with IFF_UP after without IFF_UP during dev_close()
  356. * or similar - all of which could otherwise happen due to delays from
  357. * schedule_work().
  358. */
  359. wireless_nlevent_flush();
  360. return NOTIFY_OK;
  361. }
  362. static struct notifier_block wext_netdev_notifier = {
  363. .notifier_call = wext_netdev_notifier_call,
  364. };
  365. static int __net_init wext_pernet_init(struct net *net)
  366. {
  367. skb_queue_head_init(&net->wext_nlevents);
  368. return 0;
  369. }
  370. static void __net_exit wext_pernet_exit(struct net *net)
  371. {
  372. skb_queue_purge(&net->wext_nlevents);
  373. }
  374. static struct pernet_operations wext_pernet_ops = {
  375. .init = wext_pernet_init,
  376. .exit = wext_pernet_exit,
  377. };
  378. static int __init wireless_nlevent_init(void)
  379. {
  380. int err = register_pernet_subsys(&wext_pernet_ops);
  381. if (err)
  382. return err;
  383. err = register_netdevice_notifier(&wext_netdev_notifier);
  384. if (err)
  385. unregister_pernet_subsys(&wext_pernet_ops);
  386. return err;
  387. }
  388. subsys_initcall(wireless_nlevent_init);
  389. /* Process events generated by the wireless layer or the driver. */
  390. static void wireless_nlevent_process(struct work_struct *work)
  391. {
  392. wireless_nlevent_flush();
  393. }
  394. static DECLARE_WORK(wireless_nlevent_work, wireless_nlevent_process);
  395. static struct nlmsghdr *rtnetlink_ifinfo_prep(struct net_device *dev,
  396. struct sk_buff *skb)
  397. {
  398. struct ifinfomsg *r;
  399. struct nlmsghdr *nlh;
  400. nlh = nlmsg_put(skb, 0, 0, RTM_NEWLINK, sizeof(*r), 0);
  401. if (!nlh)
  402. return NULL;
  403. r = nlmsg_data(nlh);
  404. r->ifi_family = AF_UNSPEC;
  405. r->__ifi_pad = 0;
  406. r->ifi_type = dev->type;
  407. r->ifi_index = dev->ifindex;
  408. r->ifi_flags = dev_get_flags(dev);
  409. r->ifi_change = 0; /* Wireless changes don't affect those flags */
  410. if (nla_put_string(skb, IFLA_IFNAME, dev->name))
  411. goto nla_put_failure;
  412. return nlh;
  413. nla_put_failure:
  414. nlmsg_cancel(skb, nlh);
  415. return NULL;
  416. }
  417. /*
  418. * Main event dispatcher. Called from other parts and drivers.
  419. * Send the event on the appropriate channels.
  420. * May be called from interrupt context.
  421. */
  422. void wireless_send_event(struct net_device * dev,
  423. unsigned int cmd,
  424. union iwreq_data * wrqu,
  425. const char * extra)
  426. {
  427. const struct iw_ioctl_description * descr = NULL;
  428. int extra_len = 0;
  429. struct iw_event *event; /* Mallocated whole event */
  430. int event_len; /* Its size */
  431. int hdr_len; /* Size of the event header */
  432. int wrqu_off = 0; /* Offset in wrqu */
  433. /* Don't "optimise" the following variable, it will crash */
  434. unsigned int cmd_index; /* *MUST* be unsigned */
  435. struct sk_buff *skb;
  436. struct nlmsghdr *nlh;
  437. struct nlattr *nla;
  438. #ifdef CONFIG_COMPAT
  439. struct __compat_iw_event *compat_event;
  440. struct compat_iw_point compat_wrqu;
  441. struct sk_buff *compskb;
  442. int ptr_len;
  443. #endif
  444. /*
  445. * Nothing in the kernel sends scan events with data, be safe.
  446. * This is necessary because we cannot fix up scan event data
  447. * for compat, due to being contained in 'extra', but normally
  448. * applications are required to retrieve the scan data anyway
  449. * and no data is included in the event, this codifies that
  450. * practice.
  451. */
  452. if (WARN_ON(cmd == SIOCGIWSCAN && extra))
  453. extra = NULL;
  454. /* Get the description of the Event */
  455. if (cmd <= SIOCIWLAST) {
  456. cmd_index = IW_IOCTL_IDX(cmd);
  457. if (cmd_index < standard_ioctl_num)
  458. descr = &(standard_ioctl[cmd_index]);
  459. } else {
  460. cmd_index = IW_EVENT_IDX(cmd);
  461. if (cmd_index < standard_event_num)
  462. descr = &(standard_event[cmd_index]);
  463. }
  464. /* Don't accept unknown events */
  465. if (descr == NULL) {
  466. /* Note : we don't return an error to the driver, because
  467. * the driver would not know what to do about it. It can't
  468. * return an error to the user, because the event is not
  469. * initiated by a user request.
  470. * The best the driver could do is to log an error message.
  471. * We will do it ourselves instead...
  472. */
  473. netdev_err(dev, "(WE) : Invalid/Unknown Wireless Event (0x%04X)\n",
  474. cmd);
  475. return;
  476. }
  477. /* Check extra parameters and set extra_len */
  478. if (descr->header_type == IW_HEADER_TYPE_POINT) {
  479. /* Check if number of token fits within bounds */
  480. if (wrqu->data.length > descr->max_tokens) {
  481. netdev_err(dev, "(WE) : Wireless Event (cmd=0x%04X) too big (%d)\n",
  482. cmd, wrqu->data.length);
  483. return;
  484. }
  485. if (wrqu->data.length < descr->min_tokens) {
  486. netdev_err(dev, "(WE) : Wireless Event (cmd=0x%04X) too small (%d)\n",
  487. cmd, wrqu->data.length);
  488. return;
  489. }
  490. /* Calculate extra_len - extra is NULL for restricted events */
  491. if (extra != NULL)
  492. extra_len = wrqu->data.length * descr->token_size;
  493. /* Always at an offset in wrqu */
  494. wrqu_off = IW_EV_POINT_OFF;
  495. }
  496. /* Total length of the event */
  497. hdr_len = event_type_size[descr->header_type];
  498. event_len = hdr_len + extra_len;
  499. /*
  500. * The problem for 64/32 bit.
  501. *
  502. * On 64-bit, a regular event is laid out as follows:
  503. * | 0 | 1 | 2 | 3 | 4 | 5 | 6 | 7 |
  504. * | event.len | event.cmd | p a d d i n g |
  505. * | wrqu data ... (with the correct size) |
  506. *
  507. * This padding exists because we manipulate event->u,
  508. * and 'event' is not packed.
  509. *
  510. * An iw_point event is laid out like this instead:
  511. * | 0 | 1 | 2 | 3 | 4 | 5 | 6 | 7 |
  512. * | event.len | event.cmd | p a d d i n g |
  513. * | iwpnt.len | iwpnt.flg | p a d d i n g |
  514. * | extra data ...
  515. *
  516. * The second padding exists because struct iw_point is extended,
  517. * but this depends on the platform...
  518. *
  519. * On 32-bit, all the padding shouldn't be there.
  520. */
  521. skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
  522. if (!skb)
  523. return;
  524. /* Send via the RtNetlink event channel */
  525. nlh = rtnetlink_ifinfo_prep(dev, skb);
  526. if (WARN_ON(!nlh)) {
  527. kfree_skb(skb);
  528. return;
  529. }
  530. /* Add the wireless events in the netlink packet */
  531. nla = nla_reserve(skb, IFLA_WIRELESS, event_len);
  532. if (!nla) {
  533. kfree_skb(skb);
  534. return;
  535. }
  536. event = nla_data(nla);
  537. /* Fill event - first clear to avoid data leaking */
  538. memset(event, 0, hdr_len);
  539. event->len = event_len;
  540. event->cmd = cmd;
  541. memcpy(&event->u, ((char *) wrqu) + wrqu_off, hdr_len - IW_EV_LCP_LEN);
  542. if (extra_len)
  543. memcpy(((char *) event) + hdr_len, extra, extra_len);
  544. nlmsg_end(skb, nlh);
  545. #ifdef CONFIG_COMPAT
  546. hdr_len = compat_event_type_size[descr->header_type];
  547. /* ptr_len is remaining size in event header apart from LCP */
  548. ptr_len = hdr_len - IW_EV_COMPAT_LCP_LEN;
  549. event_len = hdr_len + extra_len;
  550. compskb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
  551. if (!compskb) {
  552. kfree_skb(skb);
  553. return;
  554. }
  555. /* Send via the RtNetlink event channel */
  556. nlh = rtnetlink_ifinfo_prep(dev, compskb);
  557. if (WARN_ON(!nlh)) {
  558. kfree_skb(skb);
  559. kfree_skb(compskb);
  560. return;
  561. }
  562. /* Add the wireless events in the netlink packet */
  563. nla = nla_reserve(compskb, IFLA_WIRELESS, event_len);
  564. if (!nla) {
  565. kfree_skb(skb);
  566. kfree_skb(compskb);
  567. return;
  568. }
  569. compat_event = nla_data(nla);
  570. compat_event->len = event_len;
  571. compat_event->cmd = cmd;
  572. if (descr->header_type == IW_HEADER_TYPE_POINT) {
  573. compat_wrqu.length = wrqu->data.length;
  574. compat_wrqu.flags = wrqu->data.flags;
  575. memcpy(compat_event->ptr_bytes,
  576. ((char *)&compat_wrqu) + IW_EV_COMPAT_POINT_OFF,
  577. ptr_len);
  578. if (extra_len)
  579. memcpy(&compat_event->ptr_bytes[ptr_len],
  580. extra, extra_len);
  581. } else {
  582. /* extra_len must be zero, so no if (extra) needed */
  583. memcpy(compat_event->ptr_bytes, wrqu, ptr_len);
  584. }
  585. nlmsg_end(compskb, nlh);
  586. skb_shinfo(skb)->frag_list = compskb;
  587. #endif
  588. skb_queue_tail(&dev_net(dev)->wext_nlevents, skb);
  589. schedule_work(&wireless_nlevent_work);
  590. }
  591. EXPORT_SYMBOL(wireless_send_event);
  592. /* IW handlers */
  593. struct iw_statistics *get_wireless_stats(struct net_device *dev)
  594. {
  595. #ifdef CONFIG_WIRELESS_EXT
  596. if ((dev->wireless_handlers != NULL) &&
  597. (dev->wireless_handlers->get_wireless_stats != NULL))
  598. return dev->wireless_handlers->get_wireless_stats(dev);
  599. #endif
  600. #ifdef CONFIG_CFG80211_WEXT
  601. if (dev->ieee80211_ptr &&
  602. dev->ieee80211_ptr->wiphy &&
  603. dev->ieee80211_ptr->wiphy->wext &&
  604. dev->ieee80211_ptr->wiphy->wext->get_wireless_stats)
  605. return dev->ieee80211_ptr->wiphy->wext->get_wireless_stats(dev);
  606. #endif
  607. /* not found */
  608. return NULL;
  609. }
  610. /* noinline to avoid a bogus warning with -O3 */
  611. static noinline int iw_handler_get_iwstats(struct net_device * dev,
  612. struct iw_request_info * info,
  613. union iwreq_data * wrqu,
  614. char * extra)
  615. {
  616. /* Get stats from the driver */
  617. struct iw_statistics *stats;
  618. stats = get_wireless_stats(dev);
  619. if (stats) {
  620. /* Copy statistics to extra */
  621. memcpy(extra, stats, sizeof(struct iw_statistics));
  622. wrqu->data.length = sizeof(struct iw_statistics);
  623. /* Check if we need to clear the updated flag */
  624. if (wrqu->data.flags != 0)
  625. stats->qual.updated &= ~IW_QUAL_ALL_UPDATED;
  626. return 0;
  627. } else
  628. return -EOPNOTSUPP;
  629. }
  630. static iw_handler get_handler(struct net_device *dev, unsigned int cmd)
  631. {
  632. /* Don't "optimise" the following variable, it will crash */
  633. unsigned int index; /* *MUST* be unsigned */
  634. const struct iw_handler_def *handlers = NULL;
  635. #ifdef CONFIG_CFG80211_WEXT
  636. if (dev->ieee80211_ptr && dev->ieee80211_ptr->wiphy)
  637. handlers = dev->ieee80211_ptr->wiphy->wext;
  638. #endif
  639. #ifdef CONFIG_WIRELESS_EXT
  640. if (dev->wireless_handlers)
  641. handlers = dev->wireless_handlers;
  642. #endif
  643. if (!handlers)
  644. return NULL;
  645. /* Try as a standard command */
  646. index = IW_IOCTL_IDX(cmd);
  647. if (index < handlers->num_standard)
  648. return handlers->standard[index];
  649. #ifdef CONFIG_WEXT_PRIV
  650. /* Try as a private command */
  651. index = cmd - SIOCIWFIRSTPRIV;
  652. if (index < handlers->num_private)
  653. return handlers->private[index];
  654. #endif
  655. /* Not found */
  656. return NULL;
  657. }
  658. static int ioctl_standard_iw_point(struct iw_point *iwp, unsigned int cmd,
  659. const struct iw_ioctl_description *descr,
  660. iw_handler handler, struct net_device *dev,
  661. struct iw_request_info *info)
  662. {
  663. int err, extra_size, user_length = 0, essid_compat = 0;
  664. char *extra;
  665. /* Calculate space needed by arguments. Always allocate
  666. * for max space.
  667. */
  668. extra_size = descr->max_tokens * descr->token_size;
  669. /* Check need for ESSID compatibility for WE < 21 */
  670. switch (cmd) {
  671. case SIOCSIWESSID:
  672. case SIOCGIWESSID:
  673. case SIOCSIWNICKN:
  674. case SIOCGIWNICKN:
  675. if (iwp->length == descr->max_tokens + 1)
  676. essid_compat = 1;
  677. else if (IW_IS_SET(cmd) && (iwp->length != 0)) {
  678. char essid[IW_ESSID_MAX_SIZE + 1];
  679. unsigned int len;
  680. len = iwp->length * descr->token_size;
  681. if (len > IW_ESSID_MAX_SIZE)
  682. return -EFAULT;
  683. err = copy_from_user(essid, iwp->pointer, len);
  684. if (err)
  685. return -EFAULT;
  686. if (essid[iwp->length - 1] == '\0')
  687. essid_compat = 1;
  688. }
  689. break;
  690. default:
  691. break;
  692. }
  693. iwp->length -= essid_compat;
  694. /* Check what user space is giving us */
  695. if (IW_IS_SET(cmd)) {
  696. /* Check NULL pointer */
  697. if (!iwp->pointer && iwp->length != 0)
  698. return -EFAULT;
  699. /* Check if number of token fits within bounds */
  700. if (iwp->length > descr->max_tokens)
  701. return -E2BIG;
  702. if (iwp->length < descr->min_tokens)
  703. return -EINVAL;
  704. } else {
  705. /* Check NULL pointer */
  706. if (!iwp->pointer)
  707. return -EFAULT;
  708. /* Save user space buffer size for checking */
  709. user_length = iwp->length;
  710. /* Don't check if user_length > max to allow forward
  711. * compatibility. The test user_length < min is
  712. * implied by the test at the end.
  713. */
  714. /* Support for very large requests */
  715. if ((descr->flags & IW_DESCR_FLAG_NOMAX) &&
  716. (user_length > descr->max_tokens)) {
  717. /* Allow userspace to GET more than max so
  718. * we can support any size GET requests.
  719. * There is still a limit : -ENOMEM.
  720. */
  721. extra_size = user_length * descr->token_size;
  722. /* Note : user_length is originally a __u16,
  723. * and token_size is controlled by us,
  724. * so extra_size won't get negative and
  725. * won't overflow...
  726. */
  727. }
  728. }
  729. /* Sanity-check to ensure we never end up _allocating_ zero
  730. * bytes of data for extra.
  731. */
  732. if (extra_size <= 0)
  733. return -EFAULT;
  734. /* kzalloc() ensures NULL-termination for essid_compat. */
  735. extra = kzalloc(extra_size, GFP_KERNEL);
  736. if (!extra)
  737. return -ENOMEM;
  738. /* If it is a SET, get all the extra data in here */
  739. if (IW_IS_SET(cmd) && (iwp->length != 0)) {
  740. if (copy_from_user(extra, iwp->pointer,
  741. iwp->length *
  742. descr->token_size)) {
  743. err = -EFAULT;
  744. goto out;
  745. }
  746. if (cmd == SIOCSIWENCODEEXT) {
  747. struct iw_encode_ext *ee = (void *) extra;
  748. if (iwp->length < sizeof(*ee) + ee->key_len) {
  749. err = -EFAULT;
  750. goto out;
  751. }
  752. }
  753. }
  754. if (IW_IS_GET(cmd) && !(descr->flags & IW_DESCR_FLAG_NOMAX)) {
  755. /*
  756. * If this is a GET, but not NOMAX, it means that the extra
  757. * data is not bounded by userspace, but by max_tokens. Thus
  758. * set the length to max_tokens. This matches the extra data
  759. * allocation.
  760. * The driver should fill it with the number of tokens it
  761. * provided, and it may check iwp->length rather than having
  762. * knowledge of max_tokens. If the driver doesn't change the
  763. * iwp->length, this ioctl just copies back max_token tokens
  764. * filled with zeroes. Hopefully the driver isn't claiming
  765. * them to be valid data.
  766. */
  767. iwp->length = descr->max_tokens;
  768. }
  769. err = handler(dev, info, (union iwreq_data *) iwp, extra);
  770. iwp->length += essid_compat;
  771. /* If we have something to return to the user */
  772. if (!err && IW_IS_GET(cmd)) {
  773. /* Check if there is enough buffer up there */
  774. if (user_length < iwp->length) {
  775. err = -E2BIG;
  776. goto out;
  777. }
  778. if (copy_to_user(iwp->pointer, extra,
  779. iwp->length *
  780. descr->token_size)) {
  781. err = -EFAULT;
  782. goto out;
  783. }
  784. }
  785. /* Generate an event to notify listeners of the change */
  786. if ((descr->flags & IW_DESCR_FLAG_EVENT) &&
  787. ((err == 0) || (err == -EIWCOMMIT))) {
  788. union iwreq_data *data = (union iwreq_data *) iwp;
  789. if (descr->flags & IW_DESCR_FLAG_RESTRICT)
  790. /* If the event is restricted, don't
  791. * export the payload.
  792. */
  793. wireless_send_event(dev, cmd, data, NULL);
  794. else
  795. wireless_send_event(dev, cmd, data, extra);
  796. }
  797. out:
  798. kfree(extra);
  799. return err;
  800. }
  801. /*
  802. * Call the commit handler in the driver
  803. * (if exist and if conditions are right)
  804. *
  805. * Note : our current commit strategy is currently pretty dumb,
  806. * but we will be able to improve on that...
  807. * The goal is to try to agreagate as many changes as possible
  808. * before doing the commit. Drivers that will define a commit handler
  809. * are usually those that need a reset after changing parameters, so
  810. * we want to minimise the number of reset.
  811. * A cool idea is to use a timer : at each "set" command, we re-set the
  812. * timer, when the timer eventually fires, we call the driver.
  813. * Hopefully, more on that later.
  814. *
  815. * Also, I'm waiting to see how many people will complain about the
  816. * netif_running(dev) test. I'm open on that one...
  817. * Hopefully, the driver will remember to do a commit in "open()" ;-)
  818. */
  819. int call_commit_handler(struct net_device *dev)
  820. {
  821. #ifdef CONFIG_WIRELESS_EXT
  822. if (netif_running(dev) &&
  823. dev->wireless_handlers &&
  824. dev->wireless_handlers->standard[0])
  825. /* Call the commit handler on the driver */
  826. return dev->wireless_handlers->standard[0](dev, NULL,
  827. NULL, NULL);
  828. else
  829. return 0; /* Command completed successfully */
  830. #else
  831. /* cfg80211 has no commit */
  832. return 0;
  833. #endif
  834. }
  835. /*
  836. * Main IOCTl dispatcher.
  837. * Check the type of IOCTL and call the appropriate wrapper...
  838. */
  839. static int wireless_process_ioctl(struct net *net, struct iwreq *iwr,
  840. unsigned int cmd,
  841. struct iw_request_info *info,
  842. wext_ioctl_func standard,
  843. wext_ioctl_func private)
  844. {
  845. struct net_device *dev;
  846. iw_handler handler;
  847. /* Permissions are already checked in dev_ioctl() before calling us.
  848. * The copy_to/from_user() of ifr is also dealt with in there */
  849. /* Make sure the device exist */
  850. if ((dev = __dev_get_by_name(net, iwr->ifr_name)) == NULL)
  851. return -ENODEV;
  852. /* A bunch of special cases, then the generic case...
  853. * Note that 'cmd' is already filtered in dev_ioctl() with
  854. * (cmd >= SIOCIWFIRST && cmd <= SIOCIWLAST) */
  855. if (cmd == SIOCGIWSTATS)
  856. return standard(dev, iwr, cmd, info,
  857. &iw_handler_get_iwstats);
  858. #ifdef CONFIG_WEXT_PRIV
  859. if (cmd == SIOCGIWPRIV && dev->wireless_handlers)
  860. return standard(dev, iwr, cmd, info,
  861. iw_handler_get_private);
  862. #endif
  863. /* Basic check */
  864. if (!netif_device_present(dev))
  865. return -ENODEV;
  866. /* New driver API : try to find the handler */
  867. handler = get_handler(dev, cmd);
  868. if (handler) {
  869. /* Standard and private are not the same */
  870. if (cmd < SIOCIWFIRSTPRIV)
  871. return standard(dev, iwr, cmd, info, handler);
  872. else if (private)
  873. return private(dev, iwr, cmd, info, handler);
  874. }
  875. return -EOPNOTSUPP;
  876. }
  877. /* If command is `set a parameter', or `get the encoding parameters',
  878. * check if the user has the right to do it.
  879. */
  880. static int wext_permission_check(unsigned int cmd)
  881. {
  882. if ((IW_IS_SET(cmd) || cmd == SIOCGIWENCODE ||
  883. cmd == SIOCGIWENCODEEXT) &&
  884. !capable(CAP_NET_ADMIN))
  885. return -EPERM;
  886. return 0;
  887. }
  888. /* entry point from dev ioctl */
  889. static int wext_ioctl_dispatch(struct net *net, struct iwreq *iwr,
  890. unsigned int cmd, struct iw_request_info *info,
  891. wext_ioctl_func standard,
  892. wext_ioctl_func private)
  893. {
  894. int ret = wext_permission_check(cmd);
  895. if (ret)
  896. return ret;
  897. dev_load(net, iwr->ifr_name);
  898. rtnl_lock();
  899. ret = wireless_process_ioctl(net, iwr, cmd, info, standard, private);
  900. rtnl_unlock();
  901. return ret;
  902. }
  903. /*
  904. * Wrapper to call a standard Wireless Extension handler.
  905. * We do various checks and also take care of moving data between
  906. * user space and kernel space.
  907. */
  908. static int ioctl_standard_call(struct net_device * dev,
  909. struct iwreq *iwr,
  910. unsigned int cmd,
  911. struct iw_request_info *info,
  912. iw_handler handler)
  913. {
  914. const struct iw_ioctl_description * descr;
  915. int ret = -EINVAL;
  916. /* Get the description of the IOCTL */
  917. if (IW_IOCTL_IDX(cmd) >= standard_ioctl_num)
  918. return -EOPNOTSUPP;
  919. descr = &(standard_ioctl[IW_IOCTL_IDX(cmd)]);
  920. /* Check if we have a pointer to user space data or not */
  921. if (descr->header_type != IW_HEADER_TYPE_POINT) {
  922. /* No extra arguments. Trivial to handle */
  923. ret = handler(dev, info, &(iwr->u), NULL);
  924. /* Generate an event to notify listeners of the change */
  925. if ((descr->flags & IW_DESCR_FLAG_EVENT) &&
  926. ((ret == 0) || (ret == -EIWCOMMIT)))
  927. wireless_send_event(dev, cmd, &(iwr->u), NULL);
  928. } else {
  929. ret = ioctl_standard_iw_point(&iwr->u.data, cmd, descr,
  930. handler, dev, info);
  931. }
  932. /* Call commit handler if needed and defined */
  933. if (ret == -EIWCOMMIT)
  934. ret = call_commit_handler(dev);
  935. /* Here, we will generate the appropriate event if needed */
  936. return ret;
  937. }
  938. int wext_handle_ioctl(struct net *net, unsigned int cmd, void __user *arg)
  939. {
  940. struct iw_request_info info = { .cmd = cmd, .flags = 0 };
  941. struct iwreq iwr;
  942. int ret;
  943. if (copy_from_user(&iwr, arg, sizeof(iwr)))
  944. return -EFAULT;
  945. iwr.ifr_name[sizeof(iwr.ifr_name) - 1] = 0;
  946. ret = wext_ioctl_dispatch(net, &iwr, cmd, &info,
  947. ioctl_standard_call,
  948. ioctl_private_call);
  949. if (ret >= 0 &&
  950. IW_IS_GET(cmd) &&
  951. copy_to_user(arg, &iwr, sizeof(struct iwreq)))
  952. return -EFAULT;
  953. return ret;
  954. }
  955. #ifdef CONFIG_COMPAT
  956. static int compat_standard_call(struct net_device *dev,
  957. struct iwreq *iwr,
  958. unsigned int cmd,
  959. struct iw_request_info *info,
  960. iw_handler handler)
  961. {
  962. const struct iw_ioctl_description *descr;
  963. struct compat_iw_point *iwp_compat;
  964. struct iw_point iwp;
  965. int err;
  966. descr = standard_ioctl + IW_IOCTL_IDX(cmd);
  967. if (descr->header_type != IW_HEADER_TYPE_POINT)
  968. return ioctl_standard_call(dev, iwr, cmd, info, handler);
  969. iwp_compat = (struct compat_iw_point *) &iwr->u.data;
  970. iwp.pointer = compat_ptr(iwp_compat->pointer);
  971. iwp.length = iwp_compat->length;
  972. iwp.flags = iwp_compat->flags;
  973. err = ioctl_standard_iw_point(&iwp, cmd, descr, handler, dev, info);
  974. iwp_compat->pointer = ptr_to_compat(iwp.pointer);
  975. iwp_compat->length = iwp.length;
  976. iwp_compat->flags = iwp.flags;
  977. return err;
  978. }
  979. int compat_wext_handle_ioctl(struct net *net, unsigned int cmd,
  980. unsigned long arg)
  981. {
  982. void __user *argp = (void __user *)arg;
  983. struct iw_request_info info;
  984. struct iwreq iwr;
  985. char *colon;
  986. int ret;
  987. if (copy_from_user(&iwr, argp, sizeof(struct iwreq)))
  988. return -EFAULT;
  989. iwr.ifr_name[IFNAMSIZ-1] = 0;
  990. colon = strchr(iwr.ifr_name, ':');
  991. if (colon)
  992. *colon = 0;
  993. info.cmd = cmd;
  994. info.flags = IW_REQUEST_FLAG_COMPAT;
  995. ret = wext_ioctl_dispatch(net, &iwr, cmd, &info,
  996. compat_standard_call,
  997. compat_private_call);
  998. if (ret >= 0 &&
  999. IW_IS_GET(cmd) &&
  1000. copy_to_user(argp, &iwr, sizeof(struct iwreq)))
  1001. return -EFAULT;
  1002. return ret;
  1003. }
  1004. #endif
  1005. char *iwe_stream_add_event(struct iw_request_info *info, char *stream,
  1006. char *ends, struct iw_event *iwe, int event_len)
  1007. {
  1008. int lcp_len = iwe_stream_lcp_len(info);
  1009. event_len = iwe_stream_event_len_adjust(info, event_len);
  1010. /* Check if it's possible */
  1011. if (likely((stream + event_len) < ends)) {
  1012. iwe->len = event_len;
  1013. /* Beware of alignement issues on 64 bits */
  1014. memcpy(stream, (char *) iwe, IW_EV_LCP_PK_LEN);
  1015. memcpy(stream + lcp_len, &iwe->u,
  1016. event_len - lcp_len);
  1017. stream += event_len;
  1018. }
  1019. return stream;
  1020. }
  1021. EXPORT_SYMBOL(iwe_stream_add_event);
  1022. char *iwe_stream_add_point(struct iw_request_info *info, char *stream,
  1023. char *ends, struct iw_event *iwe, char *extra)
  1024. {
  1025. int event_len = iwe_stream_point_len(info) + iwe->u.data.length;
  1026. int point_len = iwe_stream_point_len(info);
  1027. int lcp_len = iwe_stream_lcp_len(info);
  1028. /* Check if it's possible */
  1029. if (likely((stream + event_len) < ends)) {
  1030. iwe->len = event_len;
  1031. memcpy(stream, (char *) iwe, IW_EV_LCP_PK_LEN);
  1032. memcpy(stream + lcp_len,
  1033. ((char *) &iwe->u) + IW_EV_POINT_OFF,
  1034. IW_EV_POINT_PK_LEN - IW_EV_LCP_PK_LEN);
  1035. if (iwe->u.data.length && extra)
  1036. memcpy(stream + point_len, extra, iwe->u.data.length);
  1037. stream += event_len;
  1038. }
  1039. return stream;
  1040. }
  1041. EXPORT_SYMBOL(iwe_stream_add_point);
  1042. char *iwe_stream_add_value(struct iw_request_info *info, char *event,
  1043. char *value, char *ends, struct iw_event *iwe,
  1044. int event_len)
  1045. {
  1046. int lcp_len = iwe_stream_lcp_len(info);
  1047. /* Don't duplicate LCP */
  1048. event_len -= IW_EV_LCP_LEN;
  1049. /* Check if it's possible */
  1050. if (likely((value + event_len) < ends)) {
  1051. /* Add new value */
  1052. memcpy(value, &iwe->u, event_len);
  1053. value += event_len;
  1054. /* Patch LCP */
  1055. iwe->len = value - event;
  1056. memcpy(event, (char *) iwe, lcp_len);
  1057. }
  1058. return value;
  1059. }
  1060. EXPORT_SYMBOL(iwe_stream_add_value);