1 /* This program is free software; you can redistribute it and/or modify
2 * it under the terms of the GNU General Public License version 2
3 * as published by the Free Software Foundation.
5 * This program is distributed in the hope that it will be useful,
6 * but WITHOUT ANY WARRANTY; without even the implied warranty of
7 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
8 * GNU General Public License for more details.
11 * Alexander Aring <aar@pengutronix.de>
13 * Based on: net/wireless/nl80211.c
16 #include <linux/rtnetlink.h>
18 #include <net/cfg802154.h>
19 #include <net/genetlink.h>
20 #include <net/mac802154.h>
21 #include <net/netlink.h>
22 #include <net/nl802154.h>
29 static int nl802154_pre_doit(const struct genl_ops
*ops
, struct sk_buff
*skb
,
30 struct genl_info
*info
);
32 static void nl802154_post_doit(const struct genl_ops
*ops
, struct sk_buff
*skb
,
33 struct genl_info
*info
);
35 /* the netlink family */
36 static struct genl_family nl802154_fam
= {
37 .id
= GENL_ID_GENERATE
, /* don't bother with a hardcoded ID */
38 .name
= NL802154_GENL_NAME
, /* have users key off the name instead */
39 .hdrsize
= 0, /* no private header */
40 .version
= 1, /* no particular meaning now */
41 .maxattr
= NL802154_ATTR_MAX
,
43 .pre_doit
= nl802154_pre_doit
,
44 .post_doit
= nl802154_post_doit
,
47 /* multicast groups */
48 enum nl802154_multicast_groups
{
49 NL802154_MCGRP_CONFIG
,
52 static const struct genl_multicast_group nl802154_mcgrps
[] = {
53 [NL802154_MCGRP_CONFIG
] = { .name
= "config", },
56 /* returns ERR_PTR values */
57 static struct wpan_dev
*
58 __cfg802154_wpan_dev_from_attrs(struct net
*netns
, struct nlattr
**attrs
)
60 struct cfg802154_registered_device
*rdev
;
61 struct wpan_dev
*result
= NULL
;
62 bool have_ifidx
= attrs
[NL802154_ATTR_IFINDEX
];
63 bool have_wpan_dev_id
= attrs
[NL802154_ATTR_WPAN_DEV
];
65 int wpan_phy_idx
= -1;
70 if (!have_ifidx
&& !have_wpan_dev_id
)
71 return ERR_PTR(-EINVAL
);
74 ifidx
= nla_get_u32(attrs
[NL802154_ATTR_IFINDEX
]);
75 if (have_wpan_dev_id
) {
76 wpan_dev_id
= nla_get_u64(attrs
[NL802154_ATTR_WPAN_DEV
]);
77 wpan_phy_idx
= wpan_dev_id
>> 32;
80 list_for_each_entry(rdev
, &cfg802154_rdev_list
, list
) {
81 struct wpan_dev
*wpan_dev
;
83 /* TODO netns compare */
85 if (have_wpan_dev_id
&& rdev
->wpan_phy_idx
!= wpan_phy_idx
)
88 list_for_each_entry(wpan_dev
, &rdev
->wpan_dev_list
, list
) {
89 if (have_ifidx
&& wpan_dev
->netdev
&&
90 wpan_dev
->netdev
->ifindex
== ifidx
) {
94 if (have_wpan_dev_id
&&
95 wpan_dev
->identifier
== (u32
)wpan_dev_id
) {
108 return ERR_PTR(-ENODEV
);
111 static struct cfg802154_registered_device
*
112 __cfg802154_rdev_from_attrs(struct net
*netns
, struct nlattr
**attrs
)
114 struct cfg802154_registered_device
*rdev
= NULL
, *tmp
;
115 struct net_device
*netdev
;
119 if (!attrs
[NL802154_ATTR_WPAN_PHY
] &&
120 !attrs
[NL802154_ATTR_IFINDEX
] &&
121 !attrs
[NL802154_ATTR_WPAN_DEV
])
122 return ERR_PTR(-EINVAL
);
124 if (attrs
[NL802154_ATTR_WPAN_PHY
])
125 rdev
= cfg802154_rdev_by_wpan_phy_idx(
126 nla_get_u32(attrs
[NL802154_ATTR_WPAN_PHY
]));
128 if (attrs
[NL802154_ATTR_WPAN_DEV
]) {
129 u64 wpan_dev_id
= nla_get_u64(attrs
[NL802154_ATTR_WPAN_DEV
]);
130 struct wpan_dev
*wpan_dev
;
133 tmp
= cfg802154_rdev_by_wpan_phy_idx(wpan_dev_id
>> 32);
135 /* make sure wpan_dev exists */
136 list_for_each_entry(wpan_dev
, &tmp
->wpan_dev_list
, list
) {
137 if (wpan_dev
->identifier
!= (u32
)wpan_dev_id
)
146 if (rdev
&& tmp
!= rdev
)
147 return ERR_PTR(-EINVAL
);
152 if (attrs
[NL802154_ATTR_IFINDEX
]) {
153 int ifindex
= nla_get_u32(attrs
[NL802154_ATTR_IFINDEX
]);
155 netdev
= __dev_get_by_index(netns
, ifindex
);
157 if (netdev
->ieee802154_ptr
)
158 tmp
= wpan_phy_to_rdev(
159 netdev
->ieee802154_ptr
->wpan_phy
);
163 /* not wireless device -- return error */
165 return ERR_PTR(-EINVAL
);
167 /* mismatch -- return error */
168 if (rdev
&& tmp
!= rdev
)
169 return ERR_PTR(-EINVAL
);
176 return ERR_PTR(-ENODEV
);
178 /* TODO netns compare */
183 /* This function returns a pointer to the driver
184 * that the genl_info item that is passed refers to.
186 * The result of this can be a PTR_ERR and hence must
187 * be checked with IS_ERR() for errors.
189 static struct cfg802154_registered_device
*
190 cfg802154_get_dev_from_info(struct net
*netns
, struct genl_info
*info
)
192 return __cfg802154_rdev_from_attrs(netns
, info
->attrs
);
195 /* policy for the attributes */
196 static const struct nla_policy nl802154_policy
[NL802154_ATTR_MAX
+1] = {
197 [NL802154_ATTR_WPAN_PHY
] = { .type
= NLA_U32
},
198 [NL802154_ATTR_WPAN_PHY_NAME
] = { .type
= NLA_NUL_STRING
,
201 [NL802154_ATTR_IFINDEX
] = { .type
= NLA_U32
},
202 [NL802154_ATTR_IFTYPE
] = { .type
= NLA_U32
},
203 [NL802154_ATTR_IFNAME
] = { .type
= NLA_NUL_STRING
, .len
= IFNAMSIZ
-1 },
205 [NL802154_ATTR_WPAN_DEV
] = { .type
= NLA_U64
},
207 [NL802154_ATTR_PAGE
] = { .type
= NLA_U8
, },
208 [NL802154_ATTR_CHANNEL
] = { .type
= NLA_U8
, },
210 [NL802154_ATTR_TX_POWER
] = { .type
= NLA_S32
, },
212 [NL802154_ATTR_CCA_MODE
] = { .type
= NLA_U32
, },
213 [NL802154_ATTR_CCA_OPT
] = { .type
= NLA_U32
, },
214 [NL802154_ATTR_CCA_ED_LEVEL
] = { .type
= NLA_S32
, },
216 [NL802154_ATTR_SUPPORTED_CHANNEL
] = { .type
= NLA_U32
, },
218 [NL802154_ATTR_PAN_ID
] = { .type
= NLA_U16
, },
219 [NL802154_ATTR_EXTENDED_ADDR
] = { .type
= NLA_U64
},
220 [NL802154_ATTR_SHORT_ADDR
] = { .type
= NLA_U16
, },
222 [NL802154_ATTR_MIN_BE
] = { .type
= NLA_U8
, },
223 [NL802154_ATTR_MAX_BE
] = { .type
= NLA_U8
, },
224 [NL802154_ATTR_MAX_CSMA_BACKOFFS
] = { .type
= NLA_U8
, },
226 [NL802154_ATTR_MAX_FRAME_RETRIES
] = { .type
= NLA_S8
, },
228 [NL802154_ATTR_LBT_MODE
] = { .type
= NLA_U8
, },
230 [NL802154_ATTR_WPAN_PHY_CAPS
] = { .type
= NLA_NESTED
},
232 [NL802154_ATTR_SUPPORTED_COMMANDS
] = { .type
= NLA_NESTED
},
235 /* message building helper */
236 static inline void *nl802154hdr_put(struct sk_buff
*skb
, u32 portid
, u32 seq
,
239 /* since there is no private header just add the generic one */
240 return genlmsg_put(skb
, portid
, seq
, &nl802154_fam
, flags
, cmd
);
244 nl802154_put_flags(struct sk_buff
*msg
, int attr
, u32 mask
)
246 struct nlattr
*nl_flags
= nla_nest_start(msg
, attr
);
254 if ((mask
& 1) && nla_put_flag(msg
, i
))
261 nla_nest_end(msg
, nl_flags
);
266 nl802154_send_wpan_phy_channels(struct cfg802154_registered_device
*rdev
,
269 struct nlattr
*nl_page
;
272 nl_page
= nla_nest_start(msg
, NL802154_ATTR_CHANNELS_SUPPORTED
);
276 for (page
= 0; page
<= IEEE802154_MAX_PAGE
; page
++) {
277 if (nla_put_u32(msg
, NL802154_ATTR_SUPPORTED_CHANNEL
,
278 rdev
->wpan_phy
.supported
.channels
[page
]))
281 nla_nest_end(msg
, nl_page
);
287 nl802154_put_capabilities(struct sk_buff
*msg
,
288 struct cfg802154_registered_device
*rdev
)
290 const struct wpan_phy_supported
*caps
= &rdev
->wpan_phy
.supported
;
291 struct nlattr
*nl_caps
, *nl_channels
;
294 nl_caps
= nla_nest_start(msg
, NL802154_ATTR_WPAN_PHY_CAPS
);
298 nl_channels
= nla_nest_start(msg
, NL802154_CAP_ATTR_CHANNELS
);
302 for (i
= 0; i
<= IEEE802154_MAX_PAGE
; i
++) {
303 if (caps
->channels
[i
]) {
304 if (nl802154_put_flags(msg
, i
, caps
->channels
[i
]))
309 nla_nest_end(msg
, nl_channels
);
311 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_ED_LEVEL
) {
312 struct nlattr
*nl_ed_lvls
;
314 nl_ed_lvls
= nla_nest_start(msg
,
315 NL802154_CAP_ATTR_CCA_ED_LEVELS
);
319 for (i
= 0; i
< caps
->cca_ed_levels_size
; i
++) {
320 if (nla_put_s32(msg
, i
, caps
->cca_ed_levels
[i
]))
324 nla_nest_end(msg
, nl_ed_lvls
);
327 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_TXPOWER
) {
328 struct nlattr
*nl_tx_pwrs
;
330 nl_tx_pwrs
= nla_nest_start(msg
, NL802154_CAP_ATTR_TX_POWERS
);
334 for (i
= 0; i
< caps
->tx_powers_size
; i
++) {
335 if (nla_put_s32(msg
, i
, caps
->tx_powers
[i
]))
339 nla_nest_end(msg
, nl_tx_pwrs
);
342 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_MODE
) {
343 if (nl802154_put_flags(msg
, NL802154_CAP_ATTR_CCA_MODES
,
345 nl802154_put_flags(msg
, NL802154_CAP_ATTR_CCA_OPTS
,
350 if (nla_put_u8(msg
, NL802154_CAP_ATTR_MIN_MINBE
, caps
->min_minbe
) ||
351 nla_put_u8(msg
, NL802154_CAP_ATTR_MAX_MINBE
, caps
->max_minbe
) ||
352 nla_put_u8(msg
, NL802154_CAP_ATTR_MIN_MAXBE
, caps
->min_maxbe
) ||
353 nla_put_u8(msg
, NL802154_CAP_ATTR_MAX_MAXBE
, caps
->max_maxbe
) ||
354 nla_put_u8(msg
, NL802154_CAP_ATTR_MIN_CSMA_BACKOFFS
,
355 caps
->min_csma_backoffs
) ||
356 nla_put_u8(msg
, NL802154_CAP_ATTR_MAX_CSMA_BACKOFFS
,
357 caps
->max_csma_backoffs
) ||
358 nla_put_s8(msg
, NL802154_CAP_ATTR_MIN_FRAME_RETRIES
,
359 caps
->min_frame_retries
) ||
360 nla_put_s8(msg
, NL802154_CAP_ATTR_MAX_FRAME_RETRIES
,
361 caps
->max_frame_retries
) ||
362 nl802154_put_flags(msg
, NL802154_CAP_ATTR_IFTYPES
,
364 nla_put_u32(msg
, NL802154_CAP_ATTR_LBT
, caps
->lbt
))
367 nla_nest_end(msg
, nl_caps
);
372 static int nl802154_send_wpan_phy(struct cfg802154_registered_device
*rdev
,
373 enum nl802154_commands cmd
,
374 struct sk_buff
*msg
, u32 portid
, u32 seq
,
377 struct nlattr
*nl_cmds
;
381 hdr
= nl802154hdr_put(msg
, portid
, seq
, flags
, cmd
);
385 if (nla_put_u32(msg
, NL802154_ATTR_WPAN_PHY
, rdev
->wpan_phy_idx
) ||
386 nla_put_string(msg
, NL802154_ATTR_WPAN_PHY_NAME
,
387 wpan_phy_name(&rdev
->wpan_phy
)) ||
388 nla_put_u32(msg
, NL802154_ATTR_GENERATION
,
389 cfg802154_rdev_list_generation
))
390 goto nla_put_failure
;
392 if (cmd
!= NL802154_CMD_NEW_WPAN_PHY
)
397 /* current channel settings */
398 if (nla_put_u8(msg
, NL802154_ATTR_PAGE
,
399 rdev
->wpan_phy
.current_page
) ||
400 nla_put_u8(msg
, NL802154_ATTR_CHANNEL
,
401 rdev
->wpan_phy
.current_channel
))
402 goto nla_put_failure
;
404 /* TODO remove this behaviour, we still keep support it for a while
405 * so users can change the behaviour to the new one.
407 if (nl802154_send_wpan_phy_channels(rdev
, msg
))
408 goto nla_put_failure
;
411 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_MODE
) {
412 if (nla_put_u32(msg
, NL802154_ATTR_CCA_MODE
,
413 rdev
->wpan_phy
.cca
.mode
))
414 goto nla_put_failure
;
416 if (rdev
->wpan_phy
.cca
.mode
== NL802154_CCA_ENERGY_CARRIER
) {
417 if (nla_put_u32(msg
, NL802154_ATTR_CCA_OPT
,
418 rdev
->wpan_phy
.cca
.opt
))
419 goto nla_put_failure
;
423 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_TXPOWER
) {
424 if (nla_put_s32(msg
, NL802154_ATTR_TX_POWER
,
425 rdev
->wpan_phy
.transmit_power
))
426 goto nla_put_failure
;
429 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_ED_LEVEL
) {
430 if (nla_put_s32(msg
, NL802154_ATTR_CCA_ED_LEVEL
,
431 rdev
->wpan_phy
.cca_ed_level
))
432 goto nla_put_failure
;
435 if (nl802154_put_capabilities(msg
, rdev
))
436 goto nla_put_failure
;
438 nl_cmds
= nla_nest_start(msg
, NL802154_ATTR_SUPPORTED_COMMANDS
);
440 goto nla_put_failure
;
445 if (rdev->ops->op) { \
447 if (nla_put_u32(msg, i, NL802154_CMD_ ## n)) \
448 goto nla_put_failure; \
452 CMD(add_virtual_intf
, NEW_INTERFACE
);
453 CMD(del_virtual_intf
, DEL_INTERFACE
);
454 CMD(set_channel
, SET_CHANNEL
);
455 CMD(set_pan_id
, SET_PAN_ID
);
456 CMD(set_short_addr
, SET_SHORT_ADDR
);
457 CMD(set_backoff_exponent
, SET_BACKOFF_EXPONENT
);
458 CMD(set_max_csma_backoffs
, SET_MAX_CSMA_BACKOFFS
);
459 CMD(set_max_frame_retries
, SET_MAX_FRAME_RETRIES
);
460 CMD(set_lbt_mode
, SET_LBT_MODE
);
462 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_TXPOWER
)
463 CMD(set_tx_power
, SET_TX_POWER
);
465 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_ED_LEVEL
)
466 CMD(set_cca_ed_level
, SET_CCA_ED_LEVEL
);
468 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_MODE
)
469 CMD(set_cca_mode
, SET_CCA_MODE
);
472 nla_nest_end(msg
, nl_cmds
);
475 genlmsg_end(msg
, hdr
);
479 genlmsg_cancel(msg
, hdr
);
483 struct nl802154_dump_wpan_phy_state
{
489 static int nl802154_dump_wpan_phy_parse(struct sk_buff
*skb
,
490 struct netlink_callback
*cb
,
491 struct nl802154_dump_wpan_phy_state
*state
)
493 struct nlattr
**tb
= nl802154_fam
.attrbuf
;
494 int ret
= nlmsg_parse(cb
->nlh
, GENL_HDRLEN
+ nl802154_fam
.hdrsize
,
495 tb
, nl802154_fam
.maxattr
, nl802154_policy
);
497 /* TODO check if we can handle error here,
498 * we have no backward compatibility
503 if (tb
[NL802154_ATTR_WPAN_PHY
])
504 state
->filter_wpan_phy
= nla_get_u32(tb
[NL802154_ATTR_WPAN_PHY
]);
505 if (tb
[NL802154_ATTR_WPAN_DEV
])
506 state
->filter_wpan_phy
= nla_get_u64(tb
[NL802154_ATTR_WPAN_DEV
]) >> 32;
507 if (tb
[NL802154_ATTR_IFINDEX
]) {
508 struct net_device
*netdev
;
509 struct cfg802154_registered_device
*rdev
;
510 int ifidx
= nla_get_u32(tb
[NL802154_ATTR_IFINDEX
]);
513 netdev
= __dev_get_by_index(&init_net
, ifidx
);
516 if (netdev
->ieee802154_ptr
) {
517 rdev
= wpan_phy_to_rdev(
518 netdev
->ieee802154_ptr
->wpan_phy
);
519 state
->filter_wpan_phy
= rdev
->wpan_phy_idx
;
527 nl802154_dump_wpan_phy(struct sk_buff
*skb
, struct netlink_callback
*cb
)
530 struct nl802154_dump_wpan_phy_state
*state
= (void *)cb
->args
[0];
531 struct cfg802154_registered_device
*rdev
;
535 state
= kzalloc(sizeof(*state
), GFP_KERNEL
);
540 state
->filter_wpan_phy
= -1;
541 ret
= nl802154_dump_wpan_phy_parse(skb
, cb
, state
);
547 cb
->args
[0] = (long)state
;
550 list_for_each_entry(rdev
, &cfg802154_rdev_list
, list
) {
551 /* TODO net ns compare */
552 if (++idx
<= state
->start
)
554 if (state
->filter_wpan_phy
!= -1 &&
555 state
->filter_wpan_phy
!= rdev
->wpan_phy_idx
)
557 /* attempt to fit multiple wpan_phy data chunks into the skb */
558 ret
= nl802154_send_wpan_phy(rdev
,
559 NL802154_CMD_NEW_WPAN_PHY
,
561 NETLINK_CB(cb
->skb
).portid
,
562 cb
->nlh
->nlmsg_seq
, NLM_F_MULTI
);
564 if ((ret
== -ENOBUFS
|| ret
== -EMSGSIZE
) &&
565 !skb
->len
&& cb
->min_dump_alloc
< 4096) {
566 cb
->min_dump_alloc
= 4096;
582 static int nl802154_dump_wpan_phy_done(struct netlink_callback
*cb
)
584 kfree((void *)cb
->args
[0]);
588 static int nl802154_get_wpan_phy(struct sk_buff
*skb
, struct genl_info
*info
)
591 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
593 msg
= nlmsg_new(NLMSG_DEFAULT_SIZE
, GFP_KERNEL
);
597 if (nl802154_send_wpan_phy(rdev
, NL802154_CMD_NEW_WPAN_PHY
, msg
,
598 info
->snd_portid
, info
->snd_seq
, 0) < 0) {
603 return genlmsg_reply(msg
, info
);
606 static inline u64
wpan_dev_id(struct wpan_dev
*wpan_dev
)
608 return (u64
)wpan_dev
->identifier
|
609 ((u64
)wpan_phy_to_rdev(wpan_dev
->wpan_phy
)->wpan_phy_idx
<< 32);
613 nl802154_send_iface(struct sk_buff
*msg
, u32 portid
, u32 seq
, int flags
,
614 struct cfg802154_registered_device
*rdev
,
615 struct wpan_dev
*wpan_dev
)
617 struct net_device
*dev
= wpan_dev
->netdev
;
620 hdr
= nl802154hdr_put(msg
, portid
, seq
, flags
,
621 NL802154_CMD_NEW_INTERFACE
);
626 (nla_put_u32(msg
, NL802154_ATTR_IFINDEX
, dev
->ifindex
) ||
627 nla_put_string(msg
, NL802154_ATTR_IFNAME
, dev
->name
)))
628 goto nla_put_failure
;
630 if (nla_put_u32(msg
, NL802154_ATTR_WPAN_PHY
, rdev
->wpan_phy_idx
) ||
631 nla_put_u32(msg
, NL802154_ATTR_IFTYPE
, wpan_dev
->iftype
) ||
632 nla_put_u64(msg
, NL802154_ATTR_WPAN_DEV
, wpan_dev_id(wpan_dev
)) ||
633 nla_put_u32(msg
, NL802154_ATTR_GENERATION
,
634 rdev
->devlist_generation
^
635 (cfg802154_rdev_list_generation
<< 2)))
636 goto nla_put_failure
;
638 /* address settings */
639 if (nla_put_le64(msg
, NL802154_ATTR_EXTENDED_ADDR
,
640 wpan_dev
->extended_addr
) ||
641 nla_put_le16(msg
, NL802154_ATTR_SHORT_ADDR
,
642 wpan_dev
->short_addr
) ||
643 nla_put_le16(msg
, NL802154_ATTR_PAN_ID
, wpan_dev
->pan_id
))
644 goto nla_put_failure
;
647 if (nla_put_s8(msg
, NL802154_ATTR_MAX_FRAME_RETRIES
,
648 wpan_dev
->frame_retries
) ||
649 nla_put_u8(msg
, NL802154_ATTR_MAX_BE
, wpan_dev
->max_be
) ||
650 nla_put_u8(msg
, NL802154_ATTR_MAX_CSMA_BACKOFFS
,
651 wpan_dev
->csma_retries
) ||
652 nla_put_u8(msg
, NL802154_ATTR_MIN_BE
, wpan_dev
->min_be
))
653 goto nla_put_failure
;
655 /* listen before transmit */
656 if (nla_put_u8(msg
, NL802154_ATTR_LBT_MODE
, wpan_dev
->lbt
))
657 goto nla_put_failure
;
659 genlmsg_end(msg
, hdr
);
663 genlmsg_cancel(msg
, hdr
);
668 nl802154_dump_interface(struct sk_buff
*skb
, struct netlink_callback
*cb
)
672 int wp_start
= cb
->args
[0];
673 int if_start
= cb
->args
[1];
674 struct cfg802154_registered_device
*rdev
;
675 struct wpan_dev
*wpan_dev
;
678 list_for_each_entry(rdev
, &cfg802154_rdev_list
, list
) {
679 /* TODO netns compare */
680 if (wp_idx
< wp_start
) {
686 list_for_each_entry(wpan_dev
, &rdev
->wpan_dev_list
, list
) {
687 if (if_idx
< if_start
) {
691 if (nl802154_send_iface(skb
, NETLINK_CB(cb
->skb
).portid
,
692 cb
->nlh
->nlmsg_seq
, NLM_F_MULTI
,
693 rdev
, wpan_dev
) < 0) {
704 cb
->args
[0] = wp_idx
;
705 cb
->args
[1] = if_idx
;
710 static int nl802154_get_interface(struct sk_buff
*skb
, struct genl_info
*info
)
713 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
714 struct wpan_dev
*wdev
= info
->user_ptr
[1];
716 msg
= nlmsg_new(NLMSG_DEFAULT_SIZE
, GFP_KERNEL
);
720 if (nl802154_send_iface(msg
, info
->snd_portid
, info
->snd_seq
, 0,
726 return genlmsg_reply(msg
, info
);
729 static int nl802154_new_interface(struct sk_buff
*skb
, struct genl_info
*info
)
731 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
732 enum nl802154_iftype type
= NL802154_IFTYPE_UNSPEC
;
733 __le64 extended_addr
= cpu_to_le64(0x0000000000000000ULL
);
735 /* TODO avoid failing a new interface
736 * creation due to pending removal?
739 if (!info
->attrs
[NL802154_ATTR_IFNAME
])
742 if (info
->attrs
[NL802154_ATTR_IFTYPE
]) {
743 type
= nla_get_u32(info
->attrs
[NL802154_ATTR_IFTYPE
]);
744 if (type
> NL802154_IFTYPE_MAX
||
745 !(rdev
->wpan_phy
.supported
.iftypes
& BIT(type
)))
749 /* TODO add nla_get_le64 to netlink */
750 if (info
->attrs
[NL802154_ATTR_EXTENDED_ADDR
])
751 extended_addr
= (__force __le64
)nla_get_u64(
752 info
->attrs
[NL802154_ATTR_EXTENDED_ADDR
]);
754 if (!rdev
->ops
->add_virtual_intf
)
757 return rdev_add_virtual_intf(rdev
,
758 nla_data(info
->attrs
[NL802154_ATTR_IFNAME
]),
759 NET_NAME_USER
, type
, extended_addr
);
762 static int nl802154_del_interface(struct sk_buff
*skb
, struct genl_info
*info
)
764 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
765 struct wpan_dev
*wpan_dev
= info
->user_ptr
[1];
767 if (!rdev
->ops
->del_virtual_intf
)
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.
776 if (!wpan_dev
->netdev
)
777 info
->user_ptr
[1] = NULL
;
779 return rdev_del_virtual_intf(rdev
, wpan_dev
);
782 static int nl802154_set_channel(struct sk_buff
*skb
, struct genl_info
*info
)
784 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
787 if (!info
->attrs
[NL802154_ATTR_PAGE
] ||
788 !info
->attrs
[NL802154_ATTR_CHANNEL
])
791 page
= nla_get_u8(info
->attrs
[NL802154_ATTR_PAGE
]);
792 channel
= nla_get_u8(info
->attrs
[NL802154_ATTR_CHANNEL
]);
794 /* check 802.15.4 constraints */
795 if (page
> IEEE802154_MAX_PAGE
|| channel
> IEEE802154_MAX_CHANNEL
||
796 !(rdev
->wpan_phy
.supported
.channels
[page
] & BIT(channel
)))
799 return rdev_set_channel(rdev
, page
, channel
);
802 static int nl802154_set_cca_mode(struct sk_buff
*skb
, struct genl_info
*info
)
804 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
805 struct wpan_phy_cca cca
;
807 if (!(rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_MODE
))
810 if (!info
->attrs
[NL802154_ATTR_CCA_MODE
])
813 cca
.mode
= nla_get_u32(info
->attrs
[NL802154_ATTR_CCA_MODE
]);
814 /* checking 802.15.4 constraints */
815 if (cca
.mode
< NL802154_CCA_ENERGY
||
816 cca
.mode
> NL802154_CCA_ATTR_MAX
||
817 !(rdev
->wpan_phy
.supported
.cca_modes
& BIT(cca
.mode
)))
820 if (cca
.mode
== NL802154_CCA_ENERGY_CARRIER
) {
821 if (!info
->attrs
[NL802154_ATTR_CCA_OPT
])
824 cca
.opt
= nla_get_u32(info
->attrs
[NL802154_ATTR_CCA_OPT
]);
825 if (cca
.opt
> NL802154_CCA_OPT_ATTR_MAX
||
826 !(rdev
->wpan_phy
.supported
.cca_opts
& BIT(cca
.opt
)))
830 return rdev_set_cca_mode(rdev
, &cca
);
833 static int nl802154_set_cca_ed_level(struct sk_buff
*skb
, struct genl_info
*info
)
835 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
839 if (!(rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_ED_LEVEL
))
842 if (!info
->attrs
[NL802154_ATTR_CCA_ED_LEVEL
])
845 ed_level
= nla_get_s32(info
->attrs
[NL802154_ATTR_CCA_ED_LEVEL
]);
847 for (i
= 0; i
< rdev
->wpan_phy
.supported
.cca_ed_levels_size
; i
++) {
848 if (ed_level
== rdev
->wpan_phy
.supported
.cca_ed_levels
[i
])
849 return rdev_set_cca_ed_level(rdev
, ed_level
);
855 static int nl802154_set_tx_power(struct sk_buff
*skb
, struct genl_info
*info
)
857 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
861 if (!(rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_TXPOWER
))
864 if (!info
->attrs
[NL802154_ATTR_TX_POWER
])
867 power
= nla_get_s32(info
->attrs
[NL802154_ATTR_TX_POWER
]);
869 for (i
= 0; i
< rdev
->wpan_phy
.supported
.tx_powers_size
; i
++) {
870 if (power
== rdev
->wpan_phy
.supported
.tx_powers
[i
])
871 return rdev_set_tx_power(rdev
, power
);
877 static int nl802154_set_pan_id(struct sk_buff
*skb
, struct genl_info
*info
)
879 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
880 struct net_device
*dev
= info
->user_ptr
[1];
881 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
884 /* conflict here while tx/rx calls */
885 if (netif_running(dev
))
888 /* don't change address fields on monitor */
889 if (wpan_dev
->iftype
== NL802154_IFTYPE_MONITOR
||
890 !info
->attrs
[NL802154_ATTR_PAN_ID
])
893 pan_id
= nla_get_le16(info
->attrs
[NL802154_ATTR_PAN_ID
]);
896 * I am not sure about to check here on broadcast pan_id.
897 * Broadcast is a valid setting, comment from 802.15.4:
898 * If this value is 0xffff, the device is not associated.
900 * This could useful to simple deassociate an device.
902 if (pan_id
== cpu_to_le16(IEEE802154_PAN_ID_BROADCAST
))
905 return rdev_set_pan_id(rdev
, wpan_dev
, pan_id
);
908 static int nl802154_set_short_addr(struct sk_buff
*skb
, struct genl_info
*info
)
910 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
911 struct net_device
*dev
= info
->user_ptr
[1];
912 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
915 /* conflict here while tx/rx calls */
916 if (netif_running(dev
))
919 /* don't change address fields on monitor */
920 if (wpan_dev
->iftype
== NL802154_IFTYPE_MONITOR
||
921 !info
->attrs
[NL802154_ATTR_SHORT_ADDR
])
924 short_addr
= nla_get_le16(info
->attrs
[NL802154_ATTR_SHORT_ADDR
]);
927 * I am not sure about to check here on broadcast short_addr.
928 * Broadcast is a valid setting, comment from 802.15.4:
929 * A value of 0xfffe indicates that the device has
930 * associated but has not been allocated an address. A
931 * value of 0xffff indicates that the device does not
932 * have a short address.
934 * I think we should allow to set these settings but
935 * don't allow to allow socket communication with it.
937 if (short_addr
== cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC
) ||
938 short_addr
== cpu_to_le16(IEEE802154_ADDR_SHORT_BROADCAST
))
941 return rdev_set_short_addr(rdev
, wpan_dev
, short_addr
);
945 nl802154_set_backoff_exponent(struct sk_buff
*skb
, struct genl_info
*info
)
947 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
948 struct net_device
*dev
= info
->user_ptr
[1];
949 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
952 /* should be set on netif open inside phy settings */
953 if (netif_running(dev
))
956 if (!info
->attrs
[NL802154_ATTR_MIN_BE
] ||
957 !info
->attrs
[NL802154_ATTR_MAX_BE
])
960 min_be
= nla_get_u8(info
->attrs
[NL802154_ATTR_MIN_BE
]);
961 max_be
= nla_get_u8(info
->attrs
[NL802154_ATTR_MAX_BE
]);
963 /* check 802.15.4 constraints */
964 if (min_be
< rdev
->wpan_phy
.supported
.min_minbe
||
965 min_be
> rdev
->wpan_phy
.supported
.max_minbe
||
966 max_be
< rdev
->wpan_phy
.supported
.min_maxbe
||
967 max_be
> rdev
->wpan_phy
.supported
.max_maxbe
||
971 return rdev_set_backoff_exponent(rdev
, wpan_dev
, min_be
, max_be
);
975 nl802154_set_max_csma_backoffs(struct sk_buff
*skb
, struct genl_info
*info
)
977 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
978 struct net_device
*dev
= info
->user_ptr
[1];
979 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
980 u8 max_csma_backoffs
;
982 /* conflict here while other running iface settings */
983 if (netif_running(dev
))
986 if (!info
->attrs
[NL802154_ATTR_MAX_CSMA_BACKOFFS
])
989 max_csma_backoffs
= nla_get_u8(
990 info
->attrs
[NL802154_ATTR_MAX_CSMA_BACKOFFS
]);
992 /* check 802.15.4 constraints */
993 if (max_csma_backoffs
< rdev
->wpan_phy
.supported
.min_csma_backoffs
||
994 max_csma_backoffs
> rdev
->wpan_phy
.supported
.max_csma_backoffs
)
997 return rdev_set_max_csma_backoffs(rdev
, wpan_dev
, max_csma_backoffs
);
1001 nl802154_set_max_frame_retries(struct sk_buff
*skb
, struct genl_info
*info
)
1003 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
1004 struct net_device
*dev
= info
->user_ptr
[1];
1005 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
1006 s8 max_frame_retries
;
1008 if (netif_running(dev
))
1011 if (!info
->attrs
[NL802154_ATTR_MAX_FRAME_RETRIES
])
1014 max_frame_retries
= nla_get_s8(
1015 info
->attrs
[NL802154_ATTR_MAX_FRAME_RETRIES
]);
1017 /* check 802.15.4 constraints */
1018 if (max_frame_retries
< rdev
->wpan_phy
.supported
.min_frame_retries
||
1019 max_frame_retries
> rdev
->wpan_phy
.supported
.max_frame_retries
)
1022 return rdev_set_max_frame_retries(rdev
, wpan_dev
, max_frame_retries
);
1025 static int nl802154_set_lbt_mode(struct sk_buff
*skb
, struct genl_info
*info
)
1027 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
1028 struct net_device
*dev
= info
->user_ptr
[1];
1029 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
1032 if (netif_running(dev
))
1035 if (!info
->attrs
[NL802154_ATTR_LBT_MODE
])
1038 mode
= !!nla_get_u8(info
->attrs
[NL802154_ATTR_LBT_MODE
]);
1039 if (!wpan_phy_supported_bool(mode
, rdev
->wpan_phy
.supported
.lbt
))
1042 return rdev_set_lbt_mode(rdev
, wpan_dev
, mode
);
1045 #define NL802154_FLAG_NEED_WPAN_PHY 0x01
1046 #define NL802154_FLAG_NEED_NETDEV 0x02
1047 #define NL802154_FLAG_NEED_RTNL 0x04
1048 #define NL802154_FLAG_CHECK_NETDEV_UP 0x08
1049 #define NL802154_FLAG_NEED_NETDEV_UP (NL802154_FLAG_NEED_NETDEV |\
1050 NL802154_FLAG_CHECK_NETDEV_UP)
1051 #define NL802154_FLAG_NEED_WPAN_DEV 0x10
1052 #define NL802154_FLAG_NEED_WPAN_DEV_UP (NL802154_FLAG_NEED_WPAN_DEV |\
1053 NL802154_FLAG_CHECK_NETDEV_UP)
1055 static int nl802154_pre_doit(const struct genl_ops
*ops
, struct sk_buff
*skb
,
1056 struct genl_info
*info
)
1058 struct cfg802154_registered_device
*rdev
;
1059 struct wpan_dev
*wpan_dev
;
1060 struct net_device
*dev
;
1061 bool rtnl
= ops
->internal_flags
& NL802154_FLAG_NEED_RTNL
;
1066 if (ops
->internal_flags
& NL802154_FLAG_NEED_WPAN_PHY
) {
1067 rdev
= cfg802154_get_dev_from_info(genl_info_net(info
), info
);
1071 return PTR_ERR(rdev
);
1073 info
->user_ptr
[0] = rdev
;
1074 } else if (ops
->internal_flags
& NL802154_FLAG_NEED_NETDEV
||
1075 ops
->internal_flags
& NL802154_FLAG_NEED_WPAN_DEV
) {
1077 wpan_dev
= __cfg802154_wpan_dev_from_attrs(genl_info_net(info
),
1079 if (IS_ERR(wpan_dev
)) {
1082 return PTR_ERR(wpan_dev
);
1085 dev
= wpan_dev
->netdev
;
1086 rdev
= wpan_phy_to_rdev(wpan_dev
->wpan_phy
);
1088 if (ops
->internal_flags
& NL802154_FLAG_NEED_NETDEV
) {
1095 info
->user_ptr
[1] = dev
;
1097 info
->user_ptr
[1] = wpan_dev
;
1101 if (ops
->internal_flags
& NL802154_FLAG_CHECK_NETDEV_UP
&&
1102 !netif_running(dev
)) {
1111 info
->user_ptr
[0] = rdev
;
1117 static void nl802154_post_doit(const struct genl_ops
*ops
, struct sk_buff
*skb
,
1118 struct genl_info
*info
)
1120 if (info
->user_ptr
[1]) {
1121 if (ops
->internal_flags
& NL802154_FLAG_NEED_WPAN_DEV
) {
1122 struct wpan_dev
*wpan_dev
= info
->user_ptr
[1];
1124 if (wpan_dev
->netdev
)
1125 dev_put(wpan_dev
->netdev
);
1127 dev_put(info
->user_ptr
[1]);
1131 if (ops
->internal_flags
& NL802154_FLAG_NEED_RTNL
)
1135 static const struct genl_ops nl802154_ops
[] = {
1137 .cmd
= NL802154_CMD_GET_WPAN_PHY
,
1138 .doit
= nl802154_get_wpan_phy
,
1139 .dumpit
= nl802154_dump_wpan_phy
,
1140 .done
= nl802154_dump_wpan_phy_done
,
1141 .policy
= nl802154_policy
,
1142 /* can be retrieved by unprivileged users */
1143 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1144 NL802154_FLAG_NEED_RTNL
,
1147 .cmd
= NL802154_CMD_GET_INTERFACE
,
1148 .doit
= nl802154_get_interface
,
1149 .dumpit
= nl802154_dump_interface
,
1150 .policy
= nl802154_policy
,
1151 /* can be retrieved by unprivileged users */
1152 .internal_flags
= NL802154_FLAG_NEED_WPAN_DEV
|
1153 NL802154_FLAG_NEED_RTNL
,
1156 .cmd
= NL802154_CMD_NEW_INTERFACE
,
1157 .doit
= nl802154_new_interface
,
1158 .policy
= nl802154_policy
,
1159 .flags
= GENL_ADMIN_PERM
,
1160 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1161 NL802154_FLAG_NEED_RTNL
,
1164 .cmd
= NL802154_CMD_DEL_INTERFACE
,
1165 .doit
= nl802154_del_interface
,
1166 .policy
= nl802154_policy
,
1167 .flags
= GENL_ADMIN_PERM
,
1168 .internal_flags
= NL802154_FLAG_NEED_WPAN_DEV
|
1169 NL802154_FLAG_NEED_RTNL
,
1172 .cmd
= NL802154_CMD_SET_CHANNEL
,
1173 .doit
= nl802154_set_channel
,
1174 .policy
= nl802154_policy
,
1175 .flags
= GENL_ADMIN_PERM
,
1176 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1177 NL802154_FLAG_NEED_RTNL
,
1180 .cmd
= NL802154_CMD_SET_CCA_MODE
,
1181 .doit
= nl802154_set_cca_mode
,
1182 .policy
= nl802154_policy
,
1183 .flags
= GENL_ADMIN_PERM
,
1184 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1185 NL802154_FLAG_NEED_RTNL
,
1188 .cmd
= NL802154_CMD_SET_CCA_ED_LEVEL
,
1189 .doit
= nl802154_set_cca_ed_level
,
1190 .policy
= nl802154_policy
,
1191 .flags
= GENL_ADMIN_PERM
,
1192 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1193 NL802154_FLAG_NEED_RTNL
,
1196 .cmd
= NL802154_CMD_SET_TX_POWER
,
1197 .doit
= nl802154_set_tx_power
,
1198 .policy
= nl802154_policy
,
1199 .flags
= GENL_ADMIN_PERM
,
1200 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1201 NL802154_FLAG_NEED_RTNL
,
1204 .cmd
= NL802154_CMD_SET_PAN_ID
,
1205 .doit
= nl802154_set_pan_id
,
1206 .policy
= nl802154_policy
,
1207 .flags
= GENL_ADMIN_PERM
,
1208 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1209 NL802154_FLAG_NEED_RTNL
,
1212 .cmd
= NL802154_CMD_SET_SHORT_ADDR
,
1213 .doit
= nl802154_set_short_addr
,
1214 .policy
= nl802154_policy
,
1215 .flags
= GENL_ADMIN_PERM
,
1216 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1217 NL802154_FLAG_NEED_RTNL
,
1220 .cmd
= NL802154_CMD_SET_BACKOFF_EXPONENT
,
1221 .doit
= nl802154_set_backoff_exponent
,
1222 .policy
= nl802154_policy
,
1223 .flags
= GENL_ADMIN_PERM
,
1224 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1225 NL802154_FLAG_NEED_RTNL
,
1228 .cmd
= NL802154_CMD_SET_MAX_CSMA_BACKOFFS
,
1229 .doit
= nl802154_set_max_csma_backoffs
,
1230 .policy
= nl802154_policy
,
1231 .flags
= GENL_ADMIN_PERM
,
1232 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1233 NL802154_FLAG_NEED_RTNL
,
1236 .cmd
= NL802154_CMD_SET_MAX_FRAME_RETRIES
,
1237 .doit
= nl802154_set_max_frame_retries
,
1238 .policy
= nl802154_policy
,
1239 .flags
= GENL_ADMIN_PERM
,
1240 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1241 NL802154_FLAG_NEED_RTNL
,
1244 .cmd
= NL802154_CMD_SET_LBT_MODE
,
1245 .doit
= nl802154_set_lbt_mode
,
1246 .policy
= nl802154_policy
,
1247 .flags
= GENL_ADMIN_PERM
,
1248 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1249 NL802154_FLAG_NEED_RTNL
,
1253 /* initialisation/exit functions */
1254 int nl802154_init(void)
1256 return genl_register_family_with_ops_groups(&nl802154_fam
, nl802154_ops
,
1260 void nl802154_exit(void)
1262 genl_unregister_family(&nl802154_fam
);