nl802154.c 69 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. *
  4. * Authors:
  5. * Alexander Aring <aar@pengutronix.de>
  6. *
  7. * Based on: net/wireless/nl80211.c
  8. */
  9. #include <linux/rtnetlink.h>
  10. #include <net/cfg802154.h>
  11. #include <net/genetlink.h>
  12. #include <net/mac802154.h>
  13. #include <net/netlink.h>
  14. #include <net/nl802154.h>
  15. #include <net/sock.h>
  16. #include "nl802154.h"
  17. #include "rdev-ops.h"
  18. #include "core.h"
  19. /* the netlink family */
  20. static struct genl_family nl802154_fam;
  21. /* multicast groups */
  22. enum nl802154_multicast_groups {
  23. NL802154_MCGRP_CONFIG,
  24. };
  25. static const struct genl_multicast_group nl802154_mcgrps[] = {
  26. [NL802154_MCGRP_CONFIG] = { .name = "config", },
  27. };
  28. /* returns ERR_PTR values */
  29. static struct wpan_dev *
  30. __cfg802154_wpan_dev_from_attrs(struct net *netns, struct nlattr **attrs)
  31. {
  32. struct cfg802154_registered_device *rdev;
  33. struct wpan_dev *result = NULL;
  34. bool have_ifidx = attrs[NL802154_ATTR_IFINDEX];
  35. bool have_wpan_dev_id = attrs[NL802154_ATTR_WPAN_DEV];
  36. u64 wpan_dev_id;
  37. int wpan_phy_idx = -1;
  38. int ifidx = -1;
  39. ASSERT_RTNL();
  40. if (!have_ifidx && !have_wpan_dev_id)
  41. return ERR_PTR(-EINVAL);
  42. if (have_ifidx)
  43. ifidx = nla_get_u32(attrs[NL802154_ATTR_IFINDEX]);
  44. if (have_wpan_dev_id) {
  45. wpan_dev_id = nla_get_u64(attrs[NL802154_ATTR_WPAN_DEV]);
  46. wpan_phy_idx = wpan_dev_id >> 32;
  47. }
  48. list_for_each_entry(rdev, &cfg802154_rdev_list, list) {
  49. struct wpan_dev *wpan_dev;
  50. if (wpan_phy_net(&rdev->wpan_phy) != netns)
  51. continue;
  52. if (have_wpan_dev_id && rdev->wpan_phy_idx != wpan_phy_idx)
  53. continue;
  54. list_for_each_entry(wpan_dev, &rdev->wpan_dev_list, list) {
  55. if (have_ifidx && wpan_dev->netdev &&
  56. wpan_dev->netdev->ifindex == ifidx) {
  57. result = wpan_dev;
  58. break;
  59. }
  60. if (have_wpan_dev_id &&
  61. wpan_dev->identifier == (u32)wpan_dev_id) {
  62. result = wpan_dev;
  63. break;
  64. }
  65. }
  66. if (result)
  67. break;
  68. }
  69. if (result)
  70. return result;
  71. return ERR_PTR(-ENODEV);
  72. }
  73. static struct cfg802154_registered_device *
  74. __cfg802154_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
  75. {
  76. struct cfg802154_registered_device *rdev = NULL, *tmp;
  77. struct net_device *netdev;
  78. ASSERT_RTNL();
  79. if (!attrs[NL802154_ATTR_WPAN_PHY] &&
  80. !attrs[NL802154_ATTR_IFINDEX] &&
  81. !attrs[NL802154_ATTR_WPAN_DEV])
  82. return ERR_PTR(-EINVAL);
  83. if (attrs[NL802154_ATTR_WPAN_PHY])
  84. rdev = cfg802154_rdev_by_wpan_phy_idx(
  85. nla_get_u32(attrs[NL802154_ATTR_WPAN_PHY]));
  86. if (attrs[NL802154_ATTR_WPAN_DEV]) {
  87. u64 wpan_dev_id = nla_get_u64(attrs[NL802154_ATTR_WPAN_DEV]);
  88. struct wpan_dev *wpan_dev;
  89. bool found = false;
  90. tmp = cfg802154_rdev_by_wpan_phy_idx(wpan_dev_id >> 32);
  91. if (tmp) {
  92. /* make sure wpan_dev exists */
  93. list_for_each_entry(wpan_dev, &tmp->wpan_dev_list, list) {
  94. if (wpan_dev->identifier != (u32)wpan_dev_id)
  95. continue;
  96. found = true;
  97. break;
  98. }
  99. if (!found)
  100. tmp = NULL;
  101. if (rdev && tmp != rdev)
  102. return ERR_PTR(-EINVAL);
  103. rdev = tmp;
  104. }
  105. }
  106. if (attrs[NL802154_ATTR_IFINDEX]) {
  107. int ifindex = nla_get_u32(attrs[NL802154_ATTR_IFINDEX]);
  108. netdev = __dev_get_by_index(netns, ifindex);
  109. if (netdev) {
  110. if (netdev->ieee802154_ptr)
  111. tmp = wpan_phy_to_rdev(
  112. netdev->ieee802154_ptr->wpan_phy);
  113. else
  114. tmp = NULL;
  115. /* not wireless device -- return error */
  116. if (!tmp)
  117. return ERR_PTR(-EINVAL);
  118. /* mismatch -- return error */
  119. if (rdev && tmp != rdev)
  120. return ERR_PTR(-EINVAL);
  121. rdev = tmp;
  122. }
  123. }
  124. if (!rdev)
  125. return ERR_PTR(-ENODEV);
  126. if (netns != wpan_phy_net(&rdev->wpan_phy))
  127. return ERR_PTR(-ENODEV);
  128. return rdev;
  129. }
  130. /* This function returns a pointer to the driver
  131. * that the genl_info item that is passed refers to.
  132. *
  133. * The result of this can be a PTR_ERR and hence must
  134. * be checked with IS_ERR() for errors.
  135. */
  136. static struct cfg802154_registered_device *
  137. cfg802154_get_dev_from_info(struct net *netns, struct genl_info *info)
  138. {
  139. return __cfg802154_rdev_from_attrs(netns, info->attrs);
  140. }
  141. /* policy for the attributes */
  142. static const struct nla_policy nl802154_policy[NL802154_ATTR_MAX+1] = {
  143. [NL802154_ATTR_WPAN_PHY] = { .type = NLA_U32 },
  144. [NL802154_ATTR_WPAN_PHY_NAME] = { .type = NLA_NUL_STRING,
  145. .len = 20-1 },
  146. [NL802154_ATTR_IFINDEX] = { .type = NLA_U32 },
  147. [NL802154_ATTR_IFTYPE] = { .type = NLA_U32 },
  148. [NL802154_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
  149. [NL802154_ATTR_WPAN_DEV] = { .type = NLA_U64 },
  150. [NL802154_ATTR_PAGE] = { .type = NLA_U8, },
  151. [NL802154_ATTR_CHANNEL] = { .type = NLA_U8, },
  152. [NL802154_ATTR_TX_POWER] = { .type = NLA_S32, },
  153. [NL802154_ATTR_CCA_MODE] = { .type = NLA_U32, },
  154. [NL802154_ATTR_CCA_OPT] = { .type = NLA_U32, },
  155. [NL802154_ATTR_CCA_ED_LEVEL] = { .type = NLA_S32, },
  156. [NL802154_ATTR_SUPPORTED_CHANNEL] = { .type = NLA_U32, },
  157. [NL802154_ATTR_PAN_ID] = { .type = NLA_U16, },
  158. [NL802154_ATTR_EXTENDED_ADDR] = { .type = NLA_U64 },
  159. [NL802154_ATTR_SHORT_ADDR] = { .type = NLA_U16, },
  160. [NL802154_ATTR_MIN_BE] = { .type = NLA_U8, },
  161. [NL802154_ATTR_MAX_BE] = { .type = NLA_U8, },
  162. [NL802154_ATTR_MAX_CSMA_BACKOFFS] = { .type = NLA_U8, },
  163. [NL802154_ATTR_MAX_FRAME_RETRIES] = { .type = NLA_S8, },
  164. [NL802154_ATTR_LBT_MODE] = { .type = NLA_U8, },
  165. [NL802154_ATTR_WPAN_PHY_CAPS] = { .type = NLA_NESTED },
  166. [NL802154_ATTR_SUPPORTED_COMMANDS] = { .type = NLA_NESTED },
  167. [NL802154_ATTR_ACKREQ_DEFAULT] = { .type = NLA_U8 },
  168. [NL802154_ATTR_PID] = { .type = NLA_U32 },
  169. [NL802154_ATTR_NETNS_FD] = { .type = NLA_U32 },
  170. #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
  171. [NL802154_ATTR_SEC_ENABLED] = { .type = NLA_U8, },
  172. [NL802154_ATTR_SEC_OUT_LEVEL] = { .type = NLA_U32, },
  173. [NL802154_ATTR_SEC_OUT_KEY_ID] = { .type = NLA_NESTED, },
  174. [NL802154_ATTR_SEC_FRAME_COUNTER] = { .type = NLA_U32 },
  175. [NL802154_ATTR_SEC_LEVEL] = { .type = NLA_NESTED },
  176. [NL802154_ATTR_SEC_DEVICE] = { .type = NLA_NESTED },
  177. [NL802154_ATTR_SEC_DEVKEY] = { .type = NLA_NESTED },
  178. [NL802154_ATTR_SEC_KEY] = { .type = NLA_NESTED },
  179. #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
  180. };
  181. #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
  182. static int
  183. nl802154_prepare_wpan_dev_dump(struct sk_buff *skb,
  184. struct netlink_callback *cb,
  185. struct cfg802154_registered_device **rdev,
  186. struct wpan_dev **wpan_dev)
  187. {
  188. const struct genl_dumpit_info *info = genl_dumpit_info(cb);
  189. int err;
  190. rtnl_lock();
  191. if (!cb->args[0]) {
  192. *wpan_dev = __cfg802154_wpan_dev_from_attrs(sock_net(skb->sk),
  193. info->attrs);
  194. if (IS_ERR(*wpan_dev)) {
  195. err = PTR_ERR(*wpan_dev);
  196. goto out_unlock;
  197. }
  198. *rdev = wpan_phy_to_rdev((*wpan_dev)->wpan_phy);
  199. /* 0 is the first index - add 1 to parse only once */
  200. cb->args[0] = (*rdev)->wpan_phy_idx + 1;
  201. cb->args[1] = (*wpan_dev)->identifier;
  202. } else {
  203. /* subtract the 1 again here */
  204. struct wpan_phy *wpan_phy = wpan_phy_idx_to_wpan_phy(cb->args[0] - 1);
  205. struct wpan_dev *tmp;
  206. if (!wpan_phy) {
  207. err = -ENODEV;
  208. goto out_unlock;
  209. }
  210. *rdev = wpan_phy_to_rdev(wpan_phy);
  211. *wpan_dev = NULL;
  212. list_for_each_entry(tmp, &(*rdev)->wpan_dev_list, list) {
  213. if (tmp->identifier == cb->args[1]) {
  214. *wpan_dev = tmp;
  215. break;
  216. }
  217. }
  218. if (!*wpan_dev) {
  219. err = -ENODEV;
  220. goto out_unlock;
  221. }
  222. }
  223. return 0;
  224. out_unlock:
  225. rtnl_unlock();
  226. return err;
  227. }
  228. static void
  229. nl802154_finish_wpan_dev_dump(struct cfg802154_registered_device *rdev)
  230. {
  231. rtnl_unlock();
  232. }
  233. #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
  234. /* message building helper */
  235. static inline void *nl802154hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
  236. int flags, u8 cmd)
  237. {
  238. /* since there is no private header just add the generic one */
  239. return genlmsg_put(skb, portid, seq, &nl802154_fam, flags, cmd);
  240. }
  241. static int
  242. nl802154_put_flags(struct sk_buff *msg, int attr, u32 mask)
  243. {
  244. struct nlattr *nl_flags = nla_nest_start_noflag(msg, attr);
  245. int i;
  246. if (!nl_flags)
  247. return -ENOBUFS;
  248. i = 0;
  249. while (mask) {
  250. if ((mask & 1) && nla_put_flag(msg, i))
  251. return -ENOBUFS;
  252. mask >>= 1;
  253. i++;
  254. }
  255. nla_nest_end(msg, nl_flags);
  256. return 0;
  257. }
  258. static int
  259. nl802154_send_wpan_phy_channels(struct cfg802154_registered_device *rdev,
  260. struct sk_buff *msg)
  261. {
  262. struct nlattr *nl_page;
  263. unsigned long page;
  264. nl_page = nla_nest_start_noflag(msg, NL802154_ATTR_CHANNELS_SUPPORTED);
  265. if (!nl_page)
  266. return -ENOBUFS;
  267. for (page = 0; page <= IEEE802154_MAX_PAGE; page++) {
  268. if (nla_put_u32(msg, NL802154_ATTR_SUPPORTED_CHANNEL,
  269. rdev->wpan_phy.supported.channels[page]))
  270. return -ENOBUFS;
  271. }
  272. nla_nest_end(msg, nl_page);
  273. return 0;
  274. }
  275. static int
  276. nl802154_put_capabilities(struct sk_buff *msg,
  277. struct cfg802154_registered_device *rdev)
  278. {
  279. const struct wpan_phy_supported *caps = &rdev->wpan_phy.supported;
  280. struct nlattr *nl_caps, *nl_channels;
  281. int i;
  282. nl_caps = nla_nest_start_noflag(msg, NL802154_ATTR_WPAN_PHY_CAPS);
  283. if (!nl_caps)
  284. return -ENOBUFS;
  285. nl_channels = nla_nest_start_noflag(msg, NL802154_CAP_ATTR_CHANNELS);
  286. if (!nl_channels)
  287. return -ENOBUFS;
  288. for (i = 0; i <= IEEE802154_MAX_PAGE; i++) {
  289. if (caps->channels[i]) {
  290. if (nl802154_put_flags(msg, i, caps->channels[i]))
  291. return -ENOBUFS;
  292. }
  293. }
  294. nla_nest_end(msg, nl_channels);
  295. if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_ED_LEVEL) {
  296. struct nlattr *nl_ed_lvls;
  297. nl_ed_lvls = nla_nest_start_noflag(msg,
  298. NL802154_CAP_ATTR_CCA_ED_LEVELS);
  299. if (!nl_ed_lvls)
  300. return -ENOBUFS;
  301. for (i = 0; i < caps->cca_ed_levels_size; i++) {
  302. if (nla_put_s32(msg, i, caps->cca_ed_levels[i]))
  303. return -ENOBUFS;
  304. }
  305. nla_nest_end(msg, nl_ed_lvls);
  306. }
  307. if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_TXPOWER) {
  308. struct nlattr *nl_tx_pwrs;
  309. nl_tx_pwrs = nla_nest_start_noflag(msg,
  310. NL802154_CAP_ATTR_TX_POWERS);
  311. if (!nl_tx_pwrs)
  312. return -ENOBUFS;
  313. for (i = 0; i < caps->tx_powers_size; i++) {
  314. if (nla_put_s32(msg, i, caps->tx_powers[i]))
  315. return -ENOBUFS;
  316. }
  317. nla_nest_end(msg, nl_tx_pwrs);
  318. }
  319. if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_MODE) {
  320. if (nl802154_put_flags(msg, NL802154_CAP_ATTR_CCA_MODES,
  321. caps->cca_modes) ||
  322. nl802154_put_flags(msg, NL802154_CAP_ATTR_CCA_OPTS,
  323. caps->cca_opts))
  324. return -ENOBUFS;
  325. }
  326. if (nla_put_u8(msg, NL802154_CAP_ATTR_MIN_MINBE, caps->min_minbe) ||
  327. nla_put_u8(msg, NL802154_CAP_ATTR_MAX_MINBE, caps->max_minbe) ||
  328. nla_put_u8(msg, NL802154_CAP_ATTR_MIN_MAXBE, caps->min_maxbe) ||
  329. nla_put_u8(msg, NL802154_CAP_ATTR_MAX_MAXBE, caps->max_maxbe) ||
  330. nla_put_u8(msg, NL802154_CAP_ATTR_MIN_CSMA_BACKOFFS,
  331. caps->min_csma_backoffs) ||
  332. nla_put_u8(msg, NL802154_CAP_ATTR_MAX_CSMA_BACKOFFS,
  333. caps->max_csma_backoffs) ||
  334. nla_put_s8(msg, NL802154_CAP_ATTR_MIN_FRAME_RETRIES,
  335. caps->min_frame_retries) ||
  336. nla_put_s8(msg, NL802154_CAP_ATTR_MAX_FRAME_RETRIES,
  337. caps->max_frame_retries) ||
  338. nl802154_put_flags(msg, NL802154_CAP_ATTR_IFTYPES,
  339. caps->iftypes) ||
  340. nla_put_u32(msg, NL802154_CAP_ATTR_LBT, caps->lbt))
  341. return -ENOBUFS;
  342. nla_nest_end(msg, nl_caps);
  343. return 0;
  344. }
  345. static int nl802154_send_wpan_phy(struct cfg802154_registered_device *rdev,
  346. enum nl802154_commands cmd,
  347. struct sk_buff *msg, u32 portid, u32 seq,
  348. int flags)
  349. {
  350. struct nlattr *nl_cmds;
  351. void *hdr;
  352. int i;
  353. hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
  354. if (!hdr)
  355. return -ENOBUFS;
  356. if (nla_put_u32(msg, NL802154_ATTR_WPAN_PHY, rdev->wpan_phy_idx) ||
  357. nla_put_string(msg, NL802154_ATTR_WPAN_PHY_NAME,
  358. wpan_phy_name(&rdev->wpan_phy)) ||
  359. nla_put_u32(msg, NL802154_ATTR_GENERATION,
  360. cfg802154_rdev_list_generation))
  361. goto nla_put_failure;
  362. if (cmd != NL802154_CMD_NEW_WPAN_PHY)
  363. goto finish;
  364. /* DUMP PHY PIB */
  365. /* current channel settings */
  366. if (nla_put_u8(msg, NL802154_ATTR_PAGE,
  367. rdev->wpan_phy.current_page) ||
  368. nla_put_u8(msg, NL802154_ATTR_CHANNEL,
  369. rdev->wpan_phy.current_channel))
  370. goto nla_put_failure;
  371. /* TODO remove this behaviour, we still keep support it for a while
  372. * so users can change the behaviour to the new one.
  373. */
  374. if (nl802154_send_wpan_phy_channels(rdev, msg))
  375. goto nla_put_failure;
  376. /* cca mode */
  377. if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_MODE) {
  378. if (nla_put_u32(msg, NL802154_ATTR_CCA_MODE,
  379. rdev->wpan_phy.cca.mode))
  380. goto nla_put_failure;
  381. if (rdev->wpan_phy.cca.mode == NL802154_CCA_ENERGY_CARRIER) {
  382. if (nla_put_u32(msg, NL802154_ATTR_CCA_OPT,
  383. rdev->wpan_phy.cca.opt))
  384. goto nla_put_failure;
  385. }
  386. }
  387. if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_TXPOWER) {
  388. if (nla_put_s32(msg, NL802154_ATTR_TX_POWER,
  389. rdev->wpan_phy.transmit_power))
  390. goto nla_put_failure;
  391. }
  392. if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_ED_LEVEL) {
  393. if (nla_put_s32(msg, NL802154_ATTR_CCA_ED_LEVEL,
  394. rdev->wpan_phy.cca_ed_level))
  395. goto nla_put_failure;
  396. }
  397. if (nl802154_put_capabilities(msg, rdev))
  398. goto nla_put_failure;
  399. nl_cmds = nla_nest_start_noflag(msg, NL802154_ATTR_SUPPORTED_COMMANDS);
  400. if (!nl_cmds)
  401. goto nla_put_failure;
  402. i = 0;
  403. #define CMD(op, n) \
  404. do { \
  405. if (rdev->ops->op) { \
  406. i++; \
  407. if (nla_put_u32(msg, i, NL802154_CMD_ ## n)) \
  408. goto nla_put_failure; \
  409. } \
  410. } while (0)
  411. CMD(add_virtual_intf, NEW_INTERFACE);
  412. CMD(del_virtual_intf, DEL_INTERFACE);
  413. CMD(set_channel, SET_CHANNEL);
  414. CMD(set_pan_id, SET_PAN_ID);
  415. CMD(set_short_addr, SET_SHORT_ADDR);
  416. CMD(set_backoff_exponent, SET_BACKOFF_EXPONENT);
  417. CMD(set_max_csma_backoffs, SET_MAX_CSMA_BACKOFFS);
  418. CMD(set_max_frame_retries, SET_MAX_FRAME_RETRIES);
  419. CMD(set_lbt_mode, SET_LBT_MODE);
  420. CMD(set_ackreq_default, SET_ACKREQ_DEFAULT);
  421. if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_TXPOWER)
  422. CMD(set_tx_power, SET_TX_POWER);
  423. if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_ED_LEVEL)
  424. CMD(set_cca_ed_level, SET_CCA_ED_LEVEL);
  425. if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_MODE)
  426. CMD(set_cca_mode, SET_CCA_MODE);
  427. #undef CMD
  428. nla_nest_end(msg, nl_cmds);
  429. finish:
  430. genlmsg_end(msg, hdr);
  431. return 0;
  432. nla_put_failure:
  433. genlmsg_cancel(msg, hdr);
  434. return -EMSGSIZE;
  435. }
  436. struct nl802154_dump_wpan_phy_state {
  437. s64 filter_wpan_phy;
  438. long start;
  439. };
  440. static int nl802154_dump_wpan_phy_parse(struct sk_buff *skb,
  441. struct netlink_callback *cb,
  442. struct nl802154_dump_wpan_phy_state *state)
  443. {
  444. const struct genl_dumpit_info *info = genl_dumpit_info(cb);
  445. struct nlattr **tb = info->attrs;
  446. if (tb[NL802154_ATTR_WPAN_PHY])
  447. state->filter_wpan_phy = nla_get_u32(tb[NL802154_ATTR_WPAN_PHY]);
  448. if (tb[NL802154_ATTR_WPAN_DEV])
  449. state->filter_wpan_phy = nla_get_u64(tb[NL802154_ATTR_WPAN_DEV]) >> 32;
  450. if (tb[NL802154_ATTR_IFINDEX]) {
  451. struct net_device *netdev;
  452. struct cfg802154_registered_device *rdev;
  453. int ifidx = nla_get_u32(tb[NL802154_ATTR_IFINDEX]);
  454. netdev = __dev_get_by_index(&init_net, ifidx);
  455. if (!netdev)
  456. return -ENODEV;
  457. if (netdev->ieee802154_ptr) {
  458. rdev = wpan_phy_to_rdev(
  459. netdev->ieee802154_ptr->wpan_phy);
  460. state->filter_wpan_phy = rdev->wpan_phy_idx;
  461. }
  462. }
  463. return 0;
  464. }
  465. static int
  466. nl802154_dump_wpan_phy(struct sk_buff *skb, struct netlink_callback *cb)
  467. {
  468. int idx = 0, ret;
  469. struct nl802154_dump_wpan_phy_state *state = (void *)cb->args[0];
  470. struct cfg802154_registered_device *rdev;
  471. rtnl_lock();
  472. if (!state) {
  473. state = kzalloc(sizeof(*state), GFP_KERNEL);
  474. if (!state) {
  475. rtnl_unlock();
  476. return -ENOMEM;
  477. }
  478. state->filter_wpan_phy = -1;
  479. ret = nl802154_dump_wpan_phy_parse(skb, cb, state);
  480. if (ret) {
  481. kfree(state);
  482. rtnl_unlock();
  483. return ret;
  484. }
  485. cb->args[0] = (long)state;
  486. }
  487. list_for_each_entry(rdev, &cfg802154_rdev_list, list) {
  488. if (!net_eq(wpan_phy_net(&rdev->wpan_phy), sock_net(skb->sk)))
  489. continue;
  490. if (++idx <= state->start)
  491. continue;
  492. if (state->filter_wpan_phy != -1 &&
  493. state->filter_wpan_phy != rdev->wpan_phy_idx)
  494. continue;
  495. /* attempt to fit multiple wpan_phy data chunks into the skb */
  496. ret = nl802154_send_wpan_phy(rdev,
  497. NL802154_CMD_NEW_WPAN_PHY,
  498. skb,
  499. NETLINK_CB(cb->skb).portid,
  500. cb->nlh->nlmsg_seq, NLM_F_MULTI);
  501. if (ret < 0) {
  502. if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
  503. !skb->len && cb->min_dump_alloc < 4096) {
  504. cb->min_dump_alloc = 4096;
  505. rtnl_unlock();
  506. return 1;
  507. }
  508. idx--;
  509. break;
  510. }
  511. break;
  512. }
  513. rtnl_unlock();
  514. state->start = idx;
  515. return skb->len;
  516. }
  517. static int nl802154_dump_wpan_phy_done(struct netlink_callback *cb)
  518. {
  519. kfree((void *)cb->args[0]);
  520. return 0;
  521. }
  522. static int nl802154_get_wpan_phy(struct sk_buff *skb, struct genl_info *info)
  523. {
  524. struct sk_buff *msg;
  525. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  526. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  527. if (!msg)
  528. return -ENOMEM;
  529. if (nl802154_send_wpan_phy(rdev, NL802154_CMD_NEW_WPAN_PHY, msg,
  530. info->snd_portid, info->snd_seq, 0) < 0) {
  531. nlmsg_free(msg);
  532. return -ENOBUFS;
  533. }
  534. return genlmsg_reply(msg, info);
  535. }
  536. static inline u64 wpan_dev_id(struct wpan_dev *wpan_dev)
  537. {
  538. return (u64)wpan_dev->identifier |
  539. ((u64)wpan_phy_to_rdev(wpan_dev->wpan_phy)->wpan_phy_idx << 32);
  540. }
  541. #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
  542. #include <net/ieee802154_netdev.h>
  543. static int
  544. ieee802154_llsec_send_key_id(struct sk_buff *msg,
  545. const struct ieee802154_llsec_key_id *desc)
  546. {
  547. struct nlattr *nl_dev_addr;
  548. if (nla_put_u32(msg, NL802154_KEY_ID_ATTR_MODE, desc->mode))
  549. return -ENOBUFS;
  550. switch (desc->mode) {
  551. case NL802154_KEY_ID_MODE_IMPLICIT:
  552. nl_dev_addr = nla_nest_start_noflag(msg,
  553. NL802154_KEY_ID_ATTR_IMPLICIT);
  554. if (!nl_dev_addr)
  555. return -ENOBUFS;
  556. if (nla_put_le16(msg, NL802154_DEV_ADDR_ATTR_PAN_ID,
  557. desc->device_addr.pan_id) ||
  558. nla_put_u32(msg, NL802154_DEV_ADDR_ATTR_MODE,
  559. desc->device_addr.mode))
  560. return -ENOBUFS;
  561. switch (desc->device_addr.mode) {
  562. case NL802154_DEV_ADDR_SHORT:
  563. if (nla_put_le16(msg, NL802154_DEV_ADDR_ATTR_SHORT,
  564. desc->device_addr.short_addr))
  565. return -ENOBUFS;
  566. break;
  567. case NL802154_DEV_ADDR_EXTENDED:
  568. if (nla_put_le64(msg, NL802154_DEV_ADDR_ATTR_EXTENDED,
  569. desc->device_addr.extended_addr,
  570. NL802154_DEV_ADDR_ATTR_PAD))
  571. return -ENOBUFS;
  572. break;
  573. default:
  574. /* userspace should handle unknown */
  575. break;
  576. }
  577. nla_nest_end(msg, nl_dev_addr);
  578. break;
  579. case NL802154_KEY_ID_MODE_INDEX:
  580. break;
  581. case NL802154_KEY_ID_MODE_INDEX_SHORT:
  582. /* TODO renmae short_source? */
  583. if (nla_put_le32(msg, NL802154_KEY_ID_ATTR_SOURCE_SHORT,
  584. desc->short_source))
  585. return -ENOBUFS;
  586. break;
  587. case NL802154_KEY_ID_MODE_INDEX_EXTENDED:
  588. if (nla_put_le64(msg, NL802154_KEY_ID_ATTR_SOURCE_EXTENDED,
  589. desc->extended_source,
  590. NL802154_KEY_ID_ATTR_PAD))
  591. return -ENOBUFS;
  592. break;
  593. default:
  594. /* userspace should handle unknown */
  595. break;
  596. }
  597. /* TODO key_id to key_idx ? Check naming */
  598. if (desc->mode != NL802154_KEY_ID_MODE_IMPLICIT) {
  599. if (nla_put_u8(msg, NL802154_KEY_ID_ATTR_INDEX, desc->id))
  600. return -ENOBUFS;
  601. }
  602. return 0;
  603. }
  604. static int nl802154_get_llsec_params(struct sk_buff *msg,
  605. struct cfg802154_registered_device *rdev,
  606. struct wpan_dev *wpan_dev)
  607. {
  608. struct nlattr *nl_key_id;
  609. struct ieee802154_llsec_params params;
  610. int ret;
  611. ret = rdev_get_llsec_params(rdev, wpan_dev, &params);
  612. if (ret < 0)
  613. return ret;
  614. if (nla_put_u8(msg, NL802154_ATTR_SEC_ENABLED, params.enabled) ||
  615. nla_put_u32(msg, NL802154_ATTR_SEC_OUT_LEVEL, params.out_level) ||
  616. nla_put_be32(msg, NL802154_ATTR_SEC_FRAME_COUNTER,
  617. params.frame_counter))
  618. return -ENOBUFS;
  619. nl_key_id = nla_nest_start_noflag(msg, NL802154_ATTR_SEC_OUT_KEY_ID);
  620. if (!nl_key_id)
  621. return -ENOBUFS;
  622. ret = ieee802154_llsec_send_key_id(msg, &params.out_key);
  623. if (ret < 0)
  624. return ret;
  625. nla_nest_end(msg, nl_key_id);
  626. return 0;
  627. }
  628. #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
  629. static int
  630. nl802154_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
  631. struct cfg802154_registered_device *rdev,
  632. struct wpan_dev *wpan_dev)
  633. {
  634. struct net_device *dev = wpan_dev->netdev;
  635. void *hdr;
  636. hdr = nl802154hdr_put(msg, portid, seq, flags,
  637. NL802154_CMD_NEW_INTERFACE);
  638. if (!hdr)
  639. return -1;
  640. if (dev &&
  641. (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex) ||
  642. nla_put_string(msg, NL802154_ATTR_IFNAME, dev->name)))
  643. goto nla_put_failure;
  644. if (nla_put_u32(msg, NL802154_ATTR_WPAN_PHY, rdev->wpan_phy_idx) ||
  645. nla_put_u32(msg, NL802154_ATTR_IFTYPE, wpan_dev->iftype) ||
  646. nla_put_u64_64bit(msg, NL802154_ATTR_WPAN_DEV,
  647. wpan_dev_id(wpan_dev), NL802154_ATTR_PAD) ||
  648. nla_put_u32(msg, NL802154_ATTR_GENERATION,
  649. rdev->devlist_generation ^
  650. (cfg802154_rdev_list_generation << 2)))
  651. goto nla_put_failure;
  652. /* address settings */
  653. if (nla_put_le64(msg, NL802154_ATTR_EXTENDED_ADDR,
  654. wpan_dev->extended_addr,
  655. NL802154_ATTR_PAD) ||
  656. nla_put_le16(msg, NL802154_ATTR_SHORT_ADDR,
  657. wpan_dev->short_addr) ||
  658. nla_put_le16(msg, NL802154_ATTR_PAN_ID, wpan_dev->pan_id))
  659. goto nla_put_failure;
  660. /* ARET handling */
  661. if (nla_put_s8(msg, NL802154_ATTR_MAX_FRAME_RETRIES,
  662. wpan_dev->frame_retries) ||
  663. nla_put_u8(msg, NL802154_ATTR_MAX_BE, wpan_dev->max_be) ||
  664. nla_put_u8(msg, NL802154_ATTR_MAX_CSMA_BACKOFFS,
  665. wpan_dev->csma_retries) ||
  666. nla_put_u8(msg, NL802154_ATTR_MIN_BE, wpan_dev->min_be))
  667. goto nla_put_failure;
  668. /* listen before transmit */
  669. if (nla_put_u8(msg, NL802154_ATTR_LBT_MODE, wpan_dev->lbt))
  670. goto nla_put_failure;
  671. /* ackreq default behaviour */
  672. if (nla_put_u8(msg, NL802154_ATTR_ACKREQ_DEFAULT, wpan_dev->ackreq))
  673. goto nla_put_failure;
  674. #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
  675. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  676. goto out;
  677. if (nl802154_get_llsec_params(msg, rdev, wpan_dev) < 0)
  678. goto nla_put_failure;
  679. out:
  680. #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
  681. genlmsg_end(msg, hdr);
  682. return 0;
  683. nla_put_failure:
  684. genlmsg_cancel(msg, hdr);
  685. return -EMSGSIZE;
  686. }
  687. static int
  688. nl802154_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
  689. {
  690. int wp_idx = 0;
  691. int if_idx = 0;
  692. int wp_start = cb->args[0];
  693. int if_start = cb->args[1];
  694. struct cfg802154_registered_device *rdev;
  695. struct wpan_dev *wpan_dev;
  696. rtnl_lock();
  697. list_for_each_entry(rdev, &cfg802154_rdev_list, list) {
  698. if (!net_eq(wpan_phy_net(&rdev->wpan_phy), sock_net(skb->sk)))
  699. continue;
  700. if (wp_idx < wp_start) {
  701. wp_idx++;
  702. continue;
  703. }
  704. if_idx = 0;
  705. list_for_each_entry(wpan_dev, &rdev->wpan_dev_list, list) {
  706. if (if_idx < if_start) {
  707. if_idx++;
  708. continue;
  709. }
  710. if (nl802154_send_iface(skb, NETLINK_CB(cb->skb).portid,
  711. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  712. rdev, wpan_dev) < 0) {
  713. goto out;
  714. }
  715. if_idx++;
  716. }
  717. wp_idx++;
  718. }
  719. out:
  720. rtnl_unlock();
  721. cb->args[0] = wp_idx;
  722. cb->args[1] = if_idx;
  723. return skb->len;
  724. }
  725. static int nl802154_get_interface(struct sk_buff *skb, struct genl_info *info)
  726. {
  727. struct sk_buff *msg;
  728. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  729. struct wpan_dev *wdev = info->user_ptr[1];
  730. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  731. if (!msg)
  732. return -ENOMEM;
  733. if (nl802154_send_iface(msg, info->snd_portid, info->snd_seq, 0,
  734. rdev, wdev) < 0) {
  735. nlmsg_free(msg);
  736. return -ENOBUFS;
  737. }
  738. return genlmsg_reply(msg, info);
  739. }
  740. static int nl802154_new_interface(struct sk_buff *skb, struct genl_info *info)
  741. {
  742. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  743. enum nl802154_iftype type = NL802154_IFTYPE_UNSPEC;
  744. __le64 extended_addr = cpu_to_le64(0x0000000000000000ULL);
  745. /* TODO avoid failing a new interface
  746. * creation due to pending removal?
  747. */
  748. if (!info->attrs[NL802154_ATTR_IFNAME])
  749. return -EINVAL;
  750. if (info->attrs[NL802154_ATTR_IFTYPE]) {
  751. type = nla_get_u32(info->attrs[NL802154_ATTR_IFTYPE]);
  752. if (type > NL802154_IFTYPE_MAX ||
  753. !(rdev->wpan_phy.supported.iftypes & BIT(type)))
  754. return -EINVAL;
  755. }
  756. if (info->attrs[NL802154_ATTR_EXTENDED_ADDR])
  757. extended_addr = nla_get_le64(info->attrs[NL802154_ATTR_EXTENDED_ADDR]);
  758. if (!rdev->ops->add_virtual_intf)
  759. return -EOPNOTSUPP;
  760. return rdev_add_virtual_intf(rdev,
  761. nla_data(info->attrs[NL802154_ATTR_IFNAME]),
  762. NET_NAME_USER, type, extended_addr);
  763. }
  764. static int nl802154_del_interface(struct sk_buff *skb, struct genl_info *info)
  765. {
  766. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  767. struct wpan_dev *wpan_dev = info->user_ptr[1];
  768. if (!rdev->ops->del_virtual_intf)
  769. return -EOPNOTSUPP;
  770. /* If we remove a wpan device without a netdev then clear
  771. * user_ptr[1] so that nl802154_post_doit won't dereference it
  772. * to check if it needs to do dev_put(). Otherwise it crashes
  773. * since the wpan_dev has been freed, unlike with a netdev where
  774. * we need the dev_put() for the netdev to really be freed.
  775. */
  776. if (!wpan_dev->netdev)
  777. info->user_ptr[1] = NULL;
  778. return rdev_del_virtual_intf(rdev, wpan_dev);
  779. }
  780. static int nl802154_set_channel(struct sk_buff *skb, struct genl_info *info)
  781. {
  782. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  783. u8 channel, page;
  784. if (!info->attrs[NL802154_ATTR_PAGE] ||
  785. !info->attrs[NL802154_ATTR_CHANNEL])
  786. return -EINVAL;
  787. page = nla_get_u8(info->attrs[NL802154_ATTR_PAGE]);
  788. channel = nla_get_u8(info->attrs[NL802154_ATTR_CHANNEL]);
  789. /* check 802.15.4 constraints */
  790. if (page > IEEE802154_MAX_PAGE || channel > IEEE802154_MAX_CHANNEL ||
  791. !(rdev->wpan_phy.supported.channels[page] & BIT(channel)))
  792. return -EINVAL;
  793. return rdev_set_channel(rdev, page, channel);
  794. }
  795. static int nl802154_set_cca_mode(struct sk_buff *skb, struct genl_info *info)
  796. {
  797. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  798. struct wpan_phy_cca cca;
  799. if (!(rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_MODE))
  800. return -EOPNOTSUPP;
  801. if (!info->attrs[NL802154_ATTR_CCA_MODE])
  802. return -EINVAL;
  803. cca.mode = nla_get_u32(info->attrs[NL802154_ATTR_CCA_MODE]);
  804. /* checking 802.15.4 constraints */
  805. if (cca.mode < NL802154_CCA_ENERGY ||
  806. cca.mode > NL802154_CCA_ATTR_MAX ||
  807. !(rdev->wpan_phy.supported.cca_modes & BIT(cca.mode)))
  808. return -EINVAL;
  809. if (cca.mode == NL802154_CCA_ENERGY_CARRIER) {
  810. if (!info->attrs[NL802154_ATTR_CCA_OPT])
  811. return -EINVAL;
  812. cca.opt = nla_get_u32(info->attrs[NL802154_ATTR_CCA_OPT]);
  813. if (cca.opt > NL802154_CCA_OPT_ATTR_MAX ||
  814. !(rdev->wpan_phy.supported.cca_opts & BIT(cca.opt)))
  815. return -EINVAL;
  816. }
  817. return rdev_set_cca_mode(rdev, &cca);
  818. }
  819. static int nl802154_set_cca_ed_level(struct sk_buff *skb, struct genl_info *info)
  820. {
  821. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  822. s32 ed_level;
  823. int i;
  824. if (!(rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_ED_LEVEL))
  825. return -EOPNOTSUPP;
  826. if (!info->attrs[NL802154_ATTR_CCA_ED_LEVEL])
  827. return -EINVAL;
  828. ed_level = nla_get_s32(info->attrs[NL802154_ATTR_CCA_ED_LEVEL]);
  829. for (i = 0; i < rdev->wpan_phy.supported.cca_ed_levels_size; i++) {
  830. if (ed_level == rdev->wpan_phy.supported.cca_ed_levels[i])
  831. return rdev_set_cca_ed_level(rdev, ed_level);
  832. }
  833. return -EINVAL;
  834. }
  835. static int nl802154_set_tx_power(struct sk_buff *skb, struct genl_info *info)
  836. {
  837. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  838. s32 power;
  839. int i;
  840. if (!(rdev->wpan_phy.flags & WPAN_PHY_FLAG_TXPOWER))
  841. return -EOPNOTSUPP;
  842. if (!info->attrs[NL802154_ATTR_TX_POWER])
  843. return -EINVAL;
  844. power = nla_get_s32(info->attrs[NL802154_ATTR_TX_POWER]);
  845. for (i = 0; i < rdev->wpan_phy.supported.tx_powers_size; i++) {
  846. if (power == rdev->wpan_phy.supported.tx_powers[i])
  847. return rdev_set_tx_power(rdev, power);
  848. }
  849. return -EINVAL;
  850. }
  851. static int nl802154_set_pan_id(struct sk_buff *skb, struct genl_info *info)
  852. {
  853. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  854. struct net_device *dev = info->user_ptr[1];
  855. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  856. __le16 pan_id;
  857. /* conflict here while tx/rx calls */
  858. if (netif_running(dev))
  859. return -EBUSY;
  860. if (wpan_dev->lowpan_dev) {
  861. if (netif_running(wpan_dev->lowpan_dev))
  862. return -EBUSY;
  863. }
  864. /* don't change address fields on monitor */
  865. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR ||
  866. !info->attrs[NL802154_ATTR_PAN_ID])
  867. return -EINVAL;
  868. pan_id = nla_get_le16(info->attrs[NL802154_ATTR_PAN_ID]);
  869. /* TODO
  870. * I am not sure about to check here on broadcast pan_id.
  871. * Broadcast is a valid setting, comment from 802.15.4:
  872. * If this value is 0xffff, the device is not associated.
  873. *
  874. * This could useful to simple deassociate an device.
  875. */
  876. if (pan_id == cpu_to_le16(IEEE802154_PAN_ID_BROADCAST))
  877. return -EINVAL;
  878. return rdev_set_pan_id(rdev, wpan_dev, pan_id);
  879. }
  880. static int nl802154_set_short_addr(struct sk_buff *skb, struct genl_info *info)
  881. {
  882. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  883. struct net_device *dev = info->user_ptr[1];
  884. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  885. __le16 short_addr;
  886. /* conflict here while tx/rx calls */
  887. if (netif_running(dev))
  888. return -EBUSY;
  889. if (wpan_dev->lowpan_dev) {
  890. if (netif_running(wpan_dev->lowpan_dev))
  891. return -EBUSY;
  892. }
  893. /* don't change address fields on monitor */
  894. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR ||
  895. !info->attrs[NL802154_ATTR_SHORT_ADDR])
  896. return -EINVAL;
  897. short_addr = nla_get_le16(info->attrs[NL802154_ATTR_SHORT_ADDR]);
  898. /* TODO
  899. * I am not sure about to check here on broadcast short_addr.
  900. * Broadcast is a valid setting, comment from 802.15.4:
  901. * A value of 0xfffe indicates that the device has
  902. * associated but has not been allocated an address. A
  903. * value of 0xffff indicates that the device does not
  904. * have a short address.
  905. *
  906. * I think we should allow to set these settings but
  907. * don't allow to allow socket communication with it.
  908. */
  909. if (short_addr == cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC) ||
  910. short_addr == cpu_to_le16(IEEE802154_ADDR_SHORT_BROADCAST))
  911. return -EINVAL;
  912. return rdev_set_short_addr(rdev, wpan_dev, short_addr);
  913. }
  914. static int
  915. nl802154_set_backoff_exponent(struct sk_buff *skb, struct genl_info *info)
  916. {
  917. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  918. struct net_device *dev = info->user_ptr[1];
  919. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  920. u8 min_be, max_be;
  921. /* should be set on netif open inside phy settings */
  922. if (netif_running(dev))
  923. return -EBUSY;
  924. if (!info->attrs[NL802154_ATTR_MIN_BE] ||
  925. !info->attrs[NL802154_ATTR_MAX_BE])
  926. return -EINVAL;
  927. min_be = nla_get_u8(info->attrs[NL802154_ATTR_MIN_BE]);
  928. max_be = nla_get_u8(info->attrs[NL802154_ATTR_MAX_BE]);
  929. /* check 802.15.4 constraints */
  930. if (min_be < rdev->wpan_phy.supported.min_minbe ||
  931. min_be > rdev->wpan_phy.supported.max_minbe ||
  932. max_be < rdev->wpan_phy.supported.min_maxbe ||
  933. max_be > rdev->wpan_phy.supported.max_maxbe ||
  934. min_be > max_be)
  935. return -EINVAL;
  936. return rdev_set_backoff_exponent(rdev, wpan_dev, min_be, max_be);
  937. }
  938. static int
  939. nl802154_set_max_csma_backoffs(struct sk_buff *skb, struct genl_info *info)
  940. {
  941. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  942. struct net_device *dev = info->user_ptr[1];
  943. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  944. u8 max_csma_backoffs;
  945. /* conflict here while other running iface settings */
  946. if (netif_running(dev))
  947. return -EBUSY;
  948. if (!info->attrs[NL802154_ATTR_MAX_CSMA_BACKOFFS])
  949. return -EINVAL;
  950. max_csma_backoffs = nla_get_u8(
  951. info->attrs[NL802154_ATTR_MAX_CSMA_BACKOFFS]);
  952. /* check 802.15.4 constraints */
  953. if (max_csma_backoffs < rdev->wpan_phy.supported.min_csma_backoffs ||
  954. max_csma_backoffs > rdev->wpan_phy.supported.max_csma_backoffs)
  955. return -EINVAL;
  956. return rdev_set_max_csma_backoffs(rdev, wpan_dev, max_csma_backoffs);
  957. }
  958. static int
  959. nl802154_set_max_frame_retries(struct sk_buff *skb, struct genl_info *info)
  960. {
  961. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  962. struct net_device *dev = info->user_ptr[1];
  963. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  964. s8 max_frame_retries;
  965. if (netif_running(dev))
  966. return -EBUSY;
  967. if (!info->attrs[NL802154_ATTR_MAX_FRAME_RETRIES])
  968. return -EINVAL;
  969. max_frame_retries = nla_get_s8(
  970. info->attrs[NL802154_ATTR_MAX_FRAME_RETRIES]);
  971. /* check 802.15.4 constraints */
  972. if (max_frame_retries < rdev->wpan_phy.supported.min_frame_retries ||
  973. max_frame_retries > rdev->wpan_phy.supported.max_frame_retries)
  974. return -EINVAL;
  975. return rdev_set_max_frame_retries(rdev, wpan_dev, max_frame_retries);
  976. }
  977. static int nl802154_set_lbt_mode(struct sk_buff *skb, struct genl_info *info)
  978. {
  979. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  980. struct net_device *dev = info->user_ptr[1];
  981. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  982. int mode;
  983. if (netif_running(dev))
  984. return -EBUSY;
  985. if (!info->attrs[NL802154_ATTR_LBT_MODE])
  986. return -EINVAL;
  987. mode = nla_get_u8(info->attrs[NL802154_ATTR_LBT_MODE]);
  988. if (mode != 0 && mode != 1)
  989. return -EINVAL;
  990. if (!wpan_phy_supported_bool(mode, rdev->wpan_phy.supported.lbt))
  991. return -EINVAL;
  992. return rdev_set_lbt_mode(rdev, wpan_dev, mode);
  993. }
  994. static int
  995. nl802154_set_ackreq_default(struct sk_buff *skb, struct genl_info *info)
  996. {
  997. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  998. struct net_device *dev = info->user_ptr[1];
  999. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1000. int ackreq;
  1001. if (netif_running(dev))
  1002. return -EBUSY;
  1003. if (!info->attrs[NL802154_ATTR_ACKREQ_DEFAULT])
  1004. return -EINVAL;
  1005. ackreq = nla_get_u8(info->attrs[NL802154_ATTR_ACKREQ_DEFAULT]);
  1006. if (ackreq != 0 && ackreq != 1)
  1007. return -EINVAL;
  1008. return rdev_set_ackreq_default(rdev, wpan_dev, ackreq);
  1009. }
  1010. static int nl802154_wpan_phy_netns(struct sk_buff *skb, struct genl_info *info)
  1011. {
  1012. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1013. struct net *net;
  1014. int err;
  1015. if (info->attrs[NL802154_ATTR_PID]) {
  1016. u32 pid = nla_get_u32(info->attrs[NL802154_ATTR_PID]);
  1017. net = get_net_ns_by_pid(pid);
  1018. } else if (info->attrs[NL802154_ATTR_NETNS_FD]) {
  1019. u32 fd = nla_get_u32(info->attrs[NL802154_ATTR_NETNS_FD]);
  1020. net = get_net_ns_by_fd(fd);
  1021. } else {
  1022. return -EINVAL;
  1023. }
  1024. if (IS_ERR(net))
  1025. return PTR_ERR(net);
  1026. err = 0;
  1027. /* check if anything to do */
  1028. if (!net_eq(wpan_phy_net(&rdev->wpan_phy), net))
  1029. err = cfg802154_switch_netns(rdev, net);
  1030. put_net(net);
  1031. return err;
  1032. }
  1033. #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
  1034. static const struct nla_policy nl802154_dev_addr_policy[NL802154_DEV_ADDR_ATTR_MAX + 1] = {
  1035. [NL802154_DEV_ADDR_ATTR_PAN_ID] = { .type = NLA_U16 },
  1036. [NL802154_DEV_ADDR_ATTR_MODE] = { .type = NLA_U32 },
  1037. [NL802154_DEV_ADDR_ATTR_SHORT] = { .type = NLA_U16 },
  1038. [NL802154_DEV_ADDR_ATTR_EXTENDED] = { .type = NLA_U64 },
  1039. };
  1040. static int
  1041. ieee802154_llsec_parse_dev_addr(struct nlattr *nla,
  1042. struct ieee802154_addr *addr)
  1043. {
  1044. struct nlattr *attrs[NL802154_DEV_ADDR_ATTR_MAX + 1];
  1045. if (!nla || nla_parse_nested_deprecated(attrs, NL802154_DEV_ADDR_ATTR_MAX, nla, nl802154_dev_addr_policy, NULL))
  1046. return -EINVAL;
  1047. if (!attrs[NL802154_DEV_ADDR_ATTR_PAN_ID] || !attrs[NL802154_DEV_ADDR_ATTR_MODE])
  1048. return -EINVAL;
  1049. addr->pan_id = nla_get_le16(attrs[NL802154_DEV_ADDR_ATTR_PAN_ID]);
  1050. addr->mode = nla_get_u32(attrs[NL802154_DEV_ADDR_ATTR_MODE]);
  1051. switch (addr->mode) {
  1052. case NL802154_DEV_ADDR_SHORT:
  1053. if (!attrs[NL802154_DEV_ADDR_ATTR_SHORT])
  1054. return -EINVAL;
  1055. addr->short_addr = nla_get_le16(attrs[NL802154_DEV_ADDR_ATTR_SHORT]);
  1056. break;
  1057. case NL802154_DEV_ADDR_EXTENDED:
  1058. if (!attrs[NL802154_DEV_ADDR_ATTR_EXTENDED])
  1059. return -EINVAL;
  1060. addr->extended_addr = nla_get_le64(attrs[NL802154_DEV_ADDR_ATTR_EXTENDED]);
  1061. break;
  1062. default:
  1063. return -EINVAL;
  1064. }
  1065. return 0;
  1066. }
  1067. static const struct nla_policy nl802154_key_id_policy[NL802154_KEY_ID_ATTR_MAX + 1] = {
  1068. [NL802154_KEY_ID_ATTR_MODE] = { .type = NLA_U32 },
  1069. [NL802154_KEY_ID_ATTR_INDEX] = { .type = NLA_U8 },
  1070. [NL802154_KEY_ID_ATTR_IMPLICIT] = { .type = NLA_NESTED },
  1071. [NL802154_KEY_ID_ATTR_SOURCE_SHORT] = { .type = NLA_U32 },
  1072. [NL802154_KEY_ID_ATTR_SOURCE_EXTENDED] = { .type = NLA_U64 },
  1073. };
  1074. static int
  1075. ieee802154_llsec_parse_key_id(struct nlattr *nla,
  1076. struct ieee802154_llsec_key_id *desc)
  1077. {
  1078. struct nlattr *attrs[NL802154_KEY_ID_ATTR_MAX + 1];
  1079. if (!nla || nla_parse_nested_deprecated(attrs, NL802154_KEY_ID_ATTR_MAX, nla, nl802154_key_id_policy, NULL))
  1080. return -EINVAL;
  1081. if (!attrs[NL802154_KEY_ID_ATTR_MODE])
  1082. return -EINVAL;
  1083. desc->mode = nla_get_u32(attrs[NL802154_KEY_ID_ATTR_MODE]);
  1084. switch (desc->mode) {
  1085. case NL802154_KEY_ID_MODE_IMPLICIT:
  1086. if (!attrs[NL802154_KEY_ID_ATTR_IMPLICIT])
  1087. return -EINVAL;
  1088. if (ieee802154_llsec_parse_dev_addr(attrs[NL802154_KEY_ID_ATTR_IMPLICIT],
  1089. &desc->device_addr) < 0)
  1090. return -EINVAL;
  1091. break;
  1092. case NL802154_KEY_ID_MODE_INDEX:
  1093. break;
  1094. case NL802154_KEY_ID_MODE_INDEX_SHORT:
  1095. if (!attrs[NL802154_KEY_ID_ATTR_SOURCE_SHORT])
  1096. return -EINVAL;
  1097. desc->short_source = nla_get_le32(attrs[NL802154_KEY_ID_ATTR_SOURCE_SHORT]);
  1098. break;
  1099. case NL802154_KEY_ID_MODE_INDEX_EXTENDED:
  1100. if (!attrs[NL802154_KEY_ID_ATTR_SOURCE_EXTENDED])
  1101. return -EINVAL;
  1102. desc->extended_source = nla_get_le64(attrs[NL802154_KEY_ID_ATTR_SOURCE_EXTENDED]);
  1103. break;
  1104. default:
  1105. return -EINVAL;
  1106. }
  1107. if (desc->mode != NL802154_KEY_ID_MODE_IMPLICIT) {
  1108. if (!attrs[NL802154_KEY_ID_ATTR_INDEX])
  1109. return -EINVAL;
  1110. /* TODO change id to idx */
  1111. desc->id = nla_get_u8(attrs[NL802154_KEY_ID_ATTR_INDEX]);
  1112. }
  1113. return 0;
  1114. }
  1115. static int nl802154_set_llsec_params(struct sk_buff *skb,
  1116. struct genl_info *info)
  1117. {
  1118. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1119. struct net_device *dev = info->user_ptr[1];
  1120. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1121. struct ieee802154_llsec_params params;
  1122. u32 changed = 0;
  1123. int ret;
  1124. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  1125. return -EOPNOTSUPP;
  1126. if (info->attrs[NL802154_ATTR_SEC_ENABLED]) {
  1127. u8 enabled;
  1128. enabled = nla_get_u8(info->attrs[NL802154_ATTR_SEC_ENABLED]);
  1129. if (enabled != 0 && enabled != 1)
  1130. return -EINVAL;
  1131. params.enabled = nla_get_u8(info->attrs[NL802154_ATTR_SEC_ENABLED]);
  1132. changed |= IEEE802154_LLSEC_PARAM_ENABLED;
  1133. }
  1134. if (info->attrs[NL802154_ATTR_SEC_OUT_KEY_ID]) {
  1135. ret = ieee802154_llsec_parse_key_id(info->attrs[NL802154_ATTR_SEC_OUT_KEY_ID],
  1136. &params.out_key);
  1137. if (ret < 0)
  1138. return ret;
  1139. changed |= IEEE802154_LLSEC_PARAM_OUT_KEY;
  1140. }
  1141. if (info->attrs[NL802154_ATTR_SEC_OUT_LEVEL]) {
  1142. params.out_level = nla_get_u32(info->attrs[NL802154_ATTR_SEC_OUT_LEVEL]);
  1143. if (params.out_level > NL802154_SECLEVEL_MAX)
  1144. return -EINVAL;
  1145. changed |= IEEE802154_LLSEC_PARAM_OUT_LEVEL;
  1146. }
  1147. if (info->attrs[NL802154_ATTR_SEC_FRAME_COUNTER]) {
  1148. params.frame_counter = nla_get_be32(info->attrs[NL802154_ATTR_SEC_FRAME_COUNTER]);
  1149. changed |= IEEE802154_LLSEC_PARAM_FRAME_COUNTER;
  1150. }
  1151. return rdev_set_llsec_params(rdev, wpan_dev, &params, changed);
  1152. }
  1153. static int nl802154_send_key(struct sk_buff *msg, u32 cmd, u32 portid,
  1154. u32 seq, int flags,
  1155. struct cfg802154_registered_device *rdev,
  1156. struct net_device *dev,
  1157. const struct ieee802154_llsec_key_entry *key)
  1158. {
  1159. void *hdr;
  1160. u32 commands[NL802154_CMD_FRAME_NR_IDS / 32];
  1161. struct nlattr *nl_key, *nl_key_id;
  1162. hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
  1163. if (!hdr)
  1164. return -ENOBUFS;
  1165. if (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex))
  1166. goto nla_put_failure;
  1167. nl_key = nla_nest_start_noflag(msg, NL802154_ATTR_SEC_KEY);
  1168. if (!nl_key)
  1169. goto nla_put_failure;
  1170. nl_key_id = nla_nest_start_noflag(msg, NL802154_KEY_ATTR_ID);
  1171. if (!nl_key_id)
  1172. goto nla_put_failure;
  1173. if (ieee802154_llsec_send_key_id(msg, &key->id) < 0)
  1174. goto nla_put_failure;
  1175. nla_nest_end(msg, nl_key_id);
  1176. if (nla_put_u8(msg, NL802154_KEY_ATTR_USAGE_FRAMES,
  1177. key->key->frame_types))
  1178. goto nla_put_failure;
  1179. if (key->key->frame_types & BIT(NL802154_FRAME_CMD)) {
  1180. /* TODO for each nested */
  1181. memset(commands, 0, sizeof(commands));
  1182. commands[7] = key->key->cmd_frame_ids;
  1183. if (nla_put(msg, NL802154_KEY_ATTR_USAGE_CMDS,
  1184. sizeof(commands), commands))
  1185. goto nla_put_failure;
  1186. }
  1187. if (nla_put(msg, NL802154_KEY_ATTR_BYTES, NL802154_KEY_SIZE,
  1188. key->key->key))
  1189. goto nla_put_failure;
  1190. nla_nest_end(msg, nl_key);
  1191. genlmsg_end(msg, hdr);
  1192. return 0;
  1193. nla_put_failure:
  1194. genlmsg_cancel(msg, hdr);
  1195. return -EMSGSIZE;
  1196. }
  1197. static int
  1198. nl802154_dump_llsec_key(struct sk_buff *skb, struct netlink_callback *cb)
  1199. {
  1200. struct cfg802154_registered_device *rdev = NULL;
  1201. struct ieee802154_llsec_key_entry *key;
  1202. struct ieee802154_llsec_table *table;
  1203. struct wpan_dev *wpan_dev;
  1204. int err;
  1205. err = nl802154_prepare_wpan_dev_dump(skb, cb, &rdev, &wpan_dev);
  1206. if (err)
  1207. return err;
  1208. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR) {
  1209. err = skb->len;
  1210. goto out_err;
  1211. }
  1212. if (!wpan_dev->netdev) {
  1213. err = -EINVAL;
  1214. goto out_err;
  1215. }
  1216. rdev_lock_llsec_table(rdev, wpan_dev);
  1217. rdev_get_llsec_table(rdev, wpan_dev, &table);
  1218. /* TODO make it like station dump */
  1219. if (cb->args[2])
  1220. goto out;
  1221. list_for_each_entry(key, &table->keys, list) {
  1222. if (nl802154_send_key(skb, NL802154_CMD_NEW_SEC_KEY,
  1223. NETLINK_CB(cb->skb).portid,
  1224. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  1225. rdev, wpan_dev->netdev, key) < 0) {
  1226. /* TODO */
  1227. err = -EIO;
  1228. rdev_unlock_llsec_table(rdev, wpan_dev);
  1229. goto out_err;
  1230. }
  1231. }
  1232. cb->args[2] = 1;
  1233. out:
  1234. rdev_unlock_llsec_table(rdev, wpan_dev);
  1235. err = skb->len;
  1236. out_err:
  1237. nl802154_finish_wpan_dev_dump(rdev);
  1238. return err;
  1239. }
  1240. static const struct nla_policy nl802154_key_policy[NL802154_KEY_ATTR_MAX + 1] = {
  1241. [NL802154_KEY_ATTR_ID] = { NLA_NESTED },
  1242. /* TODO handle it as for_each_nested and NLA_FLAG? */
  1243. [NL802154_KEY_ATTR_USAGE_FRAMES] = { NLA_U8 },
  1244. /* TODO handle it as for_each_nested, not static array? */
  1245. [NL802154_KEY_ATTR_USAGE_CMDS] = { .len = NL802154_CMD_FRAME_NR_IDS / 8 },
  1246. [NL802154_KEY_ATTR_BYTES] = { .len = NL802154_KEY_SIZE },
  1247. };
  1248. static int nl802154_add_llsec_key(struct sk_buff *skb, struct genl_info *info)
  1249. {
  1250. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1251. struct net_device *dev = info->user_ptr[1];
  1252. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1253. struct nlattr *attrs[NL802154_KEY_ATTR_MAX + 1];
  1254. struct ieee802154_llsec_key key = { };
  1255. struct ieee802154_llsec_key_id id = { };
  1256. u32 commands[NL802154_CMD_FRAME_NR_IDS / 32] = { };
  1257. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  1258. return -EOPNOTSUPP;
  1259. if (!info->attrs[NL802154_ATTR_SEC_KEY] ||
  1260. nla_parse_nested_deprecated(attrs, NL802154_KEY_ATTR_MAX, info->attrs[NL802154_ATTR_SEC_KEY], nl802154_key_policy, info->extack))
  1261. return -EINVAL;
  1262. if (!attrs[NL802154_KEY_ATTR_USAGE_FRAMES] ||
  1263. !attrs[NL802154_KEY_ATTR_BYTES])
  1264. return -EINVAL;
  1265. if (ieee802154_llsec_parse_key_id(attrs[NL802154_KEY_ATTR_ID], &id) < 0)
  1266. return -ENOBUFS;
  1267. key.frame_types = nla_get_u8(attrs[NL802154_KEY_ATTR_USAGE_FRAMES]);
  1268. if (key.frame_types > BIT(NL802154_FRAME_MAX) ||
  1269. ((key.frame_types & BIT(NL802154_FRAME_CMD)) &&
  1270. !attrs[NL802154_KEY_ATTR_USAGE_CMDS]))
  1271. return -EINVAL;
  1272. if (attrs[NL802154_KEY_ATTR_USAGE_CMDS]) {
  1273. /* TODO for each nested */
  1274. nla_memcpy(commands, attrs[NL802154_KEY_ATTR_USAGE_CMDS],
  1275. NL802154_CMD_FRAME_NR_IDS / 8);
  1276. /* TODO understand the -EINVAL logic here? last condition */
  1277. if (commands[0] || commands[1] || commands[2] || commands[3] ||
  1278. commands[4] || commands[5] || commands[6] ||
  1279. commands[7] > BIT(NL802154_CMD_FRAME_MAX))
  1280. return -EINVAL;
  1281. key.cmd_frame_ids = commands[7];
  1282. } else {
  1283. key.cmd_frame_ids = 0;
  1284. }
  1285. nla_memcpy(key.key, attrs[NL802154_KEY_ATTR_BYTES], NL802154_KEY_SIZE);
  1286. if (ieee802154_llsec_parse_key_id(attrs[NL802154_KEY_ATTR_ID], &id) < 0)
  1287. return -ENOBUFS;
  1288. return rdev_add_llsec_key(rdev, wpan_dev, &id, &key);
  1289. }
  1290. static int nl802154_del_llsec_key(struct sk_buff *skb, struct genl_info *info)
  1291. {
  1292. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1293. struct net_device *dev = info->user_ptr[1];
  1294. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1295. struct nlattr *attrs[NL802154_KEY_ATTR_MAX + 1];
  1296. struct ieee802154_llsec_key_id id;
  1297. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  1298. return -EOPNOTSUPP;
  1299. if (!info->attrs[NL802154_ATTR_SEC_KEY] ||
  1300. nla_parse_nested_deprecated(attrs, NL802154_KEY_ATTR_MAX, info->attrs[NL802154_ATTR_SEC_KEY], nl802154_key_policy, info->extack))
  1301. return -EINVAL;
  1302. if (ieee802154_llsec_parse_key_id(attrs[NL802154_KEY_ATTR_ID], &id) < 0)
  1303. return -ENOBUFS;
  1304. return rdev_del_llsec_key(rdev, wpan_dev, &id);
  1305. }
  1306. static int nl802154_send_device(struct sk_buff *msg, u32 cmd, u32 portid,
  1307. u32 seq, int flags,
  1308. struct cfg802154_registered_device *rdev,
  1309. struct net_device *dev,
  1310. const struct ieee802154_llsec_device *dev_desc)
  1311. {
  1312. void *hdr;
  1313. struct nlattr *nl_device;
  1314. hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
  1315. if (!hdr)
  1316. return -ENOBUFS;
  1317. if (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex))
  1318. goto nla_put_failure;
  1319. nl_device = nla_nest_start_noflag(msg, NL802154_ATTR_SEC_DEVICE);
  1320. if (!nl_device)
  1321. goto nla_put_failure;
  1322. if (nla_put_u32(msg, NL802154_DEV_ATTR_FRAME_COUNTER,
  1323. dev_desc->frame_counter) ||
  1324. nla_put_le16(msg, NL802154_DEV_ATTR_PAN_ID, dev_desc->pan_id) ||
  1325. nla_put_le16(msg, NL802154_DEV_ATTR_SHORT_ADDR,
  1326. dev_desc->short_addr) ||
  1327. nla_put_le64(msg, NL802154_DEV_ATTR_EXTENDED_ADDR,
  1328. dev_desc->hwaddr, NL802154_DEV_ATTR_PAD) ||
  1329. nla_put_u8(msg, NL802154_DEV_ATTR_SECLEVEL_EXEMPT,
  1330. dev_desc->seclevel_exempt) ||
  1331. nla_put_u32(msg, NL802154_DEV_ATTR_KEY_MODE, dev_desc->key_mode))
  1332. goto nla_put_failure;
  1333. nla_nest_end(msg, nl_device);
  1334. genlmsg_end(msg, hdr);
  1335. return 0;
  1336. nla_put_failure:
  1337. genlmsg_cancel(msg, hdr);
  1338. return -EMSGSIZE;
  1339. }
  1340. static int
  1341. nl802154_dump_llsec_dev(struct sk_buff *skb, struct netlink_callback *cb)
  1342. {
  1343. struct cfg802154_registered_device *rdev = NULL;
  1344. struct ieee802154_llsec_device *dev;
  1345. struct ieee802154_llsec_table *table;
  1346. struct wpan_dev *wpan_dev;
  1347. int err;
  1348. err = nl802154_prepare_wpan_dev_dump(skb, cb, &rdev, &wpan_dev);
  1349. if (err)
  1350. return err;
  1351. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR) {
  1352. err = skb->len;
  1353. goto out_err;
  1354. }
  1355. if (!wpan_dev->netdev) {
  1356. err = -EINVAL;
  1357. goto out_err;
  1358. }
  1359. rdev_lock_llsec_table(rdev, wpan_dev);
  1360. rdev_get_llsec_table(rdev, wpan_dev, &table);
  1361. /* TODO make it like station dump */
  1362. if (cb->args[2])
  1363. goto out;
  1364. list_for_each_entry(dev, &table->devices, list) {
  1365. if (nl802154_send_device(skb, NL802154_CMD_NEW_SEC_LEVEL,
  1366. NETLINK_CB(cb->skb).portid,
  1367. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  1368. rdev, wpan_dev->netdev, dev) < 0) {
  1369. /* TODO */
  1370. err = -EIO;
  1371. rdev_unlock_llsec_table(rdev, wpan_dev);
  1372. goto out_err;
  1373. }
  1374. }
  1375. cb->args[2] = 1;
  1376. out:
  1377. rdev_unlock_llsec_table(rdev, wpan_dev);
  1378. err = skb->len;
  1379. out_err:
  1380. nl802154_finish_wpan_dev_dump(rdev);
  1381. return err;
  1382. }
  1383. static const struct nla_policy nl802154_dev_policy[NL802154_DEV_ATTR_MAX + 1] = {
  1384. [NL802154_DEV_ATTR_FRAME_COUNTER] = { NLA_U32 },
  1385. [NL802154_DEV_ATTR_PAN_ID] = { .type = NLA_U16 },
  1386. [NL802154_DEV_ATTR_SHORT_ADDR] = { .type = NLA_U16 },
  1387. [NL802154_DEV_ATTR_EXTENDED_ADDR] = { .type = NLA_U64 },
  1388. [NL802154_DEV_ATTR_SECLEVEL_EXEMPT] = { NLA_U8 },
  1389. [NL802154_DEV_ATTR_KEY_MODE] = { NLA_U32 },
  1390. };
  1391. static int
  1392. ieee802154_llsec_parse_device(struct nlattr *nla,
  1393. struct ieee802154_llsec_device *dev)
  1394. {
  1395. struct nlattr *attrs[NL802154_DEV_ATTR_MAX + 1];
  1396. if (!nla || nla_parse_nested_deprecated(attrs, NL802154_DEV_ATTR_MAX, nla, nl802154_dev_policy, NULL))
  1397. return -EINVAL;
  1398. memset(dev, 0, sizeof(*dev));
  1399. if (!attrs[NL802154_DEV_ATTR_FRAME_COUNTER] ||
  1400. !attrs[NL802154_DEV_ATTR_PAN_ID] ||
  1401. !attrs[NL802154_DEV_ATTR_SHORT_ADDR] ||
  1402. !attrs[NL802154_DEV_ATTR_EXTENDED_ADDR] ||
  1403. !attrs[NL802154_DEV_ATTR_SECLEVEL_EXEMPT] ||
  1404. !attrs[NL802154_DEV_ATTR_KEY_MODE])
  1405. return -EINVAL;
  1406. /* TODO be32 */
  1407. dev->frame_counter = nla_get_u32(attrs[NL802154_DEV_ATTR_FRAME_COUNTER]);
  1408. dev->pan_id = nla_get_le16(attrs[NL802154_DEV_ATTR_PAN_ID]);
  1409. dev->short_addr = nla_get_le16(attrs[NL802154_DEV_ATTR_SHORT_ADDR]);
  1410. /* TODO rename hwaddr to extended_addr */
  1411. dev->hwaddr = nla_get_le64(attrs[NL802154_DEV_ATTR_EXTENDED_ADDR]);
  1412. dev->seclevel_exempt = nla_get_u8(attrs[NL802154_DEV_ATTR_SECLEVEL_EXEMPT]);
  1413. dev->key_mode = nla_get_u32(attrs[NL802154_DEV_ATTR_KEY_MODE]);
  1414. if (dev->key_mode > NL802154_DEVKEY_MAX ||
  1415. (dev->seclevel_exempt != 0 && dev->seclevel_exempt != 1))
  1416. return -EINVAL;
  1417. return 0;
  1418. }
  1419. static int nl802154_add_llsec_dev(struct sk_buff *skb, struct genl_info *info)
  1420. {
  1421. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1422. struct net_device *dev = info->user_ptr[1];
  1423. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1424. struct ieee802154_llsec_device dev_desc;
  1425. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  1426. return -EOPNOTSUPP;
  1427. if (ieee802154_llsec_parse_device(info->attrs[NL802154_ATTR_SEC_DEVICE],
  1428. &dev_desc) < 0)
  1429. return -EINVAL;
  1430. return rdev_add_device(rdev, wpan_dev, &dev_desc);
  1431. }
  1432. static int nl802154_del_llsec_dev(struct sk_buff *skb, struct genl_info *info)
  1433. {
  1434. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1435. struct net_device *dev = info->user_ptr[1];
  1436. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1437. struct nlattr *attrs[NL802154_DEV_ATTR_MAX + 1];
  1438. __le64 extended_addr;
  1439. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  1440. return -EOPNOTSUPP;
  1441. if (!info->attrs[NL802154_ATTR_SEC_DEVICE] ||
  1442. nla_parse_nested_deprecated(attrs, NL802154_DEV_ATTR_MAX, info->attrs[NL802154_ATTR_SEC_DEVICE], nl802154_dev_policy, info->extack))
  1443. return -EINVAL;
  1444. if (!attrs[NL802154_DEV_ATTR_EXTENDED_ADDR])
  1445. return -EINVAL;
  1446. extended_addr = nla_get_le64(attrs[NL802154_DEV_ATTR_EXTENDED_ADDR]);
  1447. return rdev_del_device(rdev, wpan_dev, extended_addr);
  1448. }
  1449. static int nl802154_send_devkey(struct sk_buff *msg, u32 cmd, u32 portid,
  1450. u32 seq, int flags,
  1451. struct cfg802154_registered_device *rdev,
  1452. struct net_device *dev, __le64 extended_addr,
  1453. const struct ieee802154_llsec_device_key *devkey)
  1454. {
  1455. void *hdr;
  1456. struct nlattr *nl_devkey, *nl_key_id;
  1457. hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
  1458. if (!hdr)
  1459. return -ENOBUFS;
  1460. if (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex))
  1461. goto nla_put_failure;
  1462. nl_devkey = nla_nest_start_noflag(msg, NL802154_ATTR_SEC_DEVKEY);
  1463. if (!nl_devkey)
  1464. goto nla_put_failure;
  1465. if (nla_put_le64(msg, NL802154_DEVKEY_ATTR_EXTENDED_ADDR,
  1466. extended_addr, NL802154_DEVKEY_ATTR_PAD) ||
  1467. nla_put_u32(msg, NL802154_DEVKEY_ATTR_FRAME_COUNTER,
  1468. devkey->frame_counter))
  1469. goto nla_put_failure;
  1470. nl_key_id = nla_nest_start_noflag(msg, NL802154_DEVKEY_ATTR_ID);
  1471. if (!nl_key_id)
  1472. goto nla_put_failure;
  1473. if (ieee802154_llsec_send_key_id(msg, &devkey->key_id) < 0)
  1474. goto nla_put_failure;
  1475. nla_nest_end(msg, nl_key_id);
  1476. nla_nest_end(msg, nl_devkey);
  1477. genlmsg_end(msg, hdr);
  1478. return 0;
  1479. nla_put_failure:
  1480. genlmsg_cancel(msg, hdr);
  1481. return -EMSGSIZE;
  1482. }
  1483. static int
  1484. nl802154_dump_llsec_devkey(struct sk_buff *skb, struct netlink_callback *cb)
  1485. {
  1486. struct cfg802154_registered_device *rdev = NULL;
  1487. struct ieee802154_llsec_device_key *kpos;
  1488. struct ieee802154_llsec_device *dpos;
  1489. struct ieee802154_llsec_table *table;
  1490. struct wpan_dev *wpan_dev;
  1491. int err;
  1492. err = nl802154_prepare_wpan_dev_dump(skb, cb, &rdev, &wpan_dev);
  1493. if (err)
  1494. return err;
  1495. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR) {
  1496. err = skb->len;
  1497. goto out_err;
  1498. }
  1499. if (!wpan_dev->netdev) {
  1500. err = -EINVAL;
  1501. goto out_err;
  1502. }
  1503. rdev_lock_llsec_table(rdev, wpan_dev);
  1504. rdev_get_llsec_table(rdev, wpan_dev, &table);
  1505. /* TODO make it like station dump */
  1506. if (cb->args[2])
  1507. goto out;
  1508. /* TODO look if remove devkey and do some nested attribute */
  1509. list_for_each_entry(dpos, &table->devices, list) {
  1510. list_for_each_entry(kpos, &dpos->keys, list) {
  1511. if (nl802154_send_devkey(skb,
  1512. NL802154_CMD_NEW_SEC_LEVEL,
  1513. NETLINK_CB(cb->skb).portid,
  1514. cb->nlh->nlmsg_seq,
  1515. NLM_F_MULTI, rdev,
  1516. wpan_dev->netdev,
  1517. dpos->hwaddr,
  1518. kpos) < 0) {
  1519. /* TODO */
  1520. err = -EIO;
  1521. rdev_unlock_llsec_table(rdev, wpan_dev);
  1522. goto out_err;
  1523. }
  1524. }
  1525. }
  1526. cb->args[2] = 1;
  1527. out:
  1528. rdev_unlock_llsec_table(rdev, wpan_dev);
  1529. err = skb->len;
  1530. out_err:
  1531. nl802154_finish_wpan_dev_dump(rdev);
  1532. return err;
  1533. }
  1534. static const struct nla_policy nl802154_devkey_policy[NL802154_DEVKEY_ATTR_MAX + 1] = {
  1535. [NL802154_DEVKEY_ATTR_FRAME_COUNTER] = { NLA_U32 },
  1536. [NL802154_DEVKEY_ATTR_EXTENDED_ADDR] = { NLA_U64 },
  1537. [NL802154_DEVKEY_ATTR_ID] = { NLA_NESTED },
  1538. };
  1539. static int nl802154_add_llsec_devkey(struct sk_buff *skb, struct genl_info *info)
  1540. {
  1541. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1542. struct net_device *dev = info->user_ptr[1];
  1543. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1544. struct nlattr *attrs[NL802154_DEVKEY_ATTR_MAX + 1];
  1545. struct ieee802154_llsec_device_key key;
  1546. __le64 extended_addr;
  1547. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  1548. return -EOPNOTSUPP;
  1549. if (!info->attrs[NL802154_ATTR_SEC_DEVKEY] ||
  1550. nla_parse_nested_deprecated(attrs, NL802154_DEVKEY_ATTR_MAX, info->attrs[NL802154_ATTR_SEC_DEVKEY], nl802154_devkey_policy, info->extack) < 0)
  1551. return -EINVAL;
  1552. if (!attrs[NL802154_DEVKEY_ATTR_FRAME_COUNTER] ||
  1553. !attrs[NL802154_DEVKEY_ATTR_EXTENDED_ADDR])
  1554. return -EINVAL;
  1555. /* TODO change key.id ? */
  1556. if (ieee802154_llsec_parse_key_id(attrs[NL802154_DEVKEY_ATTR_ID],
  1557. &key.key_id) < 0)
  1558. return -ENOBUFS;
  1559. /* TODO be32 */
  1560. key.frame_counter = nla_get_u32(attrs[NL802154_DEVKEY_ATTR_FRAME_COUNTER]);
  1561. /* TODO change naming hwaddr -> extended_addr
  1562. * check unique identifier short+pan OR extended_addr
  1563. */
  1564. extended_addr = nla_get_le64(attrs[NL802154_DEVKEY_ATTR_EXTENDED_ADDR]);
  1565. return rdev_add_devkey(rdev, wpan_dev, extended_addr, &key);
  1566. }
  1567. static int nl802154_del_llsec_devkey(struct sk_buff *skb, struct genl_info *info)
  1568. {
  1569. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1570. struct net_device *dev = info->user_ptr[1];
  1571. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1572. struct nlattr *attrs[NL802154_DEVKEY_ATTR_MAX + 1];
  1573. struct ieee802154_llsec_device_key key;
  1574. __le64 extended_addr;
  1575. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  1576. return -EOPNOTSUPP;
  1577. if (!info->attrs[NL802154_ATTR_SEC_DEVKEY] ||
  1578. nla_parse_nested_deprecated(attrs, NL802154_DEVKEY_ATTR_MAX, info->attrs[NL802154_ATTR_SEC_DEVKEY], nl802154_devkey_policy, info->extack))
  1579. return -EINVAL;
  1580. if (!attrs[NL802154_DEVKEY_ATTR_EXTENDED_ADDR])
  1581. return -EINVAL;
  1582. /* TODO change key.id ? */
  1583. if (ieee802154_llsec_parse_key_id(attrs[NL802154_DEVKEY_ATTR_ID],
  1584. &key.key_id) < 0)
  1585. return -ENOBUFS;
  1586. /* TODO change naming hwaddr -> extended_addr
  1587. * check unique identifier short+pan OR extended_addr
  1588. */
  1589. extended_addr = nla_get_le64(attrs[NL802154_DEVKEY_ATTR_EXTENDED_ADDR]);
  1590. return rdev_del_devkey(rdev, wpan_dev, extended_addr, &key);
  1591. }
  1592. static int nl802154_send_seclevel(struct sk_buff *msg, u32 cmd, u32 portid,
  1593. u32 seq, int flags,
  1594. struct cfg802154_registered_device *rdev,
  1595. struct net_device *dev,
  1596. const struct ieee802154_llsec_seclevel *sl)
  1597. {
  1598. void *hdr;
  1599. struct nlattr *nl_seclevel;
  1600. hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
  1601. if (!hdr)
  1602. return -ENOBUFS;
  1603. if (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex))
  1604. goto nla_put_failure;
  1605. nl_seclevel = nla_nest_start_noflag(msg, NL802154_ATTR_SEC_LEVEL);
  1606. if (!nl_seclevel)
  1607. goto nla_put_failure;
  1608. if (nla_put_u32(msg, NL802154_SECLEVEL_ATTR_FRAME, sl->frame_type) ||
  1609. nla_put_u32(msg, NL802154_SECLEVEL_ATTR_LEVELS, sl->sec_levels) ||
  1610. nla_put_u8(msg, NL802154_SECLEVEL_ATTR_DEV_OVERRIDE,
  1611. sl->device_override))
  1612. goto nla_put_failure;
  1613. if (sl->frame_type == NL802154_FRAME_CMD) {
  1614. if (nla_put_u32(msg, NL802154_SECLEVEL_ATTR_CMD_FRAME,
  1615. sl->cmd_frame_id))
  1616. goto nla_put_failure;
  1617. }
  1618. nla_nest_end(msg, nl_seclevel);
  1619. genlmsg_end(msg, hdr);
  1620. return 0;
  1621. nla_put_failure:
  1622. genlmsg_cancel(msg, hdr);
  1623. return -EMSGSIZE;
  1624. }
  1625. static int
  1626. nl802154_dump_llsec_seclevel(struct sk_buff *skb, struct netlink_callback *cb)
  1627. {
  1628. struct cfg802154_registered_device *rdev = NULL;
  1629. struct ieee802154_llsec_seclevel *sl;
  1630. struct ieee802154_llsec_table *table;
  1631. struct wpan_dev *wpan_dev;
  1632. int err;
  1633. err = nl802154_prepare_wpan_dev_dump(skb, cb, &rdev, &wpan_dev);
  1634. if (err)
  1635. return err;
  1636. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR) {
  1637. err = skb->len;
  1638. goto out_err;
  1639. }
  1640. if (!wpan_dev->netdev) {
  1641. err = -EINVAL;
  1642. goto out_err;
  1643. }
  1644. rdev_lock_llsec_table(rdev, wpan_dev);
  1645. rdev_get_llsec_table(rdev, wpan_dev, &table);
  1646. /* TODO make it like station dump */
  1647. if (cb->args[2])
  1648. goto out;
  1649. list_for_each_entry(sl, &table->security_levels, list) {
  1650. if (nl802154_send_seclevel(skb, NL802154_CMD_NEW_SEC_LEVEL,
  1651. NETLINK_CB(cb->skb).portid,
  1652. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  1653. rdev, wpan_dev->netdev, sl) < 0) {
  1654. /* TODO */
  1655. err = -EIO;
  1656. rdev_unlock_llsec_table(rdev, wpan_dev);
  1657. goto out_err;
  1658. }
  1659. }
  1660. cb->args[2] = 1;
  1661. out:
  1662. rdev_unlock_llsec_table(rdev, wpan_dev);
  1663. err = skb->len;
  1664. out_err:
  1665. nl802154_finish_wpan_dev_dump(rdev);
  1666. return err;
  1667. }
  1668. static const struct nla_policy nl802154_seclevel_policy[NL802154_SECLEVEL_ATTR_MAX + 1] = {
  1669. [NL802154_SECLEVEL_ATTR_LEVELS] = { .type = NLA_U8 },
  1670. [NL802154_SECLEVEL_ATTR_FRAME] = { .type = NLA_U32 },
  1671. [NL802154_SECLEVEL_ATTR_CMD_FRAME] = { .type = NLA_U32 },
  1672. [NL802154_SECLEVEL_ATTR_DEV_OVERRIDE] = { .type = NLA_U8 },
  1673. };
  1674. static int
  1675. llsec_parse_seclevel(struct nlattr *nla, struct ieee802154_llsec_seclevel *sl)
  1676. {
  1677. struct nlattr *attrs[NL802154_SECLEVEL_ATTR_MAX + 1];
  1678. if (!nla || nla_parse_nested_deprecated(attrs, NL802154_SECLEVEL_ATTR_MAX, nla, nl802154_seclevel_policy, NULL))
  1679. return -EINVAL;
  1680. memset(sl, 0, sizeof(*sl));
  1681. if (!attrs[NL802154_SECLEVEL_ATTR_LEVELS] ||
  1682. !attrs[NL802154_SECLEVEL_ATTR_FRAME] ||
  1683. !attrs[NL802154_SECLEVEL_ATTR_DEV_OVERRIDE])
  1684. return -EINVAL;
  1685. sl->sec_levels = nla_get_u8(attrs[NL802154_SECLEVEL_ATTR_LEVELS]);
  1686. sl->frame_type = nla_get_u32(attrs[NL802154_SECLEVEL_ATTR_FRAME]);
  1687. sl->device_override = nla_get_u8(attrs[NL802154_SECLEVEL_ATTR_DEV_OVERRIDE]);
  1688. if (sl->frame_type > NL802154_FRAME_MAX ||
  1689. (sl->device_override != 0 && sl->device_override != 1))
  1690. return -EINVAL;
  1691. if (sl->frame_type == NL802154_FRAME_CMD) {
  1692. if (!attrs[NL802154_SECLEVEL_ATTR_CMD_FRAME])
  1693. return -EINVAL;
  1694. sl->cmd_frame_id = nla_get_u32(attrs[NL802154_SECLEVEL_ATTR_CMD_FRAME]);
  1695. if (sl->cmd_frame_id > NL802154_CMD_FRAME_MAX)
  1696. return -EINVAL;
  1697. }
  1698. return 0;
  1699. }
  1700. static int nl802154_add_llsec_seclevel(struct sk_buff *skb,
  1701. struct genl_info *info)
  1702. {
  1703. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1704. struct net_device *dev = info->user_ptr[1];
  1705. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1706. struct ieee802154_llsec_seclevel sl;
  1707. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  1708. return -EOPNOTSUPP;
  1709. if (llsec_parse_seclevel(info->attrs[NL802154_ATTR_SEC_LEVEL],
  1710. &sl) < 0)
  1711. return -EINVAL;
  1712. return rdev_add_seclevel(rdev, wpan_dev, &sl);
  1713. }
  1714. static int nl802154_del_llsec_seclevel(struct sk_buff *skb,
  1715. struct genl_info *info)
  1716. {
  1717. struct cfg802154_registered_device *rdev = info->user_ptr[0];
  1718. struct net_device *dev = info->user_ptr[1];
  1719. struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
  1720. struct ieee802154_llsec_seclevel sl;
  1721. if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR)
  1722. return -EOPNOTSUPP;
  1723. if (!info->attrs[NL802154_ATTR_SEC_LEVEL] ||
  1724. llsec_parse_seclevel(info->attrs[NL802154_ATTR_SEC_LEVEL],
  1725. &sl) < 0)
  1726. return -EINVAL;
  1727. return rdev_del_seclevel(rdev, wpan_dev, &sl);
  1728. }
  1729. #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
  1730. #define NL802154_FLAG_NEED_WPAN_PHY 0x01
  1731. #define NL802154_FLAG_NEED_NETDEV 0x02
  1732. #define NL802154_FLAG_NEED_RTNL 0x04
  1733. #define NL802154_FLAG_CHECK_NETDEV_UP 0x08
  1734. #define NL802154_FLAG_NEED_NETDEV_UP (NL802154_FLAG_NEED_NETDEV |\
  1735. NL802154_FLAG_CHECK_NETDEV_UP)
  1736. #define NL802154_FLAG_NEED_WPAN_DEV 0x10
  1737. #define NL802154_FLAG_NEED_WPAN_DEV_UP (NL802154_FLAG_NEED_WPAN_DEV |\
  1738. NL802154_FLAG_CHECK_NETDEV_UP)
  1739. static int nl802154_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
  1740. struct genl_info *info)
  1741. {
  1742. struct cfg802154_registered_device *rdev;
  1743. struct wpan_dev *wpan_dev;
  1744. struct net_device *dev;
  1745. bool rtnl = ops->internal_flags & NL802154_FLAG_NEED_RTNL;
  1746. if (rtnl)
  1747. rtnl_lock();
  1748. if (ops->internal_flags & NL802154_FLAG_NEED_WPAN_PHY) {
  1749. rdev = cfg802154_get_dev_from_info(genl_info_net(info), info);
  1750. if (IS_ERR(rdev)) {
  1751. if (rtnl)
  1752. rtnl_unlock();
  1753. return PTR_ERR(rdev);
  1754. }
  1755. info->user_ptr[0] = rdev;
  1756. } else if (ops->internal_flags & NL802154_FLAG_NEED_NETDEV ||
  1757. ops->internal_flags & NL802154_FLAG_NEED_WPAN_DEV) {
  1758. ASSERT_RTNL();
  1759. wpan_dev = __cfg802154_wpan_dev_from_attrs(genl_info_net(info),
  1760. info->attrs);
  1761. if (IS_ERR(wpan_dev)) {
  1762. if (rtnl)
  1763. rtnl_unlock();
  1764. return PTR_ERR(wpan_dev);
  1765. }
  1766. dev = wpan_dev->netdev;
  1767. rdev = wpan_phy_to_rdev(wpan_dev->wpan_phy);
  1768. if (ops->internal_flags & NL802154_FLAG_NEED_NETDEV) {
  1769. if (!dev) {
  1770. if (rtnl)
  1771. rtnl_unlock();
  1772. return -EINVAL;
  1773. }
  1774. info->user_ptr[1] = dev;
  1775. } else {
  1776. info->user_ptr[1] = wpan_dev;
  1777. }
  1778. if (dev) {
  1779. if (ops->internal_flags & NL802154_FLAG_CHECK_NETDEV_UP &&
  1780. !netif_running(dev)) {
  1781. if (rtnl)
  1782. rtnl_unlock();
  1783. return -ENETDOWN;
  1784. }
  1785. dev_hold(dev);
  1786. }
  1787. info->user_ptr[0] = rdev;
  1788. }
  1789. return 0;
  1790. }
  1791. static void nl802154_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
  1792. struct genl_info *info)
  1793. {
  1794. if (info->user_ptr[1]) {
  1795. if (ops->internal_flags & NL802154_FLAG_NEED_WPAN_DEV) {
  1796. struct wpan_dev *wpan_dev = info->user_ptr[1];
  1797. if (wpan_dev->netdev)
  1798. dev_put(wpan_dev->netdev);
  1799. } else {
  1800. dev_put(info->user_ptr[1]);
  1801. }
  1802. }
  1803. if (ops->internal_flags & NL802154_FLAG_NEED_RTNL)
  1804. rtnl_unlock();
  1805. }
  1806. static const struct genl_ops nl802154_ops[] = {
  1807. {
  1808. .cmd = NL802154_CMD_GET_WPAN_PHY,
  1809. .validate = GENL_DONT_VALIDATE_STRICT |
  1810. GENL_DONT_VALIDATE_DUMP_STRICT,
  1811. .doit = nl802154_get_wpan_phy,
  1812. .dumpit = nl802154_dump_wpan_phy,
  1813. .done = nl802154_dump_wpan_phy_done,
  1814. /* can be retrieved by unprivileged users */
  1815. .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
  1816. NL802154_FLAG_NEED_RTNL,
  1817. },
  1818. {
  1819. .cmd = NL802154_CMD_GET_INTERFACE,
  1820. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1821. .doit = nl802154_get_interface,
  1822. .dumpit = nl802154_dump_interface,
  1823. /* can be retrieved by unprivileged users */
  1824. .internal_flags = NL802154_FLAG_NEED_WPAN_DEV |
  1825. NL802154_FLAG_NEED_RTNL,
  1826. },
  1827. {
  1828. .cmd = NL802154_CMD_NEW_INTERFACE,
  1829. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1830. .doit = nl802154_new_interface,
  1831. .flags = GENL_ADMIN_PERM,
  1832. .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
  1833. NL802154_FLAG_NEED_RTNL,
  1834. },
  1835. {
  1836. .cmd = NL802154_CMD_DEL_INTERFACE,
  1837. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1838. .doit = nl802154_del_interface,
  1839. .flags = GENL_ADMIN_PERM,
  1840. .internal_flags = NL802154_FLAG_NEED_WPAN_DEV |
  1841. NL802154_FLAG_NEED_RTNL,
  1842. },
  1843. {
  1844. .cmd = NL802154_CMD_SET_CHANNEL,
  1845. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1846. .doit = nl802154_set_channel,
  1847. .flags = GENL_ADMIN_PERM,
  1848. .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
  1849. NL802154_FLAG_NEED_RTNL,
  1850. },
  1851. {
  1852. .cmd = NL802154_CMD_SET_CCA_MODE,
  1853. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1854. .doit = nl802154_set_cca_mode,
  1855. .flags = GENL_ADMIN_PERM,
  1856. .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
  1857. NL802154_FLAG_NEED_RTNL,
  1858. },
  1859. {
  1860. .cmd = NL802154_CMD_SET_CCA_ED_LEVEL,
  1861. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1862. .doit = nl802154_set_cca_ed_level,
  1863. .flags = GENL_ADMIN_PERM,
  1864. .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
  1865. NL802154_FLAG_NEED_RTNL,
  1866. },
  1867. {
  1868. .cmd = NL802154_CMD_SET_TX_POWER,
  1869. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1870. .doit = nl802154_set_tx_power,
  1871. .flags = GENL_ADMIN_PERM,
  1872. .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
  1873. NL802154_FLAG_NEED_RTNL,
  1874. },
  1875. {
  1876. .cmd = NL802154_CMD_SET_WPAN_PHY_NETNS,
  1877. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1878. .doit = nl802154_wpan_phy_netns,
  1879. .flags = GENL_ADMIN_PERM,
  1880. .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
  1881. NL802154_FLAG_NEED_RTNL,
  1882. },
  1883. {
  1884. .cmd = NL802154_CMD_SET_PAN_ID,
  1885. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1886. .doit = nl802154_set_pan_id,
  1887. .flags = GENL_ADMIN_PERM,
  1888. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1889. NL802154_FLAG_NEED_RTNL,
  1890. },
  1891. {
  1892. .cmd = NL802154_CMD_SET_SHORT_ADDR,
  1893. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1894. .doit = nl802154_set_short_addr,
  1895. .flags = GENL_ADMIN_PERM,
  1896. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1897. NL802154_FLAG_NEED_RTNL,
  1898. },
  1899. {
  1900. .cmd = NL802154_CMD_SET_BACKOFF_EXPONENT,
  1901. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1902. .doit = nl802154_set_backoff_exponent,
  1903. .flags = GENL_ADMIN_PERM,
  1904. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1905. NL802154_FLAG_NEED_RTNL,
  1906. },
  1907. {
  1908. .cmd = NL802154_CMD_SET_MAX_CSMA_BACKOFFS,
  1909. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1910. .doit = nl802154_set_max_csma_backoffs,
  1911. .flags = GENL_ADMIN_PERM,
  1912. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1913. NL802154_FLAG_NEED_RTNL,
  1914. },
  1915. {
  1916. .cmd = NL802154_CMD_SET_MAX_FRAME_RETRIES,
  1917. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1918. .doit = nl802154_set_max_frame_retries,
  1919. .flags = GENL_ADMIN_PERM,
  1920. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1921. NL802154_FLAG_NEED_RTNL,
  1922. },
  1923. {
  1924. .cmd = NL802154_CMD_SET_LBT_MODE,
  1925. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1926. .doit = nl802154_set_lbt_mode,
  1927. .flags = GENL_ADMIN_PERM,
  1928. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1929. NL802154_FLAG_NEED_RTNL,
  1930. },
  1931. {
  1932. .cmd = NL802154_CMD_SET_ACKREQ_DEFAULT,
  1933. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1934. .doit = nl802154_set_ackreq_default,
  1935. .flags = GENL_ADMIN_PERM,
  1936. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1937. NL802154_FLAG_NEED_RTNL,
  1938. },
  1939. #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
  1940. {
  1941. .cmd = NL802154_CMD_SET_SEC_PARAMS,
  1942. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1943. .doit = nl802154_set_llsec_params,
  1944. .flags = GENL_ADMIN_PERM,
  1945. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1946. NL802154_FLAG_NEED_RTNL,
  1947. },
  1948. {
  1949. .cmd = NL802154_CMD_GET_SEC_KEY,
  1950. .validate = GENL_DONT_VALIDATE_STRICT |
  1951. GENL_DONT_VALIDATE_DUMP_STRICT,
  1952. /* TODO .doit by matching key id? */
  1953. .dumpit = nl802154_dump_llsec_key,
  1954. .flags = GENL_ADMIN_PERM,
  1955. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1956. NL802154_FLAG_NEED_RTNL,
  1957. },
  1958. {
  1959. .cmd = NL802154_CMD_NEW_SEC_KEY,
  1960. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1961. .doit = nl802154_add_llsec_key,
  1962. .flags = GENL_ADMIN_PERM,
  1963. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1964. NL802154_FLAG_NEED_RTNL,
  1965. },
  1966. {
  1967. .cmd = NL802154_CMD_DEL_SEC_KEY,
  1968. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1969. .doit = nl802154_del_llsec_key,
  1970. .flags = GENL_ADMIN_PERM,
  1971. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1972. NL802154_FLAG_NEED_RTNL,
  1973. },
  1974. /* TODO unique identifier must short+pan OR extended_addr */
  1975. {
  1976. .cmd = NL802154_CMD_GET_SEC_DEV,
  1977. .validate = GENL_DONT_VALIDATE_STRICT |
  1978. GENL_DONT_VALIDATE_DUMP_STRICT,
  1979. /* TODO .doit by matching extended_addr? */
  1980. .dumpit = nl802154_dump_llsec_dev,
  1981. .flags = GENL_ADMIN_PERM,
  1982. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1983. NL802154_FLAG_NEED_RTNL,
  1984. },
  1985. {
  1986. .cmd = NL802154_CMD_NEW_SEC_DEV,
  1987. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1988. .doit = nl802154_add_llsec_dev,
  1989. .flags = GENL_ADMIN_PERM,
  1990. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1991. NL802154_FLAG_NEED_RTNL,
  1992. },
  1993. {
  1994. .cmd = NL802154_CMD_DEL_SEC_DEV,
  1995. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  1996. .doit = nl802154_del_llsec_dev,
  1997. .flags = GENL_ADMIN_PERM,
  1998. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  1999. NL802154_FLAG_NEED_RTNL,
  2000. },
  2001. /* TODO remove complete devkey, put it as nested? */
  2002. {
  2003. .cmd = NL802154_CMD_GET_SEC_DEVKEY,
  2004. .validate = GENL_DONT_VALIDATE_STRICT |
  2005. GENL_DONT_VALIDATE_DUMP_STRICT,
  2006. /* TODO doit by matching ??? */
  2007. .dumpit = nl802154_dump_llsec_devkey,
  2008. .flags = GENL_ADMIN_PERM,
  2009. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  2010. NL802154_FLAG_NEED_RTNL,
  2011. },
  2012. {
  2013. .cmd = NL802154_CMD_NEW_SEC_DEVKEY,
  2014. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  2015. .doit = nl802154_add_llsec_devkey,
  2016. .flags = GENL_ADMIN_PERM,
  2017. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  2018. NL802154_FLAG_NEED_RTNL,
  2019. },
  2020. {
  2021. .cmd = NL802154_CMD_DEL_SEC_DEVKEY,
  2022. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  2023. .doit = nl802154_del_llsec_devkey,
  2024. .flags = GENL_ADMIN_PERM,
  2025. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  2026. NL802154_FLAG_NEED_RTNL,
  2027. },
  2028. {
  2029. .cmd = NL802154_CMD_GET_SEC_LEVEL,
  2030. .validate = GENL_DONT_VALIDATE_STRICT |
  2031. GENL_DONT_VALIDATE_DUMP_STRICT,
  2032. /* TODO .doit by matching frame_type? */
  2033. .dumpit = nl802154_dump_llsec_seclevel,
  2034. .flags = GENL_ADMIN_PERM,
  2035. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  2036. NL802154_FLAG_NEED_RTNL,
  2037. },
  2038. {
  2039. .cmd = NL802154_CMD_NEW_SEC_LEVEL,
  2040. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  2041. .doit = nl802154_add_llsec_seclevel,
  2042. .flags = GENL_ADMIN_PERM,
  2043. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  2044. NL802154_FLAG_NEED_RTNL,
  2045. },
  2046. {
  2047. .cmd = NL802154_CMD_DEL_SEC_LEVEL,
  2048. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  2049. /* TODO match frame_type only? */
  2050. .doit = nl802154_del_llsec_seclevel,
  2051. .flags = GENL_ADMIN_PERM,
  2052. .internal_flags = NL802154_FLAG_NEED_NETDEV |
  2053. NL802154_FLAG_NEED_RTNL,
  2054. },
  2055. #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
  2056. };
  2057. static struct genl_family nl802154_fam __ro_after_init = {
  2058. .name = NL802154_GENL_NAME, /* have users key off the name instead */
  2059. .hdrsize = 0, /* no private header */
  2060. .version = 1, /* no particular meaning now */
  2061. .maxattr = NL802154_ATTR_MAX,
  2062. .policy = nl802154_policy,
  2063. .netnsok = true,
  2064. .pre_doit = nl802154_pre_doit,
  2065. .post_doit = nl802154_post_doit,
  2066. .module = THIS_MODULE,
  2067. .ops = nl802154_ops,
  2068. .n_ops = ARRAY_SIZE(nl802154_ops),
  2069. .mcgrps = nl802154_mcgrps,
  2070. .n_mcgrps = ARRAY_SIZE(nl802154_mcgrps),
  2071. };
  2072. /* initialisation/exit functions */
  2073. int __init nl802154_init(void)
  2074. {
  2075. return genl_register_family(&nl802154_fam);
  2076. }
  2077. void nl802154_exit(void)
  2078. {
  2079. genl_unregister_family(&nl802154_fam);
  2080. }