1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431 |
- /* This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2
- * as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * Authors:
- * Alexander Aring <aar@pengutronix.de>
- *
- * Based on: net/wireless/nl80211.c
- */
- #include <linux/rtnetlink.h>
- #include <net/cfg802154.h>
- #include <net/genetlink.h>
- #include <net/mac802154.h>
- #include <net/netlink.h>
- #include <net/nl802154.h>
- #include <net/sock.h>
- #include "nl802154.h"
- #include "rdev-ops.h"
- #include "core.h"
- static int nl802154_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
- struct genl_info *info);
- static void nl802154_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
- struct genl_info *info);
- /* the netlink family */
- static struct genl_family nl802154_fam = {
- .id = GENL_ID_GENERATE, /* don't bother with a hardcoded ID */
- .name = NL802154_GENL_NAME, /* have users key off the name instead */
- .hdrsize = 0, /* no private header */
- .version = 1, /* no particular meaning now */
- .maxattr = NL802154_ATTR_MAX,
- .netnsok = true,
- .pre_doit = nl802154_pre_doit,
- .post_doit = nl802154_post_doit,
- };
- /* multicast groups */
- enum nl802154_multicast_groups {
- NL802154_MCGRP_CONFIG,
- };
- static const struct genl_multicast_group nl802154_mcgrps[] = {
- [NL802154_MCGRP_CONFIG] = { .name = "config", },
- };
- /* returns ERR_PTR values */
- static struct wpan_dev *
- __cfg802154_wpan_dev_from_attrs(struct net *netns, struct nlattr **attrs)
- {
- struct cfg802154_registered_device *rdev;
- struct wpan_dev *result = NULL;
- bool have_ifidx = attrs[NL802154_ATTR_IFINDEX];
- bool have_wpan_dev_id = attrs[NL802154_ATTR_WPAN_DEV];
- u64 wpan_dev_id;
- int wpan_phy_idx = -1;
- int ifidx = -1;
- ASSERT_RTNL();
- if (!have_ifidx && !have_wpan_dev_id)
- return ERR_PTR(-EINVAL);
- if (have_ifidx)
- ifidx = nla_get_u32(attrs[NL802154_ATTR_IFINDEX]);
- if (have_wpan_dev_id) {
- wpan_dev_id = nla_get_u64(attrs[NL802154_ATTR_WPAN_DEV]);
- wpan_phy_idx = wpan_dev_id >> 32;
- }
- list_for_each_entry(rdev, &cfg802154_rdev_list, list) {
- struct wpan_dev *wpan_dev;
- /* TODO netns compare */
- if (have_wpan_dev_id && rdev->wpan_phy_idx != wpan_phy_idx)
- continue;
- list_for_each_entry(wpan_dev, &rdev->wpan_dev_list, list) {
- if (have_ifidx && wpan_dev->netdev &&
- wpan_dev->netdev->ifindex == ifidx) {
- result = wpan_dev;
- break;
- }
- if (have_wpan_dev_id &&
- wpan_dev->identifier == (u32)wpan_dev_id) {
- result = wpan_dev;
- break;
- }
- }
- if (result)
- break;
- }
- if (result)
- return result;
- return ERR_PTR(-ENODEV);
- }
- static struct cfg802154_registered_device *
- __cfg802154_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
- {
- struct cfg802154_registered_device *rdev = NULL, *tmp;
- struct net_device *netdev;
- ASSERT_RTNL();
- if (!attrs[NL802154_ATTR_WPAN_PHY] &&
- !attrs[NL802154_ATTR_IFINDEX] &&
- !attrs[NL802154_ATTR_WPAN_DEV])
- return ERR_PTR(-EINVAL);
- if (attrs[NL802154_ATTR_WPAN_PHY])
- rdev = cfg802154_rdev_by_wpan_phy_idx(
- nla_get_u32(attrs[NL802154_ATTR_WPAN_PHY]));
- if (attrs[NL802154_ATTR_WPAN_DEV]) {
- u64 wpan_dev_id = nla_get_u64(attrs[NL802154_ATTR_WPAN_DEV]);
- struct wpan_dev *wpan_dev;
- bool found = false;
- tmp = cfg802154_rdev_by_wpan_phy_idx(wpan_dev_id >> 32);
- if (tmp) {
- /* make sure wpan_dev exists */
- list_for_each_entry(wpan_dev, &tmp->wpan_dev_list, list) {
- if (wpan_dev->identifier != (u32)wpan_dev_id)
- continue;
- found = true;
- break;
- }
- if (!found)
- tmp = NULL;
- if (rdev && tmp != rdev)
- return ERR_PTR(-EINVAL);
- rdev = tmp;
- }
- }
- if (attrs[NL802154_ATTR_IFINDEX]) {
- int ifindex = nla_get_u32(attrs[NL802154_ATTR_IFINDEX]);
- netdev = __dev_get_by_index(netns, ifindex);
- if (netdev) {
- if (netdev->ieee802154_ptr)
- tmp = wpan_phy_to_rdev(
- netdev->ieee802154_ptr->wpan_phy);
- else
- tmp = NULL;
- /* not wireless device -- return error */
- if (!tmp)
- return ERR_PTR(-EINVAL);
- /* mismatch -- return error */
- if (rdev && tmp != rdev)
- return ERR_PTR(-EINVAL);
- rdev = tmp;
- }
- }
- if (!rdev)
- return ERR_PTR(-ENODEV);
- /* TODO netns compare */
- return rdev;
- }
- /* This function returns a pointer to the driver
- * that the genl_info item that is passed refers to.
- *
- * The result of this can be a PTR_ERR and hence must
- * be checked with IS_ERR() for errors.
- */
- static struct cfg802154_registered_device *
- cfg802154_get_dev_from_info(struct net *netns, struct genl_info *info)
- {
- return __cfg802154_rdev_from_attrs(netns, info->attrs);
- }
- /* policy for the attributes */
- static const struct nla_policy nl802154_policy[NL802154_ATTR_MAX+1] = {
- [NL802154_ATTR_WPAN_PHY] = { .type = NLA_U32 },
- [NL802154_ATTR_WPAN_PHY_NAME] = { .type = NLA_NUL_STRING,
- .len = 20-1 },
- [NL802154_ATTR_IFINDEX] = { .type = NLA_U32 },
- [NL802154_ATTR_IFTYPE] = { .type = NLA_U32 },
- [NL802154_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
- [NL802154_ATTR_WPAN_DEV] = { .type = NLA_U64 },
- [NL802154_ATTR_PAGE] = { .type = NLA_U8, },
- [NL802154_ATTR_CHANNEL] = { .type = NLA_U8, },
- [NL802154_ATTR_TX_POWER] = { .type = NLA_S32, },
- [NL802154_ATTR_CCA_MODE] = { .type = NLA_U32, },
- [NL802154_ATTR_CCA_OPT] = { .type = NLA_U32, },
- [NL802154_ATTR_CCA_ED_LEVEL] = { .type = NLA_S32, },
- [NL802154_ATTR_SUPPORTED_CHANNEL] = { .type = NLA_U32, },
- [NL802154_ATTR_PAN_ID] = { .type = NLA_U16, },
- [NL802154_ATTR_EXTENDED_ADDR] = { .type = NLA_U64 },
- [NL802154_ATTR_SHORT_ADDR] = { .type = NLA_U16, },
- [NL802154_ATTR_MIN_BE] = { .type = NLA_U8, },
- [NL802154_ATTR_MAX_BE] = { .type = NLA_U8, },
- [NL802154_ATTR_MAX_CSMA_BACKOFFS] = { .type = NLA_U8, },
- [NL802154_ATTR_MAX_FRAME_RETRIES] = { .type = NLA_S8, },
- [NL802154_ATTR_LBT_MODE] = { .type = NLA_U8, },
- [NL802154_ATTR_WPAN_PHY_CAPS] = { .type = NLA_NESTED },
- [NL802154_ATTR_SUPPORTED_COMMANDS] = { .type = NLA_NESTED },
- [NL802154_ATTR_ACKREQ_DEFAULT] = { .type = NLA_U8 },
- #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
- [NL802154_ATTR_SEC_ENABLED] = { .type = NLA_U8, },
- [NL802154_ATTR_SEC_OUT_LEVEL] = { .type = NLA_U32, },
- [NL802154_ATTR_SEC_OUT_KEY_ID] = { .type = NLA_NESTED, },
- [NL802154_ATTR_SEC_FRAME_COUNTER] = { .type = NLA_U32 },
- [NL802154_ATTR_SEC_LEVEL] = { .type = NLA_NESTED },
- [NL802154_ATTR_SEC_DEVICE] = { .type = NLA_NESTED },
- [NL802154_ATTR_SEC_DEVKEY] = { .type = NLA_NESTED },
- [NL802154_ATTR_SEC_KEY] = { .type = NLA_NESTED },
- #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
- };
- #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
- static int
- nl802154_prepare_wpan_dev_dump(struct sk_buff *skb,
- struct netlink_callback *cb,
- struct cfg802154_registered_device **rdev,
- struct wpan_dev **wpan_dev)
- {
- int err;
- rtnl_lock();
- if (!cb->args[0]) {
- err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl802154_fam.hdrsize,
- nl802154_fam.attrbuf, nl802154_fam.maxattr,
- nl802154_policy);
- if (err)
- goto out_unlock;
- *wpan_dev = __cfg802154_wpan_dev_from_attrs(sock_net(skb->sk),
- nl802154_fam.attrbuf);
- if (IS_ERR(*wpan_dev)) {
- err = PTR_ERR(*wpan_dev);
- goto out_unlock;
- }
- *rdev = wpan_phy_to_rdev((*wpan_dev)->wpan_phy);
- /* 0 is the first index - add 1 to parse only once */
- cb->args[0] = (*rdev)->wpan_phy_idx + 1;
- cb->args[1] = (*wpan_dev)->identifier;
- } else {
- /* subtract the 1 again here */
- struct wpan_phy *wpan_phy = wpan_phy_idx_to_wpan_phy(cb->args[0] - 1);
- struct wpan_dev *tmp;
- if (!wpan_phy) {
- err = -ENODEV;
- goto out_unlock;
- }
- *rdev = wpan_phy_to_rdev(wpan_phy);
- *wpan_dev = NULL;
- list_for_each_entry(tmp, &(*rdev)->wpan_dev_list, list) {
- if (tmp->identifier == cb->args[1]) {
- *wpan_dev = tmp;
- break;
- }
- }
- if (!*wpan_dev) {
- err = -ENODEV;
- goto out_unlock;
- }
- }
- return 0;
- out_unlock:
- rtnl_unlock();
- return err;
- }
- static void
- nl802154_finish_wpan_dev_dump(struct cfg802154_registered_device *rdev)
- {
- rtnl_unlock();
- }
- #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
- /* message building helper */
- static inline void *nl802154hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
- int flags, u8 cmd)
- {
- /* since there is no private header just add the generic one */
- return genlmsg_put(skb, portid, seq, &nl802154_fam, flags, cmd);
- }
- static int
- nl802154_put_flags(struct sk_buff *msg, int attr, u32 mask)
- {
- struct nlattr *nl_flags = nla_nest_start(msg, attr);
- int i;
- if (!nl_flags)
- return -ENOBUFS;
- i = 0;
- while (mask) {
- if ((mask & 1) && nla_put_flag(msg, i))
- return -ENOBUFS;
- mask >>= 1;
- i++;
- }
- nla_nest_end(msg, nl_flags);
- return 0;
- }
- static int
- nl802154_send_wpan_phy_channels(struct cfg802154_registered_device *rdev,
- struct sk_buff *msg)
- {
- struct nlattr *nl_page;
- unsigned long page;
- nl_page = nla_nest_start(msg, NL802154_ATTR_CHANNELS_SUPPORTED);
- if (!nl_page)
- return -ENOBUFS;
- for (page = 0; page <= IEEE802154_MAX_PAGE; page++) {
- if (nla_put_u32(msg, NL802154_ATTR_SUPPORTED_CHANNEL,
- rdev->wpan_phy.supported.channels[page]))
- return -ENOBUFS;
- }
- nla_nest_end(msg, nl_page);
- return 0;
- }
- static int
- nl802154_put_capabilities(struct sk_buff *msg,
- struct cfg802154_registered_device *rdev)
- {
- const struct wpan_phy_supported *caps = &rdev->wpan_phy.supported;
- struct nlattr *nl_caps, *nl_channels;
- int i;
- nl_caps = nla_nest_start(msg, NL802154_ATTR_WPAN_PHY_CAPS);
- if (!nl_caps)
- return -ENOBUFS;
- nl_channels = nla_nest_start(msg, NL802154_CAP_ATTR_CHANNELS);
- if (!nl_channels)
- return -ENOBUFS;
- for (i = 0; i <= IEEE802154_MAX_PAGE; i++) {
- if (caps->channels[i]) {
- if (nl802154_put_flags(msg, i, caps->channels[i]))
- return -ENOBUFS;
- }
- }
- nla_nest_end(msg, nl_channels);
- if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_ED_LEVEL) {
- struct nlattr *nl_ed_lvls;
- nl_ed_lvls = nla_nest_start(msg,
- NL802154_CAP_ATTR_CCA_ED_LEVELS);
- if (!nl_ed_lvls)
- return -ENOBUFS;
- for (i = 0; i < caps->cca_ed_levels_size; i++) {
- if (nla_put_s32(msg, i, caps->cca_ed_levels[i]))
- return -ENOBUFS;
- }
- nla_nest_end(msg, nl_ed_lvls);
- }
- if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_TXPOWER) {
- struct nlattr *nl_tx_pwrs;
- nl_tx_pwrs = nla_nest_start(msg, NL802154_CAP_ATTR_TX_POWERS);
- if (!nl_tx_pwrs)
- return -ENOBUFS;
- for (i = 0; i < caps->tx_powers_size; i++) {
- if (nla_put_s32(msg, i, caps->tx_powers[i]))
- return -ENOBUFS;
- }
- nla_nest_end(msg, nl_tx_pwrs);
- }
- if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_MODE) {
- if (nl802154_put_flags(msg, NL802154_CAP_ATTR_CCA_MODES,
- caps->cca_modes) ||
- nl802154_put_flags(msg, NL802154_CAP_ATTR_CCA_OPTS,
- caps->cca_opts))
- return -ENOBUFS;
- }
- if (nla_put_u8(msg, NL802154_CAP_ATTR_MIN_MINBE, caps->min_minbe) ||
- nla_put_u8(msg, NL802154_CAP_ATTR_MAX_MINBE, caps->max_minbe) ||
- nla_put_u8(msg, NL802154_CAP_ATTR_MIN_MAXBE, caps->min_maxbe) ||
- nla_put_u8(msg, NL802154_CAP_ATTR_MAX_MAXBE, caps->max_maxbe) ||
- nla_put_u8(msg, NL802154_CAP_ATTR_MIN_CSMA_BACKOFFS,
- caps->min_csma_backoffs) ||
- nla_put_u8(msg, NL802154_CAP_ATTR_MAX_CSMA_BACKOFFS,
- caps->max_csma_backoffs) ||
- nla_put_s8(msg, NL802154_CAP_ATTR_MIN_FRAME_RETRIES,
- caps->min_frame_retries) ||
- nla_put_s8(msg, NL802154_CAP_ATTR_MAX_FRAME_RETRIES,
- caps->max_frame_retries) ||
- nl802154_put_flags(msg, NL802154_CAP_ATTR_IFTYPES,
- caps->iftypes) ||
- nla_put_u32(msg, NL802154_CAP_ATTR_LBT, caps->lbt))
- return -ENOBUFS;
- nla_nest_end(msg, nl_caps);
- return 0;
- }
- static int nl802154_send_wpan_phy(struct cfg802154_registered_device *rdev,
- enum nl802154_commands cmd,
- struct sk_buff *msg, u32 portid, u32 seq,
- int flags)
- {
- struct nlattr *nl_cmds;
- void *hdr;
- int i;
- hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
- if (!hdr)
- return -ENOBUFS;
- if (nla_put_u32(msg, NL802154_ATTR_WPAN_PHY, rdev->wpan_phy_idx) ||
- nla_put_string(msg, NL802154_ATTR_WPAN_PHY_NAME,
- wpan_phy_name(&rdev->wpan_phy)) ||
- nla_put_u32(msg, NL802154_ATTR_GENERATION,
- cfg802154_rdev_list_generation))
- goto nla_put_failure;
- if (cmd != NL802154_CMD_NEW_WPAN_PHY)
- goto finish;
- /* DUMP PHY PIB */
- /* current channel settings */
- if (nla_put_u8(msg, NL802154_ATTR_PAGE,
- rdev->wpan_phy.current_page) ||
- nla_put_u8(msg, NL802154_ATTR_CHANNEL,
- rdev->wpan_phy.current_channel))
- goto nla_put_failure;
- /* TODO remove this behaviour, we still keep support it for a while
- * so users can change the behaviour to the new one.
- */
- if (nl802154_send_wpan_phy_channels(rdev, msg))
- goto nla_put_failure;
- /* cca mode */
- if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_MODE) {
- if (nla_put_u32(msg, NL802154_ATTR_CCA_MODE,
- rdev->wpan_phy.cca.mode))
- goto nla_put_failure;
- if (rdev->wpan_phy.cca.mode == NL802154_CCA_ENERGY_CARRIER) {
- if (nla_put_u32(msg, NL802154_ATTR_CCA_OPT,
- rdev->wpan_phy.cca.opt))
- goto nla_put_failure;
- }
- }
- if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_TXPOWER) {
- if (nla_put_s32(msg, NL802154_ATTR_TX_POWER,
- rdev->wpan_phy.transmit_power))
- goto nla_put_failure;
- }
- if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_ED_LEVEL) {
- if (nla_put_s32(msg, NL802154_ATTR_CCA_ED_LEVEL,
- rdev->wpan_phy.cca_ed_level))
- goto nla_put_failure;
- }
- if (nl802154_put_capabilities(msg, rdev))
- goto nla_put_failure;
- nl_cmds = nla_nest_start(msg, NL802154_ATTR_SUPPORTED_COMMANDS);
- if (!nl_cmds)
- goto nla_put_failure;
- i = 0;
- #define CMD(op, n) \
- do { \
- if (rdev->ops->op) { \
- i++; \
- if (nla_put_u32(msg, i, NL802154_CMD_ ## n)) \
- goto nla_put_failure; \
- } \
- } while (0)
- CMD(add_virtual_intf, NEW_INTERFACE);
- CMD(del_virtual_intf, DEL_INTERFACE);
- CMD(set_channel, SET_CHANNEL);
- CMD(set_pan_id, SET_PAN_ID);
- CMD(set_short_addr, SET_SHORT_ADDR);
- CMD(set_backoff_exponent, SET_BACKOFF_EXPONENT);
- CMD(set_max_csma_backoffs, SET_MAX_CSMA_BACKOFFS);
- CMD(set_max_frame_retries, SET_MAX_FRAME_RETRIES);
- CMD(set_lbt_mode, SET_LBT_MODE);
- CMD(set_ackreq_default, SET_ACKREQ_DEFAULT);
- if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_TXPOWER)
- CMD(set_tx_power, SET_TX_POWER);
- if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_ED_LEVEL)
- CMD(set_cca_ed_level, SET_CCA_ED_LEVEL);
- if (rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_MODE)
- CMD(set_cca_mode, SET_CCA_MODE);
- #undef CMD
- nla_nest_end(msg, nl_cmds);
- finish:
- genlmsg_end(msg, hdr);
- return 0;
- nla_put_failure:
- genlmsg_cancel(msg, hdr);
- return -EMSGSIZE;
- }
- struct nl802154_dump_wpan_phy_state {
- s64 filter_wpan_phy;
- long start;
- };
- static int nl802154_dump_wpan_phy_parse(struct sk_buff *skb,
- struct netlink_callback *cb,
- struct nl802154_dump_wpan_phy_state *state)
- {
- struct nlattr **tb = nl802154_fam.attrbuf;
- int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl802154_fam.hdrsize,
- tb, nl802154_fam.maxattr, nl802154_policy);
- /* TODO check if we can handle error here,
- * we have no backward compatibility
- */
- if (ret)
- return 0;
- if (tb[NL802154_ATTR_WPAN_PHY])
- state->filter_wpan_phy = nla_get_u32(tb[NL802154_ATTR_WPAN_PHY]);
- if (tb[NL802154_ATTR_WPAN_DEV])
- state->filter_wpan_phy = nla_get_u64(tb[NL802154_ATTR_WPAN_DEV]) >> 32;
- if (tb[NL802154_ATTR_IFINDEX]) {
- struct net_device *netdev;
- struct cfg802154_registered_device *rdev;
- int ifidx = nla_get_u32(tb[NL802154_ATTR_IFINDEX]);
- /* TODO netns */
- netdev = __dev_get_by_index(&init_net, ifidx);
- if (!netdev)
- return -ENODEV;
- if (netdev->ieee802154_ptr) {
- rdev = wpan_phy_to_rdev(
- netdev->ieee802154_ptr->wpan_phy);
- state->filter_wpan_phy = rdev->wpan_phy_idx;
- }
- }
- return 0;
- }
- static int
- nl802154_dump_wpan_phy(struct sk_buff *skb, struct netlink_callback *cb)
- {
- int idx = 0, ret;
- struct nl802154_dump_wpan_phy_state *state = (void *)cb->args[0];
- struct cfg802154_registered_device *rdev;
- rtnl_lock();
- if (!state) {
- state = kzalloc(sizeof(*state), GFP_KERNEL);
- if (!state) {
- rtnl_unlock();
- return -ENOMEM;
- }
- state->filter_wpan_phy = -1;
- ret = nl802154_dump_wpan_phy_parse(skb, cb, state);
- if (ret) {
- kfree(state);
- rtnl_unlock();
- return ret;
- }
- cb->args[0] = (long)state;
- }
- list_for_each_entry(rdev, &cfg802154_rdev_list, list) {
- /* TODO net ns compare */
- if (++idx <= state->start)
- continue;
- if (state->filter_wpan_phy != -1 &&
- state->filter_wpan_phy != rdev->wpan_phy_idx)
- continue;
- /* attempt to fit multiple wpan_phy data chunks into the skb */
- ret = nl802154_send_wpan_phy(rdev,
- NL802154_CMD_NEW_WPAN_PHY,
- skb,
- NETLINK_CB(cb->skb).portid,
- cb->nlh->nlmsg_seq, NLM_F_MULTI);
- if (ret < 0) {
- if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
- !skb->len && cb->min_dump_alloc < 4096) {
- cb->min_dump_alloc = 4096;
- rtnl_unlock();
- return 1;
- }
- idx--;
- break;
- }
- break;
- }
- rtnl_unlock();
- state->start = idx;
- return skb->len;
- }
- static int nl802154_dump_wpan_phy_done(struct netlink_callback *cb)
- {
- kfree((void *)cb->args[0]);
- return 0;
- }
- static int nl802154_get_wpan_phy(struct sk_buff *skb, struct genl_info *info)
- {
- struct sk_buff *msg;
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
- if (!msg)
- return -ENOMEM;
- if (nl802154_send_wpan_phy(rdev, NL802154_CMD_NEW_WPAN_PHY, msg,
- info->snd_portid, info->snd_seq, 0) < 0) {
- nlmsg_free(msg);
- return -ENOBUFS;
- }
- return genlmsg_reply(msg, info);
- }
- static inline u64 wpan_dev_id(struct wpan_dev *wpan_dev)
- {
- return (u64)wpan_dev->identifier |
- ((u64)wpan_phy_to_rdev(wpan_dev->wpan_phy)->wpan_phy_idx << 32);
- }
- #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
- #include <net/ieee802154_netdev.h>
- static int
- ieee802154_llsec_send_key_id(struct sk_buff *msg,
- const struct ieee802154_llsec_key_id *desc)
- {
- struct nlattr *nl_dev_addr;
- if (nla_put_u32(msg, NL802154_KEY_ID_ATTR_MODE, desc->mode))
- return -ENOBUFS;
- switch (desc->mode) {
- case NL802154_KEY_ID_MODE_IMPLICIT:
- nl_dev_addr = nla_nest_start(msg, NL802154_KEY_ID_ATTR_IMPLICIT);
- if (!nl_dev_addr)
- return -ENOBUFS;
- if (nla_put_le16(msg, NL802154_DEV_ADDR_ATTR_PAN_ID,
- desc->device_addr.pan_id) ||
- nla_put_u32(msg, NL802154_DEV_ADDR_ATTR_MODE,
- desc->device_addr.mode))
- return -ENOBUFS;
- switch (desc->device_addr.mode) {
- case NL802154_DEV_ADDR_SHORT:
- if (nla_put_le16(msg, NL802154_DEV_ADDR_ATTR_SHORT,
- desc->device_addr.short_addr))
- return -ENOBUFS;
- break;
- case NL802154_DEV_ADDR_EXTENDED:
- if (nla_put_le64(msg, NL802154_DEV_ADDR_ATTR_EXTENDED,
- desc->device_addr.extended_addr))
- return -ENOBUFS;
- break;
- default:
- /* userspace should handle unknown */
- break;
- }
- nla_nest_end(msg, nl_dev_addr);
- break;
- case NL802154_KEY_ID_MODE_INDEX:
- break;
- case NL802154_KEY_ID_MODE_INDEX_SHORT:
- /* TODO renmae short_source? */
- if (nla_put_le32(msg, NL802154_KEY_ID_ATTR_SOURCE_SHORT,
- desc->short_source))
- return -ENOBUFS;
- break;
- case NL802154_KEY_ID_MODE_INDEX_EXTENDED:
- if (nla_put_le64(msg, NL802154_KEY_ID_ATTR_SOURCE_EXTENDED,
- desc->extended_source))
- return -ENOBUFS;
- break;
- default:
- /* userspace should handle unknown */
- break;
- }
- /* TODO key_id to key_idx ? Check naming */
- if (desc->mode != NL802154_KEY_ID_MODE_IMPLICIT) {
- if (nla_put_u8(msg, NL802154_KEY_ID_ATTR_INDEX, desc->id))
- return -ENOBUFS;
- }
- return 0;
- }
- static int nl802154_get_llsec_params(struct sk_buff *msg,
- struct cfg802154_registered_device *rdev,
- struct wpan_dev *wpan_dev)
- {
- struct nlattr *nl_key_id;
- struct ieee802154_llsec_params params;
- int ret;
- ret = rdev_get_llsec_params(rdev, wpan_dev, ¶ms);
- if (ret < 0)
- return ret;
- if (nla_put_u8(msg, NL802154_ATTR_SEC_ENABLED, params.enabled) ||
- nla_put_u32(msg, NL802154_ATTR_SEC_OUT_LEVEL, params.out_level) ||
- nla_put_be32(msg, NL802154_ATTR_SEC_FRAME_COUNTER,
- params.frame_counter))
- return -ENOBUFS;
- nl_key_id = nla_nest_start(msg, NL802154_ATTR_SEC_OUT_KEY_ID);
- if (!nl_key_id)
- return -ENOBUFS;
- ret = ieee802154_llsec_send_key_id(msg, ¶ms.out_key);
- if (ret < 0)
- return ret;
- nla_nest_end(msg, nl_key_id);
- return 0;
- }
- #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
- static int
- nl802154_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
- struct cfg802154_registered_device *rdev,
- struct wpan_dev *wpan_dev)
- {
- struct net_device *dev = wpan_dev->netdev;
- void *hdr;
- hdr = nl802154hdr_put(msg, portid, seq, flags,
- NL802154_CMD_NEW_INTERFACE);
- if (!hdr)
- return -1;
- if (dev &&
- (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex) ||
- nla_put_string(msg, NL802154_ATTR_IFNAME, dev->name)))
- goto nla_put_failure;
- if (nla_put_u32(msg, NL802154_ATTR_WPAN_PHY, rdev->wpan_phy_idx) ||
- nla_put_u32(msg, NL802154_ATTR_IFTYPE, wpan_dev->iftype) ||
- nla_put_u64(msg, NL802154_ATTR_WPAN_DEV, wpan_dev_id(wpan_dev)) ||
- nla_put_u32(msg, NL802154_ATTR_GENERATION,
- rdev->devlist_generation ^
- (cfg802154_rdev_list_generation << 2)))
- goto nla_put_failure;
- /* address settings */
- if (nla_put_le64(msg, NL802154_ATTR_EXTENDED_ADDR,
- wpan_dev->extended_addr) ||
- nla_put_le16(msg, NL802154_ATTR_SHORT_ADDR,
- wpan_dev->short_addr) ||
- nla_put_le16(msg, NL802154_ATTR_PAN_ID, wpan_dev->pan_id))
- goto nla_put_failure;
- /* ARET handling */
- if (nla_put_s8(msg, NL802154_ATTR_MAX_FRAME_RETRIES,
- wpan_dev->frame_retries) ||
- nla_put_u8(msg, NL802154_ATTR_MAX_BE, wpan_dev->max_be) ||
- nla_put_u8(msg, NL802154_ATTR_MAX_CSMA_BACKOFFS,
- wpan_dev->csma_retries) ||
- nla_put_u8(msg, NL802154_ATTR_MIN_BE, wpan_dev->min_be))
- goto nla_put_failure;
- /* listen before transmit */
- if (nla_put_u8(msg, NL802154_ATTR_LBT_MODE, wpan_dev->lbt))
- goto nla_put_failure;
- /* ackreq default behaviour */
- if (nla_put_u8(msg, NL802154_ATTR_ACKREQ_DEFAULT, wpan_dev->ackreq))
- goto nla_put_failure;
- #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
- if (nl802154_get_llsec_params(msg, rdev, wpan_dev) < 0)
- goto nla_put_failure;
- #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
- genlmsg_end(msg, hdr);
- return 0;
- nla_put_failure:
- genlmsg_cancel(msg, hdr);
- return -EMSGSIZE;
- }
- static int
- nl802154_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
- {
- int wp_idx = 0;
- int if_idx = 0;
- int wp_start = cb->args[0];
- int if_start = cb->args[1];
- struct cfg802154_registered_device *rdev;
- struct wpan_dev *wpan_dev;
- rtnl_lock();
- list_for_each_entry(rdev, &cfg802154_rdev_list, list) {
- /* TODO netns compare */
- if (wp_idx < wp_start) {
- wp_idx++;
- continue;
- }
- if_idx = 0;
- list_for_each_entry(wpan_dev, &rdev->wpan_dev_list, list) {
- if (if_idx < if_start) {
- if_idx++;
- continue;
- }
- if (nl802154_send_iface(skb, NETLINK_CB(cb->skb).portid,
- cb->nlh->nlmsg_seq, NLM_F_MULTI,
- rdev, wpan_dev) < 0) {
- goto out;
- }
- if_idx++;
- }
- wp_idx++;
- }
- out:
- rtnl_unlock();
- cb->args[0] = wp_idx;
- cb->args[1] = if_idx;
- return skb->len;
- }
- static int nl802154_get_interface(struct sk_buff *skb, struct genl_info *info)
- {
- struct sk_buff *msg;
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct wpan_dev *wdev = info->user_ptr[1];
- msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
- if (!msg)
- return -ENOMEM;
- if (nl802154_send_iface(msg, info->snd_portid, info->snd_seq, 0,
- rdev, wdev) < 0) {
- nlmsg_free(msg);
- return -ENOBUFS;
- }
- return genlmsg_reply(msg, info);
- }
- static int nl802154_new_interface(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- enum nl802154_iftype type = NL802154_IFTYPE_UNSPEC;
- __le64 extended_addr = cpu_to_le64(0x0000000000000000ULL);
- /* TODO avoid failing a new interface
- * creation due to pending removal?
- */
- if (!info->attrs[NL802154_ATTR_IFNAME])
- return -EINVAL;
- if (info->attrs[NL802154_ATTR_IFTYPE]) {
- type = nla_get_u32(info->attrs[NL802154_ATTR_IFTYPE]);
- if (type > NL802154_IFTYPE_MAX ||
- !(rdev->wpan_phy.supported.iftypes & BIT(type)))
- return -EINVAL;
- }
- if (info->attrs[NL802154_ATTR_EXTENDED_ADDR])
- extended_addr = nla_get_le64(info->attrs[NL802154_ATTR_EXTENDED_ADDR]);
- if (!rdev->ops->add_virtual_intf)
- return -EOPNOTSUPP;
- return rdev_add_virtual_intf(rdev,
- nla_data(info->attrs[NL802154_ATTR_IFNAME]),
- NET_NAME_USER, type, extended_addr);
- }
- static int nl802154_del_interface(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct wpan_dev *wpan_dev = info->user_ptr[1];
- if (!rdev->ops->del_virtual_intf)
- return -EOPNOTSUPP;
- /* If we remove a wpan device without a netdev then clear
- * user_ptr[1] so that nl802154_post_doit won't dereference it
- * to check if it needs to do dev_put(). Otherwise it crashes
- * since the wpan_dev has been freed, unlike with a netdev where
- * we need the dev_put() for the netdev to really be freed.
- */
- if (!wpan_dev->netdev)
- info->user_ptr[1] = NULL;
- return rdev_del_virtual_intf(rdev, wpan_dev);
- }
- static int nl802154_set_channel(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- u8 channel, page;
- if (!info->attrs[NL802154_ATTR_PAGE] ||
- !info->attrs[NL802154_ATTR_CHANNEL])
- return -EINVAL;
- page = nla_get_u8(info->attrs[NL802154_ATTR_PAGE]);
- channel = nla_get_u8(info->attrs[NL802154_ATTR_CHANNEL]);
- /* check 802.15.4 constraints */
- if (page > IEEE802154_MAX_PAGE || channel > IEEE802154_MAX_CHANNEL ||
- !(rdev->wpan_phy.supported.channels[page] & BIT(channel)))
- return -EINVAL;
- return rdev_set_channel(rdev, page, channel);
- }
- static int nl802154_set_cca_mode(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct wpan_phy_cca cca;
- if (!(rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_MODE))
- return -EOPNOTSUPP;
- if (!info->attrs[NL802154_ATTR_CCA_MODE])
- return -EINVAL;
- cca.mode = nla_get_u32(info->attrs[NL802154_ATTR_CCA_MODE]);
- /* checking 802.15.4 constraints */
- if (cca.mode < NL802154_CCA_ENERGY ||
- cca.mode > NL802154_CCA_ATTR_MAX ||
- !(rdev->wpan_phy.supported.cca_modes & BIT(cca.mode)))
- return -EINVAL;
- if (cca.mode == NL802154_CCA_ENERGY_CARRIER) {
- if (!info->attrs[NL802154_ATTR_CCA_OPT])
- return -EINVAL;
- cca.opt = nla_get_u32(info->attrs[NL802154_ATTR_CCA_OPT]);
- if (cca.opt > NL802154_CCA_OPT_ATTR_MAX ||
- !(rdev->wpan_phy.supported.cca_opts & BIT(cca.opt)))
- return -EINVAL;
- }
- return rdev_set_cca_mode(rdev, &cca);
- }
- static int nl802154_set_cca_ed_level(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- s32 ed_level;
- int i;
- if (!(rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_ED_LEVEL))
- return -EOPNOTSUPP;
- if (!info->attrs[NL802154_ATTR_CCA_ED_LEVEL])
- return -EINVAL;
- ed_level = nla_get_s32(info->attrs[NL802154_ATTR_CCA_ED_LEVEL]);
- for (i = 0; i < rdev->wpan_phy.supported.cca_ed_levels_size; i++) {
- if (ed_level == rdev->wpan_phy.supported.cca_ed_levels[i])
- return rdev_set_cca_ed_level(rdev, ed_level);
- }
- return -EINVAL;
- }
- static int nl802154_set_tx_power(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- s32 power;
- int i;
- if (!(rdev->wpan_phy.flags & WPAN_PHY_FLAG_TXPOWER))
- return -EOPNOTSUPP;
- if (!info->attrs[NL802154_ATTR_TX_POWER])
- return -EINVAL;
- power = nla_get_s32(info->attrs[NL802154_ATTR_TX_POWER]);
- for (i = 0; i < rdev->wpan_phy.supported.tx_powers_size; i++) {
- if (power == rdev->wpan_phy.supported.tx_powers[i])
- return rdev_set_tx_power(rdev, power);
- }
- return -EINVAL;
- }
- static int nl802154_set_pan_id(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- __le16 pan_id;
- /* conflict here while tx/rx calls */
- if (netif_running(dev))
- return -EBUSY;
- /* don't change address fields on monitor */
- if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR ||
- !info->attrs[NL802154_ATTR_PAN_ID])
- return -EINVAL;
- pan_id = nla_get_le16(info->attrs[NL802154_ATTR_PAN_ID]);
- /* TODO
- * I am not sure about to check here on broadcast pan_id.
- * Broadcast is a valid setting, comment from 802.15.4:
- * If this value is 0xffff, the device is not associated.
- *
- * This could useful to simple deassociate an device.
- */
- if (pan_id == cpu_to_le16(IEEE802154_PAN_ID_BROADCAST))
- return -EINVAL;
- return rdev_set_pan_id(rdev, wpan_dev, pan_id);
- }
- static int nl802154_set_short_addr(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- __le16 short_addr;
- /* conflict here while tx/rx calls */
- if (netif_running(dev))
- return -EBUSY;
- /* don't change address fields on monitor */
- if (wpan_dev->iftype == NL802154_IFTYPE_MONITOR ||
- !info->attrs[NL802154_ATTR_SHORT_ADDR])
- return -EINVAL;
- short_addr = nla_get_le16(info->attrs[NL802154_ATTR_SHORT_ADDR]);
- /* TODO
- * I am not sure about to check here on broadcast short_addr.
- * Broadcast is a valid setting, comment from 802.15.4:
- * A value of 0xfffe indicates that the device has
- * associated but has not been allocated an address. A
- * value of 0xffff indicates that the device does not
- * have a short address.
- *
- * I think we should allow to set these settings but
- * don't allow to allow socket communication with it.
- */
- if (short_addr == cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC) ||
- short_addr == cpu_to_le16(IEEE802154_ADDR_SHORT_BROADCAST))
- return -EINVAL;
- return rdev_set_short_addr(rdev, wpan_dev, short_addr);
- }
- static int
- nl802154_set_backoff_exponent(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- u8 min_be, max_be;
- /* should be set on netif open inside phy settings */
- if (netif_running(dev))
- return -EBUSY;
- if (!info->attrs[NL802154_ATTR_MIN_BE] ||
- !info->attrs[NL802154_ATTR_MAX_BE])
- return -EINVAL;
- min_be = nla_get_u8(info->attrs[NL802154_ATTR_MIN_BE]);
- max_be = nla_get_u8(info->attrs[NL802154_ATTR_MAX_BE]);
- /* check 802.15.4 constraints */
- if (min_be < rdev->wpan_phy.supported.min_minbe ||
- min_be > rdev->wpan_phy.supported.max_minbe ||
- max_be < rdev->wpan_phy.supported.min_maxbe ||
- max_be > rdev->wpan_phy.supported.max_maxbe ||
- min_be > max_be)
- return -EINVAL;
- return rdev_set_backoff_exponent(rdev, wpan_dev, min_be, max_be);
- }
- static int
- nl802154_set_max_csma_backoffs(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- u8 max_csma_backoffs;
- /* conflict here while other running iface settings */
- if (netif_running(dev))
- return -EBUSY;
- if (!info->attrs[NL802154_ATTR_MAX_CSMA_BACKOFFS])
- return -EINVAL;
- max_csma_backoffs = nla_get_u8(
- info->attrs[NL802154_ATTR_MAX_CSMA_BACKOFFS]);
- /* check 802.15.4 constraints */
- if (max_csma_backoffs < rdev->wpan_phy.supported.min_csma_backoffs ||
- max_csma_backoffs > rdev->wpan_phy.supported.max_csma_backoffs)
- return -EINVAL;
- return rdev_set_max_csma_backoffs(rdev, wpan_dev, max_csma_backoffs);
- }
- static int
- nl802154_set_max_frame_retries(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- s8 max_frame_retries;
- if (netif_running(dev))
- return -EBUSY;
- if (!info->attrs[NL802154_ATTR_MAX_FRAME_RETRIES])
- return -EINVAL;
- max_frame_retries = nla_get_s8(
- info->attrs[NL802154_ATTR_MAX_FRAME_RETRIES]);
- /* check 802.15.4 constraints */
- if (max_frame_retries < rdev->wpan_phy.supported.min_frame_retries ||
- max_frame_retries > rdev->wpan_phy.supported.max_frame_retries)
- return -EINVAL;
- return rdev_set_max_frame_retries(rdev, wpan_dev, max_frame_retries);
- }
- static int nl802154_set_lbt_mode(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- int mode;
- if (netif_running(dev))
- return -EBUSY;
- if (!info->attrs[NL802154_ATTR_LBT_MODE])
- return -EINVAL;
- mode = nla_get_u8(info->attrs[NL802154_ATTR_LBT_MODE]);
- if (mode != 0 && mode != 1)
- return -EINVAL;
- if (!wpan_phy_supported_bool(mode, rdev->wpan_phy.supported.lbt))
- return -EINVAL;
- return rdev_set_lbt_mode(rdev, wpan_dev, mode);
- }
- static int
- nl802154_set_ackreq_default(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- int ackreq;
- if (netif_running(dev))
- return -EBUSY;
- if (!info->attrs[NL802154_ATTR_ACKREQ_DEFAULT])
- return -EINVAL;
- ackreq = nla_get_u8(info->attrs[NL802154_ATTR_ACKREQ_DEFAULT]);
- if (ackreq != 0 && ackreq != 1)
- return -EINVAL;
- return rdev_set_ackreq_default(rdev, wpan_dev, ackreq);
- }
- #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
- static const struct nla_policy nl802154_dev_addr_policy[NL802154_DEV_ADDR_ATTR_MAX + 1] = {
- [NL802154_DEV_ADDR_ATTR_PAN_ID] = { .type = NLA_U16 },
- [NL802154_DEV_ADDR_ATTR_MODE] = { .type = NLA_U32 },
- [NL802154_DEV_ADDR_ATTR_SHORT] = { .type = NLA_U16 },
- [NL802154_DEV_ADDR_ATTR_EXTENDED] = { .type = NLA_U64 },
- };
- static int
- ieee802154_llsec_parse_dev_addr(struct nlattr *nla,
- struct ieee802154_addr *addr)
- {
- struct nlattr *attrs[NL802154_DEV_ADDR_ATTR_MAX + 1];
- if (!nla || nla_parse_nested(attrs, NL802154_DEV_ADDR_ATTR_MAX, nla,
- nl802154_dev_addr_policy))
- return -EINVAL;
- if (!attrs[NL802154_DEV_ADDR_ATTR_PAN_ID] &&
- !attrs[NL802154_DEV_ADDR_ATTR_MODE] &&
- !(attrs[NL802154_DEV_ADDR_ATTR_SHORT] ||
- attrs[NL802154_DEV_ADDR_ATTR_EXTENDED]))
- return -EINVAL;
- addr->pan_id = nla_get_le16(attrs[NL802154_DEV_ADDR_ATTR_PAN_ID]);
- addr->mode = nla_get_u32(attrs[NL802154_DEV_ADDR_ATTR_MODE]);
- switch (addr->mode) {
- case NL802154_DEV_ADDR_SHORT:
- addr->short_addr = nla_get_le16(attrs[NL802154_DEV_ADDR_ATTR_SHORT]);
- break;
- case NL802154_DEV_ADDR_EXTENDED:
- addr->extended_addr = nla_get_le64(attrs[NL802154_DEV_ADDR_ATTR_EXTENDED]);
- break;
- default:
- return -EINVAL;
- }
- return 0;
- }
- static const struct nla_policy nl802154_key_id_policy[NL802154_KEY_ID_ATTR_MAX + 1] = {
- [NL802154_KEY_ID_ATTR_MODE] = { .type = NLA_U32 },
- [NL802154_KEY_ID_ATTR_INDEX] = { .type = NLA_U8 },
- [NL802154_KEY_ID_ATTR_IMPLICIT] = { .type = NLA_NESTED },
- [NL802154_KEY_ID_ATTR_SOURCE_SHORT] = { .type = NLA_U32 },
- [NL802154_KEY_ID_ATTR_SOURCE_EXTENDED] = { .type = NLA_U64 },
- };
- static int
- ieee802154_llsec_parse_key_id(struct nlattr *nla,
- struct ieee802154_llsec_key_id *desc)
- {
- struct nlattr *attrs[NL802154_KEY_ID_ATTR_MAX + 1];
- if (!nla || nla_parse_nested(attrs, NL802154_KEY_ID_ATTR_MAX, nla,
- nl802154_key_id_policy))
- return -EINVAL;
- if (!attrs[NL802154_KEY_ID_ATTR_MODE])
- return -EINVAL;
- desc->mode = nla_get_u32(attrs[NL802154_KEY_ID_ATTR_MODE]);
- switch (desc->mode) {
- case NL802154_KEY_ID_MODE_IMPLICIT:
- if (!attrs[NL802154_KEY_ID_ATTR_IMPLICIT])
- return -EINVAL;
- if (ieee802154_llsec_parse_dev_addr(attrs[NL802154_KEY_ID_ATTR_IMPLICIT],
- &desc->device_addr) < 0)
- return -EINVAL;
- break;
- case NL802154_KEY_ID_MODE_INDEX:
- break;
- case NL802154_KEY_ID_MODE_INDEX_SHORT:
- if (!attrs[NL802154_KEY_ID_ATTR_SOURCE_SHORT])
- return -EINVAL;
- desc->short_source = nla_get_le32(attrs[NL802154_KEY_ID_ATTR_SOURCE_SHORT]);
- break;
- case NL802154_KEY_ID_MODE_INDEX_EXTENDED:
- if (!attrs[NL802154_KEY_ID_ATTR_SOURCE_EXTENDED])
- return -EINVAL;
- desc->extended_source = nla_get_le64(attrs[NL802154_KEY_ID_ATTR_SOURCE_EXTENDED]);
- break;
- default:
- return -EINVAL;
- }
- if (desc->mode != NL802154_KEY_ID_MODE_IMPLICIT) {
- if (!attrs[NL802154_KEY_ID_ATTR_INDEX])
- return -EINVAL;
- /* TODO change id to idx */
- desc->id = nla_get_u8(attrs[NL802154_KEY_ID_ATTR_INDEX]);
- }
- return 0;
- }
- static int nl802154_set_llsec_params(struct sk_buff *skb,
- struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- struct ieee802154_llsec_params params;
- u32 changed = 0;
- int ret;
- if (info->attrs[NL802154_ATTR_SEC_ENABLED]) {
- u8 enabled;
- enabled = nla_get_u8(info->attrs[NL802154_ATTR_SEC_ENABLED]);
- if (enabled != 0 && enabled != 1)
- return -EINVAL;
- params.enabled = nla_get_u8(info->attrs[NL802154_ATTR_SEC_ENABLED]);
- changed |= IEEE802154_LLSEC_PARAM_ENABLED;
- }
- if (info->attrs[NL802154_ATTR_SEC_OUT_KEY_ID]) {
- ret = ieee802154_llsec_parse_key_id(info->attrs[NL802154_ATTR_SEC_OUT_KEY_ID],
- ¶ms.out_key);
- if (ret < 0)
- return ret;
- changed |= IEEE802154_LLSEC_PARAM_OUT_KEY;
- }
- if (info->attrs[NL802154_ATTR_SEC_OUT_LEVEL]) {
- params.out_level = nla_get_u32(info->attrs[NL802154_ATTR_SEC_OUT_LEVEL]);
- if (params.out_level > NL802154_SECLEVEL_MAX)
- return -EINVAL;
- changed |= IEEE802154_LLSEC_PARAM_OUT_LEVEL;
- }
- if (info->attrs[NL802154_ATTR_SEC_FRAME_COUNTER]) {
- params.frame_counter = nla_get_be32(info->attrs[NL802154_ATTR_SEC_FRAME_COUNTER]);
- changed |= IEEE802154_LLSEC_PARAM_FRAME_COUNTER;
- }
- return rdev_set_llsec_params(rdev, wpan_dev, ¶ms, changed);
- }
- static int nl802154_send_key(struct sk_buff *msg, u32 cmd, u32 portid,
- u32 seq, int flags,
- struct cfg802154_registered_device *rdev,
- struct net_device *dev,
- const struct ieee802154_llsec_key_entry *key)
- {
- void *hdr;
- u32 commands[NL802154_CMD_FRAME_NR_IDS / 32];
- struct nlattr *nl_key, *nl_key_id;
- hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
- if (!hdr)
- return -1;
- if (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex))
- goto nla_put_failure;
- nl_key = nla_nest_start(msg, NL802154_ATTR_SEC_KEY);
- if (!nl_key)
- goto nla_put_failure;
- nl_key_id = nla_nest_start(msg, NL802154_KEY_ATTR_ID);
- if (!nl_key_id)
- goto nla_put_failure;
- if (ieee802154_llsec_send_key_id(msg, &key->id) < 0)
- goto nla_put_failure;
- nla_nest_end(msg, nl_key_id);
- if (nla_put_u8(msg, NL802154_KEY_ATTR_USAGE_FRAMES,
- key->key->frame_types))
- goto nla_put_failure;
- if (key->key->frame_types & BIT(NL802154_FRAME_CMD)) {
- /* TODO for each nested */
- memset(commands, 0, sizeof(commands));
- commands[7] = key->key->cmd_frame_ids;
- if (nla_put(msg, NL802154_KEY_ATTR_USAGE_CMDS,
- sizeof(commands), commands))
- goto nla_put_failure;
- }
- if (nla_put(msg, NL802154_KEY_ATTR_BYTES, NL802154_KEY_SIZE,
- key->key->key))
- goto nla_put_failure;
- nla_nest_end(msg, nl_key);
- genlmsg_end(msg, hdr);
- return 0;
- nla_put_failure:
- genlmsg_cancel(msg, hdr);
- return -EMSGSIZE;
- }
- static int
- nl802154_dump_llsec_key(struct sk_buff *skb, struct netlink_callback *cb)
- {
- struct cfg802154_registered_device *rdev = NULL;
- struct ieee802154_llsec_key_entry *key;
- struct ieee802154_llsec_table *table;
- struct wpan_dev *wpan_dev;
- int err;
- err = nl802154_prepare_wpan_dev_dump(skb, cb, &rdev, &wpan_dev);
- if (err)
- return err;
- if (!wpan_dev->netdev) {
- err = -EINVAL;
- goto out_err;
- }
- rdev_lock_llsec_table(rdev, wpan_dev);
- rdev_get_llsec_table(rdev, wpan_dev, &table);
- /* TODO make it like station dump */
- if (cb->args[2])
- goto out;
- list_for_each_entry(key, &table->keys, list) {
- if (nl802154_send_key(skb, NL802154_CMD_NEW_SEC_KEY,
- NETLINK_CB(cb->skb).portid,
- cb->nlh->nlmsg_seq, NLM_F_MULTI,
- rdev, wpan_dev->netdev, key) < 0) {
- /* TODO */
- err = -EIO;
- rdev_unlock_llsec_table(rdev, wpan_dev);
- goto out_err;
- }
- }
- cb->args[2] = 1;
- out:
- rdev_unlock_llsec_table(rdev, wpan_dev);
- err = skb->len;
- out_err:
- nl802154_finish_wpan_dev_dump(rdev);
- return err;
- }
- static const struct nla_policy nl802154_key_policy[NL802154_KEY_ATTR_MAX + 1] = {
- [NL802154_KEY_ATTR_ID] = { NLA_NESTED },
- /* TODO handle it as for_each_nested and NLA_FLAG? */
- [NL802154_KEY_ATTR_USAGE_FRAMES] = { NLA_U8 },
- /* TODO handle it as for_each_nested, not static array? */
- [NL802154_KEY_ATTR_USAGE_CMDS] = { .len = NL802154_CMD_FRAME_NR_IDS / 8 },
- [NL802154_KEY_ATTR_BYTES] = { .len = NL802154_KEY_SIZE },
- };
- static int nl802154_add_llsec_key(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- struct nlattr *attrs[NL802154_KEY_ATTR_MAX + 1];
- struct ieee802154_llsec_key key = { };
- struct ieee802154_llsec_key_id id = { };
- u32 commands[NL802154_CMD_FRAME_NR_IDS / 32] = { };
- if (nla_parse_nested(attrs, NL802154_KEY_ATTR_MAX,
- info->attrs[NL802154_ATTR_SEC_KEY],
- nl802154_key_policy))
- return -EINVAL;
- if (!attrs[NL802154_KEY_ATTR_USAGE_FRAMES] ||
- !attrs[NL802154_KEY_ATTR_BYTES])
- return -EINVAL;
- if (ieee802154_llsec_parse_key_id(attrs[NL802154_KEY_ATTR_ID], &id) < 0)
- return -ENOBUFS;
- key.frame_types = nla_get_u8(attrs[NL802154_KEY_ATTR_USAGE_FRAMES]);
- if (key.frame_types > BIT(NL802154_FRAME_MAX) ||
- ((key.frame_types & BIT(NL802154_FRAME_CMD)) &&
- !attrs[NL802154_KEY_ATTR_USAGE_CMDS]))
- return -EINVAL;
- if (attrs[NL802154_KEY_ATTR_USAGE_CMDS]) {
- /* TODO for each nested */
- nla_memcpy(commands, attrs[NL802154_KEY_ATTR_USAGE_CMDS],
- NL802154_CMD_FRAME_NR_IDS / 8);
- /* TODO understand the -EINVAL logic here? last condition */
- if (commands[0] || commands[1] || commands[2] || commands[3] ||
- commands[4] || commands[5] || commands[6] ||
- commands[7] > BIT(NL802154_CMD_FRAME_MAX))
- return -EINVAL;
- key.cmd_frame_ids = commands[7];
- } else {
- key.cmd_frame_ids = 0;
- }
- nla_memcpy(key.key, attrs[NL802154_KEY_ATTR_BYTES], NL802154_KEY_SIZE);
- if (ieee802154_llsec_parse_key_id(attrs[NL802154_KEY_ATTR_ID], &id) < 0)
- return -ENOBUFS;
- return rdev_add_llsec_key(rdev, wpan_dev, &id, &key);
- }
- static int nl802154_del_llsec_key(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- struct nlattr *attrs[NL802154_KEY_ATTR_MAX + 1];
- struct ieee802154_llsec_key_id id;
- if (nla_parse_nested(attrs, NL802154_KEY_ATTR_MAX,
- info->attrs[NL802154_ATTR_SEC_KEY],
- nl802154_key_policy))
- return -EINVAL;
- if (ieee802154_llsec_parse_key_id(attrs[NL802154_KEY_ATTR_ID], &id) < 0)
- return -ENOBUFS;
- return rdev_del_llsec_key(rdev, wpan_dev, &id);
- }
- static int nl802154_send_device(struct sk_buff *msg, u32 cmd, u32 portid,
- u32 seq, int flags,
- struct cfg802154_registered_device *rdev,
- struct net_device *dev,
- const struct ieee802154_llsec_device *dev_desc)
- {
- void *hdr;
- struct nlattr *nl_device;
- hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
- if (!hdr)
- return -1;
- if (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex))
- goto nla_put_failure;
- nl_device = nla_nest_start(msg, NL802154_ATTR_SEC_DEVICE);
- if (!nl_device)
- goto nla_put_failure;
- if (nla_put_u32(msg, NL802154_DEV_ATTR_FRAME_COUNTER,
- dev_desc->frame_counter) ||
- nla_put_le16(msg, NL802154_DEV_ATTR_PAN_ID, dev_desc->pan_id) ||
- nla_put_le16(msg, NL802154_DEV_ATTR_SHORT_ADDR,
- dev_desc->short_addr) ||
- nla_put_le64(msg, NL802154_DEV_ATTR_EXTENDED_ADDR,
- dev_desc->hwaddr) ||
- nla_put_u8(msg, NL802154_DEV_ATTR_SECLEVEL_EXEMPT,
- dev_desc->seclevel_exempt) ||
- nla_put_u32(msg, NL802154_DEV_ATTR_KEY_MODE, dev_desc->key_mode))
- goto nla_put_failure;
- nla_nest_end(msg, nl_device);
- genlmsg_end(msg, hdr);
- return 0;
- nla_put_failure:
- genlmsg_cancel(msg, hdr);
- return -EMSGSIZE;
- }
- static int
- nl802154_dump_llsec_dev(struct sk_buff *skb, struct netlink_callback *cb)
- {
- struct cfg802154_registered_device *rdev = NULL;
- struct ieee802154_llsec_device *dev;
- struct ieee802154_llsec_table *table;
- struct wpan_dev *wpan_dev;
- int err;
- err = nl802154_prepare_wpan_dev_dump(skb, cb, &rdev, &wpan_dev);
- if (err)
- return err;
- if (!wpan_dev->netdev) {
- err = -EINVAL;
- goto out_err;
- }
- rdev_lock_llsec_table(rdev, wpan_dev);
- rdev_get_llsec_table(rdev, wpan_dev, &table);
- /* TODO make it like station dump */
- if (cb->args[2])
- goto out;
- list_for_each_entry(dev, &table->devices, list) {
- if (nl802154_send_device(skb, NL802154_CMD_NEW_SEC_LEVEL,
- NETLINK_CB(cb->skb).portid,
- cb->nlh->nlmsg_seq, NLM_F_MULTI,
- rdev, wpan_dev->netdev, dev) < 0) {
- /* TODO */
- err = -EIO;
- rdev_unlock_llsec_table(rdev, wpan_dev);
- goto out_err;
- }
- }
- cb->args[2] = 1;
- out:
- rdev_unlock_llsec_table(rdev, wpan_dev);
- err = skb->len;
- out_err:
- nl802154_finish_wpan_dev_dump(rdev);
- return err;
- }
- static const struct nla_policy nl802154_dev_policy[NL802154_DEV_ATTR_MAX + 1] = {
- [NL802154_DEV_ATTR_FRAME_COUNTER] = { NLA_U32 },
- [NL802154_DEV_ATTR_PAN_ID] = { .type = NLA_U16 },
- [NL802154_DEV_ATTR_SHORT_ADDR] = { .type = NLA_U16 },
- [NL802154_DEV_ATTR_EXTENDED_ADDR] = { .type = NLA_U64 },
- [NL802154_DEV_ATTR_SECLEVEL_EXEMPT] = { NLA_U8 },
- [NL802154_DEV_ATTR_KEY_MODE] = { NLA_U32 },
- };
- static int
- ieee802154_llsec_parse_device(struct nlattr *nla,
- struct ieee802154_llsec_device *dev)
- {
- struct nlattr *attrs[NL802154_DEV_ATTR_MAX + 1];
- if (!nla || nla_parse_nested(attrs, NL802154_DEV_ATTR_MAX, nla,
- nl802154_dev_policy))
- return -EINVAL;
- memset(dev, 0, sizeof(*dev));
- if (!attrs[NL802154_DEV_ATTR_FRAME_COUNTER] ||
- !attrs[NL802154_DEV_ATTR_PAN_ID] ||
- !attrs[NL802154_DEV_ATTR_SHORT_ADDR] ||
- !attrs[NL802154_DEV_ATTR_EXTENDED_ADDR] ||
- !attrs[NL802154_DEV_ATTR_SECLEVEL_EXEMPT] ||
- !attrs[NL802154_DEV_ATTR_KEY_MODE])
- return -EINVAL;
- /* TODO be32 */
- dev->frame_counter = nla_get_u32(attrs[NL802154_DEV_ATTR_FRAME_COUNTER]);
- dev->pan_id = nla_get_le16(attrs[NL802154_DEV_ATTR_PAN_ID]);
- dev->short_addr = nla_get_le16(attrs[NL802154_DEV_ATTR_SHORT_ADDR]);
- /* TODO rename hwaddr to extended_addr */
- dev->hwaddr = nla_get_le64(attrs[NL802154_DEV_ATTR_EXTENDED_ADDR]);
- dev->seclevel_exempt = nla_get_u8(attrs[NL802154_DEV_ATTR_SECLEVEL_EXEMPT]);
- dev->key_mode = nla_get_u32(attrs[NL802154_DEV_ATTR_KEY_MODE]);
- if (dev->key_mode > NL802154_DEVKEY_MAX ||
- (dev->seclevel_exempt != 0 && dev->seclevel_exempt != 1))
- return -EINVAL;
- return 0;
- }
- static int nl802154_add_llsec_dev(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- struct ieee802154_llsec_device dev_desc;
- if (ieee802154_llsec_parse_device(info->attrs[NL802154_ATTR_SEC_DEVICE],
- &dev_desc) < 0)
- return -EINVAL;
- return rdev_add_device(rdev, wpan_dev, &dev_desc);
- }
- static int nl802154_del_llsec_dev(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- struct nlattr *attrs[NL802154_DEV_ATTR_MAX + 1];
- __le64 extended_addr;
- if (nla_parse_nested(attrs, NL802154_DEV_ATTR_MAX,
- info->attrs[NL802154_ATTR_SEC_DEVICE],
- nl802154_dev_policy))
- return -EINVAL;
- if (!attrs[NL802154_DEV_ATTR_EXTENDED_ADDR])
- return -EINVAL;
- extended_addr = nla_get_le64(attrs[NL802154_DEV_ATTR_EXTENDED_ADDR]);
- return rdev_del_device(rdev, wpan_dev, extended_addr);
- }
- static int nl802154_send_devkey(struct sk_buff *msg, u32 cmd, u32 portid,
- u32 seq, int flags,
- struct cfg802154_registered_device *rdev,
- struct net_device *dev, __le64 extended_addr,
- const struct ieee802154_llsec_device_key *devkey)
- {
- void *hdr;
- struct nlattr *nl_devkey, *nl_key_id;
- hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
- if (!hdr)
- return -1;
- if (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex))
- goto nla_put_failure;
- nl_devkey = nla_nest_start(msg, NL802154_ATTR_SEC_DEVKEY);
- if (!nl_devkey)
- goto nla_put_failure;
- if (nla_put_le64(msg, NL802154_DEVKEY_ATTR_EXTENDED_ADDR,
- extended_addr) ||
- nla_put_u32(msg, NL802154_DEVKEY_ATTR_FRAME_COUNTER,
- devkey->frame_counter))
- goto nla_put_failure;
- nl_key_id = nla_nest_start(msg, NL802154_DEVKEY_ATTR_ID);
- if (!nl_key_id)
- goto nla_put_failure;
- if (ieee802154_llsec_send_key_id(msg, &devkey->key_id) < 0)
- goto nla_put_failure;
- nla_nest_end(msg, nl_key_id);
- nla_nest_end(msg, nl_devkey);
- genlmsg_end(msg, hdr);
- return 0;
- nla_put_failure:
- genlmsg_cancel(msg, hdr);
- return -EMSGSIZE;
- }
- static int
- nl802154_dump_llsec_devkey(struct sk_buff *skb, struct netlink_callback *cb)
- {
- struct cfg802154_registered_device *rdev = NULL;
- struct ieee802154_llsec_device_key *kpos;
- struct ieee802154_llsec_device *dpos;
- struct ieee802154_llsec_table *table;
- struct wpan_dev *wpan_dev;
- int err;
- err = nl802154_prepare_wpan_dev_dump(skb, cb, &rdev, &wpan_dev);
- if (err)
- return err;
- if (!wpan_dev->netdev) {
- err = -EINVAL;
- goto out_err;
- }
- rdev_lock_llsec_table(rdev, wpan_dev);
- rdev_get_llsec_table(rdev, wpan_dev, &table);
- /* TODO make it like station dump */
- if (cb->args[2])
- goto out;
- /* TODO look if remove devkey and do some nested attribute */
- list_for_each_entry(dpos, &table->devices, list) {
- list_for_each_entry(kpos, &dpos->keys, list) {
- if (nl802154_send_devkey(skb,
- NL802154_CMD_NEW_SEC_LEVEL,
- NETLINK_CB(cb->skb).portid,
- cb->nlh->nlmsg_seq,
- NLM_F_MULTI, rdev,
- wpan_dev->netdev,
- dpos->hwaddr,
- kpos) < 0) {
- /* TODO */
- err = -EIO;
- rdev_unlock_llsec_table(rdev, wpan_dev);
- goto out_err;
- }
- }
- }
- cb->args[2] = 1;
- out:
- rdev_unlock_llsec_table(rdev, wpan_dev);
- err = skb->len;
- out_err:
- nl802154_finish_wpan_dev_dump(rdev);
- return err;
- }
- static const struct nla_policy nl802154_devkey_policy[NL802154_DEVKEY_ATTR_MAX + 1] = {
- [NL802154_DEVKEY_ATTR_FRAME_COUNTER] = { NLA_U32 },
- [NL802154_DEVKEY_ATTR_EXTENDED_ADDR] = { NLA_U64 },
- [NL802154_DEVKEY_ATTR_ID] = { NLA_NESTED },
- };
- static int nl802154_add_llsec_devkey(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- struct nlattr *attrs[NL802154_DEVKEY_ATTR_MAX + 1];
- struct ieee802154_llsec_device_key key;
- __le64 extended_addr;
- if (!info->attrs[NL802154_ATTR_SEC_DEVKEY] ||
- nla_parse_nested(attrs, NL802154_DEVKEY_ATTR_MAX,
- info->attrs[NL802154_ATTR_SEC_DEVKEY],
- nl802154_devkey_policy) < 0)
- return -EINVAL;
- if (!attrs[NL802154_DEVKEY_ATTR_FRAME_COUNTER] ||
- !attrs[NL802154_DEVKEY_ATTR_EXTENDED_ADDR])
- return -EINVAL;
- /* TODO change key.id ? */
- if (ieee802154_llsec_parse_key_id(attrs[NL802154_DEVKEY_ATTR_ID],
- &key.key_id) < 0)
- return -ENOBUFS;
- /* TODO be32 */
- key.frame_counter = nla_get_u32(attrs[NL802154_DEVKEY_ATTR_FRAME_COUNTER]);
- /* TODO change naming hwaddr -> extended_addr
- * check unique identifier short+pan OR extended_addr
- */
- extended_addr = nla_get_le64(attrs[NL802154_DEVKEY_ATTR_EXTENDED_ADDR]);
- return rdev_add_devkey(rdev, wpan_dev, extended_addr, &key);
- }
- static int nl802154_del_llsec_devkey(struct sk_buff *skb, struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- struct nlattr *attrs[NL802154_DEVKEY_ATTR_MAX + 1];
- struct ieee802154_llsec_device_key key;
- __le64 extended_addr;
- if (nla_parse_nested(attrs, NL802154_DEVKEY_ATTR_MAX,
- info->attrs[NL802154_ATTR_SEC_DEVKEY],
- nl802154_devkey_policy))
- return -EINVAL;
- if (!attrs[NL802154_DEVKEY_ATTR_EXTENDED_ADDR])
- return -EINVAL;
- /* TODO change key.id ? */
- if (ieee802154_llsec_parse_key_id(attrs[NL802154_DEVKEY_ATTR_ID],
- &key.key_id) < 0)
- return -ENOBUFS;
- /* TODO change naming hwaddr -> extended_addr
- * check unique identifier short+pan OR extended_addr
- */
- extended_addr = nla_get_le64(attrs[NL802154_DEVKEY_ATTR_EXTENDED_ADDR]);
- return rdev_del_devkey(rdev, wpan_dev, extended_addr, &key);
- }
- static int nl802154_send_seclevel(struct sk_buff *msg, u32 cmd, u32 portid,
- u32 seq, int flags,
- struct cfg802154_registered_device *rdev,
- struct net_device *dev,
- const struct ieee802154_llsec_seclevel *sl)
- {
- void *hdr;
- struct nlattr *nl_seclevel;
- hdr = nl802154hdr_put(msg, portid, seq, flags, cmd);
- if (!hdr)
- return -1;
- if (nla_put_u32(msg, NL802154_ATTR_IFINDEX, dev->ifindex))
- goto nla_put_failure;
- nl_seclevel = nla_nest_start(msg, NL802154_ATTR_SEC_LEVEL);
- if (!nl_seclevel)
- goto nla_put_failure;
- if (nla_put_u32(msg, NL802154_SECLEVEL_ATTR_FRAME, sl->frame_type) ||
- nla_put_u32(msg, NL802154_SECLEVEL_ATTR_LEVELS, sl->sec_levels) ||
- nla_put_u8(msg, NL802154_SECLEVEL_ATTR_DEV_OVERRIDE,
- sl->device_override))
- goto nla_put_failure;
- if (sl->frame_type == NL802154_FRAME_CMD) {
- if (nla_put_u32(msg, NL802154_SECLEVEL_ATTR_CMD_FRAME,
- sl->cmd_frame_id))
- goto nla_put_failure;
- }
- nla_nest_end(msg, nl_seclevel);
- genlmsg_end(msg, hdr);
- return 0;
- nla_put_failure:
- genlmsg_cancel(msg, hdr);
- return -EMSGSIZE;
- }
- static int
- nl802154_dump_llsec_seclevel(struct sk_buff *skb, struct netlink_callback *cb)
- {
- struct cfg802154_registered_device *rdev = NULL;
- struct ieee802154_llsec_seclevel *sl;
- struct ieee802154_llsec_table *table;
- struct wpan_dev *wpan_dev;
- int err;
- err = nl802154_prepare_wpan_dev_dump(skb, cb, &rdev, &wpan_dev);
- if (err)
- return err;
- if (!wpan_dev->netdev) {
- err = -EINVAL;
- goto out_err;
- }
- rdev_lock_llsec_table(rdev, wpan_dev);
- rdev_get_llsec_table(rdev, wpan_dev, &table);
- /* TODO make it like station dump */
- if (cb->args[2])
- goto out;
- list_for_each_entry(sl, &table->security_levels, list) {
- if (nl802154_send_seclevel(skb, NL802154_CMD_NEW_SEC_LEVEL,
- NETLINK_CB(cb->skb).portid,
- cb->nlh->nlmsg_seq, NLM_F_MULTI,
- rdev, wpan_dev->netdev, sl) < 0) {
- /* TODO */
- err = -EIO;
- rdev_unlock_llsec_table(rdev, wpan_dev);
- goto out_err;
- }
- }
- cb->args[2] = 1;
- out:
- rdev_unlock_llsec_table(rdev, wpan_dev);
- err = skb->len;
- out_err:
- nl802154_finish_wpan_dev_dump(rdev);
- return err;
- }
- static const struct nla_policy nl802154_seclevel_policy[NL802154_SECLEVEL_ATTR_MAX + 1] = {
- [NL802154_SECLEVEL_ATTR_LEVELS] = { .type = NLA_U8 },
- [NL802154_SECLEVEL_ATTR_FRAME] = { .type = NLA_U32 },
- [NL802154_SECLEVEL_ATTR_CMD_FRAME] = { .type = NLA_U32 },
- [NL802154_SECLEVEL_ATTR_DEV_OVERRIDE] = { .type = NLA_U8 },
- };
- static int
- llsec_parse_seclevel(struct nlattr *nla, struct ieee802154_llsec_seclevel *sl)
- {
- struct nlattr *attrs[NL802154_SECLEVEL_ATTR_MAX + 1];
- if (!nla || nla_parse_nested(attrs, NL802154_SECLEVEL_ATTR_MAX, nla,
- nl802154_seclevel_policy))
- return -EINVAL;
- memset(sl, 0, sizeof(*sl));
- if (!attrs[NL802154_SECLEVEL_ATTR_LEVELS] ||
- !attrs[NL802154_SECLEVEL_ATTR_FRAME] ||
- !attrs[NL802154_SECLEVEL_ATTR_DEV_OVERRIDE])
- return -EINVAL;
- sl->sec_levels = nla_get_u8(attrs[NL802154_SECLEVEL_ATTR_LEVELS]);
- sl->frame_type = nla_get_u32(attrs[NL802154_SECLEVEL_ATTR_FRAME]);
- sl->device_override = nla_get_u8(attrs[NL802154_SECLEVEL_ATTR_DEV_OVERRIDE]);
- if (sl->frame_type > NL802154_FRAME_MAX ||
- (sl->device_override != 0 && sl->device_override != 1))
- return -EINVAL;
- if (sl->frame_type == NL802154_FRAME_CMD) {
- if (!attrs[NL802154_SECLEVEL_ATTR_CMD_FRAME])
- return -EINVAL;
- sl->cmd_frame_id = nla_get_u32(attrs[NL802154_SECLEVEL_ATTR_CMD_FRAME]);
- if (sl->cmd_frame_id > NL802154_CMD_FRAME_MAX)
- return -EINVAL;
- }
- return 0;
- }
- static int nl802154_add_llsec_seclevel(struct sk_buff *skb,
- struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- struct ieee802154_llsec_seclevel sl;
- if (llsec_parse_seclevel(info->attrs[NL802154_ATTR_SEC_LEVEL],
- &sl) < 0)
- return -EINVAL;
- return rdev_add_seclevel(rdev, wpan_dev, &sl);
- }
- static int nl802154_del_llsec_seclevel(struct sk_buff *skb,
- struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev = info->user_ptr[0];
- struct net_device *dev = info->user_ptr[1];
- struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
- struct ieee802154_llsec_seclevel sl;
- if (!info->attrs[NL802154_ATTR_SEC_LEVEL] ||
- llsec_parse_seclevel(info->attrs[NL802154_ATTR_SEC_LEVEL],
- &sl) < 0)
- return -EINVAL;
- return rdev_del_seclevel(rdev, wpan_dev, &sl);
- }
- #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
- #define NL802154_FLAG_NEED_WPAN_PHY 0x01
- #define NL802154_FLAG_NEED_NETDEV 0x02
- #define NL802154_FLAG_NEED_RTNL 0x04
- #define NL802154_FLAG_CHECK_NETDEV_UP 0x08
- #define NL802154_FLAG_NEED_NETDEV_UP (NL802154_FLAG_NEED_NETDEV |\
- NL802154_FLAG_CHECK_NETDEV_UP)
- #define NL802154_FLAG_NEED_WPAN_DEV 0x10
- #define NL802154_FLAG_NEED_WPAN_DEV_UP (NL802154_FLAG_NEED_WPAN_DEV |\
- NL802154_FLAG_CHECK_NETDEV_UP)
- static int nl802154_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
- struct genl_info *info)
- {
- struct cfg802154_registered_device *rdev;
- struct wpan_dev *wpan_dev;
- struct net_device *dev;
- bool rtnl = ops->internal_flags & NL802154_FLAG_NEED_RTNL;
- if (rtnl)
- rtnl_lock();
- if (ops->internal_flags & NL802154_FLAG_NEED_WPAN_PHY) {
- rdev = cfg802154_get_dev_from_info(genl_info_net(info), info);
- if (IS_ERR(rdev)) {
- if (rtnl)
- rtnl_unlock();
- return PTR_ERR(rdev);
- }
- info->user_ptr[0] = rdev;
- } else if (ops->internal_flags & NL802154_FLAG_NEED_NETDEV ||
- ops->internal_flags & NL802154_FLAG_NEED_WPAN_DEV) {
- ASSERT_RTNL();
- wpan_dev = __cfg802154_wpan_dev_from_attrs(genl_info_net(info),
- info->attrs);
- if (IS_ERR(wpan_dev)) {
- if (rtnl)
- rtnl_unlock();
- return PTR_ERR(wpan_dev);
- }
- dev = wpan_dev->netdev;
- rdev = wpan_phy_to_rdev(wpan_dev->wpan_phy);
- if (ops->internal_flags & NL802154_FLAG_NEED_NETDEV) {
- if (!dev) {
- if (rtnl)
- rtnl_unlock();
- return -EINVAL;
- }
- info->user_ptr[1] = dev;
- } else {
- info->user_ptr[1] = wpan_dev;
- }
- if (dev) {
- if (ops->internal_flags & NL802154_FLAG_CHECK_NETDEV_UP &&
- !netif_running(dev)) {
- if (rtnl)
- rtnl_unlock();
- return -ENETDOWN;
- }
- dev_hold(dev);
- }
- info->user_ptr[0] = rdev;
- }
- return 0;
- }
- static void nl802154_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
- struct genl_info *info)
- {
- if (info->user_ptr[1]) {
- if (ops->internal_flags & NL802154_FLAG_NEED_WPAN_DEV) {
- struct wpan_dev *wpan_dev = info->user_ptr[1];
- if (wpan_dev->netdev)
- dev_put(wpan_dev->netdev);
- } else {
- dev_put(info->user_ptr[1]);
- }
- }
- if (ops->internal_flags & NL802154_FLAG_NEED_RTNL)
- rtnl_unlock();
- }
- static const struct genl_ops nl802154_ops[] = {
- {
- .cmd = NL802154_CMD_GET_WPAN_PHY,
- .doit = nl802154_get_wpan_phy,
- .dumpit = nl802154_dump_wpan_phy,
- .done = nl802154_dump_wpan_phy_done,
- .policy = nl802154_policy,
- /* can be retrieved by unprivileged users */
- .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_GET_INTERFACE,
- .doit = nl802154_get_interface,
- .dumpit = nl802154_dump_interface,
- .policy = nl802154_policy,
- /* can be retrieved by unprivileged users */
- .internal_flags = NL802154_FLAG_NEED_WPAN_DEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_NEW_INTERFACE,
- .doit = nl802154_new_interface,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_DEL_INTERFACE,
- .doit = nl802154_del_interface,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_WPAN_DEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_CHANNEL,
- .doit = nl802154_set_channel,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_CCA_MODE,
- .doit = nl802154_set_cca_mode,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_CCA_ED_LEVEL,
- .doit = nl802154_set_cca_ed_level,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_TX_POWER,
- .doit = nl802154_set_tx_power,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_PAN_ID,
- .doit = nl802154_set_pan_id,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_SHORT_ADDR,
- .doit = nl802154_set_short_addr,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_BACKOFF_EXPONENT,
- .doit = nl802154_set_backoff_exponent,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_MAX_CSMA_BACKOFFS,
- .doit = nl802154_set_max_csma_backoffs,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_MAX_FRAME_RETRIES,
- .doit = nl802154_set_max_frame_retries,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_LBT_MODE,
- .doit = nl802154_set_lbt_mode,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_SET_ACKREQ_DEFAULT,
- .doit = nl802154_set_ackreq_default,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- #ifdef CONFIG_IEEE802154_NL802154_EXPERIMENTAL
- {
- .cmd = NL802154_CMD_SET_SEC_PARAMS,
- .doit = nl802154_set_llsec_params,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_GET_SEC_KEY,
- /* TODO .doit by matching key id? */
- .dumpit = nl802154_dump_llsec_key,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_NEW_SEC_KEY,
- .doit = nl802154_add_llsec_key,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_DEL_SEC_KEY,
- .doit = nl802154_del_llsec_key,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- /* TODO unique identifier must short+pan OR extended_addr */
- {
- .cmd = NL802154_CMD_GET_SEC_DEV,
- /* TODO .doit by matching extended_addr? */
- .dumpit = nl802154_dump_llsec_dev,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_NEW_SEC_DEV,
- .doit = nl802154_add_llsec_dev,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_DEL_SEC_DEV,
- .doit = nl802154_del_llsec_dev,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- /* TODO remove complete devkey, put it as nested? */
- {
- .cmd = NL802154_CMD_GET_SEC_DEVKEY,
- /* TODO doit by matching ??? */
- .dumpit = nl802154_dump_llsec_devkey,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_NEW_SEC_DEVKEY,
- .doit = nl802154_add_llsec_devkey,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_DEL_SEC_DEVKEY,
- .doit = nl802154_del_llsec_devkey,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_GET_SEC_LEVEL,
- /* TODO .doit by matching frame_type? */
- .dumpit = nl802154_dump_llsec_seclevel,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_NEW_SEC_LEVEL,
- .doit = nl802154_add_llsec_seclevel,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- {
- .cmd = NL802154_CMD_DEL_SEC_LEVEL,
- /* TODO match frame_type only? */
- .doit = nl802154_del_llsec_seclevel,
- .policy = nl802154_policy,
- .flags = GENL_ADMIN_PERM,
- .internal_flags = NL802154_FLAG_NEED_NETDEV |
- NL802154_FLAG_NEED_RTNL,
- },
- #endif /* CONFIG_IEEE802154_NL802154_EXPERIMENTAL */
- };
- /* initialisation/exit functions */
- int nl802154_init(void)
- {
- return genl_register_family_with_ops_groups(&nl802154_fam, nl802154_ops,
- nl802154_mcgrps);
- }
- void nl802154_exit(void)
- {
- genl_unregister_family(&nl802154_fam);
- }
|