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
, },
215 [NL802154_ATTR_SUPPORTED_CHANNEL
] = { .type
= NLA_U32
, },
217 [NL802154_ATTR_PAN_ID
] = { .type
= NLA_U16
, },
218 [NL802154_ATTR_EXTENDED_ADDR
] = { .type
= NLA_U64
},
219 [NL802154_ATTR_SHORT_ADDR
] = { .type
= NLA_U16
, },
221 [NL802154_ATTR_MIN_BE
] = { .type
= NLA_U8
, },
222 [NL802154_ATTR_MAX_BE
] = { .type
= NLA_U8
, },
223 [NL802154_ATTR_MAX_CSMA_BACKOFFS
] = { .type
= NLA_U8
, },
225 [NL802154_ATTR_MAX_FRAME_RETRIES
] = { .type
= NLA_S8
, },
227 [NL802154_ATTR_LBT_MODE
] = { .type
= NLA_U8
, },
229 [NL802154_ATTR_WPAN_PHY_CAPS
] = { .type
= NLA_NESTED
},
232 /* message building helper */
233 static inline void *nl802154hdr_put(struct sk_buff
*skb
, u32 portid
, u32 seq
,
236 /* since there is no private header just add the generic one */
237 return genlmsg_put(skb
, portid
, seq
, &nl802154_fam
, flags
, cmd
);
241 nl802154_put_flags(struct sk_buff
*msg
, int attr
, u32 mask
)
243 struct nlattr
*nl_flags
= nla_nest_start(msg
, attr
);
251 if ((mask
& 1) && nla_put_flag(msg
, i
))
258 nla_nest_end(msg
, nl_flags
);
263 nl802154_send_wpan_phy_channels(struct cfg802154_registered_device
*rdev
,
266 struct nlattr
*nl_page
;
269 nl_page
= nla_nest_start(msg
, NL802154_ATTR_CHANNELS_SUPPORTED
);
273 for (page
= 0; page
<= IEEE802154_MAX_PAGE
; page
++) {
274 if (nla_put_u32(msg
, NL802154_ATTR_SUPPORTED_CHANNEL
,
275 rdev
->wpan_phy
.supported
.channels
[page
]))
278 nla_nest_end(msg
, nl_page
);
284 nl802154_put_capabilities(struct sk_buff
*msg
,
285 struct cfg802154_registered_device
*rdev
)
287 const struct wpan_phy_supported
*caps
= &rdev
->wpan_phy
.supported
;
288 struct nlattr
*nl_caps
, *nl_channels
;
291 nl_caps
= nla_nest_start(msg
, NL802154_ATTR_WPAN_PHY_CAPS
);
295 nl_channels
= nla_nest_start(msg
, NL802154_CAP_ATTR_CHANNELS
);
299 for (i
= 0; i
<= IEEE802154_MAX_PAGE
; i
++) {
300 if (caps
->channels
[i
]) {
301 if (nl802154_put_flags(msg
, i
, caps
->channels
[i
]))
306 nla_nest_end(msg
, nl_channels
);
308 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_ED_LEVEL
) {
309 struct nlattr
*nl_ed_lvls
;
311 nl_ed_lvls
= nla_nest_start(msg
,
312 NL802154_CAP_ATTR_CCA_ED_LEVELS
);
316 for (i
= 0; i
< caps
->cca_ed_levels_size
; i
++) {
317 if (nla_put_s32(msg
, i
, caps
->cca_ed_levels
[i
]))
321 nla_nest_end(msg
, nl_ed_lvls
);
324 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_TXPOWER
) {
325 struct nlattr
*nl_tx_pwrs
;
327 nl_tx_pwrs
= nla_nest_start(msg
, NL802154_CAP_ATTR_TX_POWERS
);
331 for (i
= 0; i
< caps
->tx_powers_size
; i
++) {
332 if (nla_put_s32(msg
, i
, caps
->tx_powers
[i
]))
336 nla_nest_end(msg
, nl_tx_pwrs
);
339 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_MODE
) {
340 if (nl802154_put_flags(msg
, NL802154_CAP_ATTR_CCA_MODES
,
342 nl802154_put_flags(msg
, NL802154_CAP_ATTR_CCA_OPTS
,
347 if (nla_put_u8(msg
, NL802154_CAP_ATTR_MIN_MINBE
, caps
->min_minbe
) ||
348 nla_put_u8(msg
, NL802154_CAP_ATTR_MAX_MINBE
, caps
->max_minbe
) ||
349 nla_put_u8(msg
, NL802154_CAP_ATTR_MIN_MAXBE
, caps
->min_maxbe
) ||
350 nla_put_u8(msg
, NL802154_CAP_ATTR_MAX_MAXBE
, caps
->max_maxbe
) ||
351 nla_put_u8(msg
, NL802154_CAP_ATTR_MIN_CSMA_BACKOFFS
,
352 caps
->min_csma_backoffs
) ||
353 nla_put_u8(msg
, NL802154_CAP_ATTR_MAX_CSMA_BACKOFFS
,
354 caps
->max_csma_backoffs
) ||
355 nla_put_s8(msg
, NL802154_CAP_ATTR_MIN_FRAME_RETRIES
,
356 caps
->min_frame_retries
) ||
357 nla_put_s8(msg
, NL802154_CAP_ATTR_MAX_FRAME_RETRIES
,
358 caps
->max_frame_retries
) ||
359 nl802154_put_flags(msg
, NL802154_CAP_ATTR_IFTYPES
,
361 nla_put_u32(msg
, NL802154_CAP_ATTR_LBT
, caps
->lbt
))
364 nla_nest_end(msg
, nl_caps
);
369 static int nl802154_send_wpan_phy(struct cfg802154_registered_device
*rdev
,
370 enum nl802154_commands cmd
,
371 struct sk_buff
*msg
, u32 portid
, u32 seq
,
376 hdr
= nl802154hdr_put(msg
, portid
, seq
, flags
, cmd
);
380 if (nla_put_u32(msg
, NL802154_ATTR_WPAN_PHY
, rdev
->wpan_phy_idx
) ||
381 nla_put_string(msg
, NL802154_ATTR_WPAN_PHY_NAME
,
382 wpan_phy_name(&rdev
->wpan_phy
)) ||
383 nla_put_u32(msg
, NL802154_ATTR_GENERATION
,
384 cfg802154_rdev_list_generation
))
385 goto nla_put_failure
;
387 if (cmd
!= NL802154_CMD_NEW_WPAN_PHY
)
392 /* current channel settings */
393 if (nla_put_u8(msg
, NL802154_ATTR_PAGE
,
394 rdev
->wpan_phy
.current_page
) ||
395 nla_put_u8(msg
, NL802154_ATTR_CHANNEL
,
396 rdev
->wpan_phy
.current_channel
))
397 goto nla_put_failure
;
399 /* TODO remove this behaviour, we still keep support it for a while
400 * so users can change the behaviour to the new one.
402 if (nl802154_send_wpan_phy_channels(rdev
, msg
))
403 goto nla_put_failure
;
406 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_MODE
) {
407 if (nla_put_u32(msg
, NL802154_ATTR_CCA_MODE
,
408 rdev
->wpan_phy
.cca
.mode
))
409 goto nla_put_failure
;
411 if (rdev
->wpan_phy
.cca
.mode
== NL802154_CCA_ENERGY_CARRIER
) {
412 if (nla_put_u32(msg
, NL802154_ATTR_CCA_OPT
,
413 rdev
->wpan_phy
.cca
.opt
))
414 goto nla_put_failure
;
418 if (rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_TXPOWER
) {
419 if (nla_put_s32(msg
, NL802154_ATTR_TX_POWER
,
420 rdev
->wpan_phy
.transmit_power
))
421 goto nla_put_failure
;
424 if (nl802154_put_capabilities(msg
, rdev
))
425 goto nla_put_failure
;
428 genlmsg_end(msg
, hdr
);
432 genlmsg_cancel(msg
, hdr
);
436 struct nl802154_dump_wpan_phy_state
{
442 static int nl802154_dump_wpan_phy_parse(struct sk_buff
*skb
,
443 struct netlink_callback
*cb
,
444 struct nl802154_dump_wpan_phy_state
*state
)
446 struct nlattr
**tb
= nl802154_fam
.attrbuf
;
447 int ret
= nlmsg_parse(cb
->nlh
, GENL_HDRLEN
+ nl802154_fam
.hdrsize
,
448 tb
, nl802154_fam
.maxattr
, nl802154_policy
);
450 /* TODO check if we can handle error here,
451 * we have no backward compatibility
456 if (tb
[NL802154_ATTR_WPAN_PHY
])
457 state
->filter_wpan_phy
= nla_get_u32(tb
[NL802154_ATTR_WPAN_PHY
]);
458 if (tb
[NL802154_ATTR_WPAN_DEV
])
459 state
->filter_wpan_phy
= nla_get_u64(tb
[NL802154_ATTR_WPAN_DEV
]) >> 32;
460 if (tb
[NL802154_ATTR_IFINDEX
]) {
461 struct net_device
*netdev
;
462 struct cfg802154_registered_device
*rdev
;
463 int ifidx
= nla_get_u32(tb
[NL802154_ATTR_IFINDEX
]);
466 netdev
= __dev_get_by_index(&init_net
, ifidx
);
469 if (netdev
->ieee802154_ptr
) {
470 rdev
= wpan_phy_to_rdev(
471 netdev
->ieee802154_ptr
->wpan_phy
);
472 state
->filter_wpan_phy
= rdev
->wpan_phy_idx
;
480 nl802154_dump_wpan_phy(struct sk_buff
*skb
, struct netlink_callback
*cb
)
483 struct nl802154_dump_wpan_phy_state
*state
= (void *)cb
->args
[0];
484 struct cfg802154_registered_device
*rdev
;
488 state
= kzalloc(sizeof(*state
), GFP_KERNEL
);
493 state
->filter_wpan_phy
= -1;
494 ret
= nl802154_dump_wpan_phy_parse(skb
, cb
, state
);
500 cb
->args
[0] = (long)state
;
503 list_for_each_entry(rdev
, &cfg802154_rdev_list
, list
) {
504 /* TODO net ns compare */
505 if (++idx
<= state
->start
)
507 if (state
->filter_wpan_phy
!= -1 &&
508 state
->filter_wpan_phy
!= rdev
->wpan_phy_idx
)
510 /* attempt to fit multiple wpan_phy data chunks into the skb */
511 ret
= nl802154_send_wpan_phy(rdev
,
512 NL802154_CMD_NEW_WPAN_PHY
,
514 NETLINK_CB(cb
->skb
).portid
,
515 cb
->nlh
->nlmsg_seq
, NLM_F_MULTI
);
517 if ((ret
== -ENOBUFS
|| ret
== -EMSGSIZE
) &&
518 !skb
->len
&& cb
->min_dump_alloc
< 4096) {
519 cb
->min_dump_alloc
= 4096;
535 static int nl802154_dump_wpan_phy_done(struct netlink_callback
*cb
)
537 kfree((void *)cb
->args
[0]);
541 static int nl802154_get_wpan_phy(struct sk_buff
*skb
, struct genl_info
*info
)
544 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
546 msg
= nlmsg_new(NLMSG_DEFAULT_SIZE
, GFP_KERNEL
);
550 if (nl802154_send_wpan_phy(rdev
, NL802154_CMD_NEW_WPAN_PHY
, msg
,
551 info
->snd_portid
, info
->snd_seq
, 0) < 0) {
556 return genlmsg_reply(msg
, info
);
559 static inline u64
wpan_dev_id(struct wpan_dev
*wpan_dev
)
561 return (u64
)wpan_dev
->identifier
|
562 ((u64
)wpan_phy_to_rdev(wpan_dev
->wpan_phy
)->wpan_phy_idx
<< 32);
566 nl802154_send_iface(struct sk_buff
*msg
, u32 portid
, u32 seq
, int flags
,
567 struct cfg802154_registered_device
*rdev
,
568 struct wpan_dev
*wpan_dev
)
570 struct net_device
*dev
= wpan_dev
->netdev
;
573 hdr
= nl802154hdr_put(msg
, portid
, seq
, flags
,
574 NL802154_CMD_NEW_INTERFACE
);
579 (nla_put_u32(msg
, NL802154_ATTR_IFINDEX
, dev
->ifindex
) ||
580 nla_put_string(msg
, NL802154_ATTR_IFNAME
, dev
->name
)))
581 goto nla_put_failure
;
583 if (nla_put_u32(msg
, NL802154_ATTR_WPAN_PHY
, rdev
->wpan_phy_idx
) ||
584 nla_put_u32(msg
, NL802154_ATTR_IFTYPE
, wpan_dev
->iftype
) ||
585 nla_put_u64(msg
, NL802154_ATTR_WPAN_DEV
, wpan_dev_id(wpan_dev
)) ||
586 nla_put_u32(msg
, NL802154_ATTR_GENERATION
,
587 rdev
->devlist_generation
^
588 (cfg802154_rdev_list_generation
<< 2)))
589 goto nla_put_failure
;
591 /* address settings */
592 if (nla_put_le64(msg
, NL802154_ATTR_EXTENDED_ADDR
,
593 wpan_dev
->extended_addr
) ||
594 nla_put_le16(msg
, NL802154_ATTR_SHORT_ADDR
,
595 wpan_dev
->short_addr
) ||
596 nla_put_le16(msg
, NL802154_ATTR_PAN_ID
, wpan_dev
->pan_id
))
597 goto nla_put_failure
;
600 if (nla_put_s8(msg
, NL802154_ATTR_MAX_FRAME_RETRIES
,
601 wpan_dev
->frame_retries
) ||
602 nla_put_u8(msg
, NL802154_ATTR_MAX_BE
, wpan_dev
->max_be
) ||
603 nla_put_u8(msg
, NL802154_ATTR_MAX_CSMA_BACKOFFS
,
604 wpan_dev
->csma_retries
) ||
605 nla_put_u8(msg
, NL802154_ATTR_MIN_BE
, wpan_dev
->min_be
))
606 goto nla_put_failure
;
608 /* listen before transmit */
609 if (nla_put_u8(msg
, NL802154_ATTR_LBT_MODE
, wpan_dev
->lbt
))
610 goto nla_put_failure
;
612 genlmsg_end(msg
, hdr
);
616 genlmsg_cancel(msg
, hdr
);
621 nl802154_dump_interface(struct sk_buff
*skb
, struct netlink_callback
*cb
)
625 int wp_start
= cb
->args
[0];
626 int if_start
= cb
->args
[1];
627 struct cfg802154_registered_device
*rdev
;
628 struct wpan_dev
*wpan_dev
;
631 list_for_each_entry(rdev
, &cfg802154_rdev_list
, list
) {
632 /* TODO netns compare */
633 if (wp_idx
< wp_start
) {
639 list_for_each_entry(wpan_dev
, &rdev
->wpan_dev_list
, list
) {
640 if (if_idx
< if_start
) {
644 if (nl802154_send_iface(skb
, NETLINK_CB(cb
->skb
).portid
,
645 cb
->nlh
->nlmsg_seq
, NLM_F_MULTI
,
646 rdev
, wpan_dev
) < 0) {
657 cb
->args
[0] = wp_idx
;
658 cb
->args
[1] = if_idx
;
663 static int nl802154_get_interface(struct sk_buff
*skb
, struct genl_info
*info
)
666 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
667 struct wpan_dev
*wdev
= info
->user_ptr
[1];
669 msg
= nlmsg_new(NLMSG_DEFAULT_SIZE
, GFP_KERNEL
);
673 if (nl802154_send_iface(msg
, info
->snd_portid
, info
->snd_seq
, 0,
679 return genlmsg_reply(msg
, info
);
682 static int nl802154_new_interface(struct sk_buff
*skb
, struct genl_info
*info
)
684 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
685 enum nl802154_iftype type
= NL802154_IFTYPE_UNSPEC
;
686 __le64 extended_addr
= cpu_to_le64(0x0000000000000000ULL
);
688 /* TODO avoid failing a new interface
689 * creation due to pending removal?
692 if (!info
->attrs
[NL802154_ATTR_IFNAME
])
695 if (info
->attrs
[NL802154_ATTR_IFTYPE
]) {
696 type
= nla_get_u32(info
->attrs
[NL802154_ATTR_IFTYPE
]);
697 if (type
> NL802154_IFTYPE_MAX
||
698 !(rdev
->wpan_phy
.supported
.iftypes
& BIT(type
)))
702 /* TODO add nla_get_le64 to netlink */
703 if (info
->attrs
[NL802154_ATTR_EXTENDED_ADDR
])
704 extended_addr
= (__force __le64
)nla_get_u64(
705 info
->attrs
[NL802154_ATTR_EXTENDED_ADDR
]);
707 if (!rdev
->ops
->add_virtual_intf
)
710 return rdev_add_virtual_intf(rdev
,
711 nla_data(info
->attrs
[NL802154_ATTR_IFNAME
]),
712 NET_NAME_USER
, type
, extended_addr
);
715 static int nl802154_del_interface(struct sk_buff
*skb
, struct genl_info
*info
)
717 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
718 struct wpan_dev
*wpan_dev
= info
->user_ptr
[1];
720 if (!rdev
->ops
->del_virtual_intf
)
723 /* If we remove a wpan device without a netdev then clear
724 * user_ptr[1] so that nl802154_post_doit won't dereference it
725 * to check if it needs to do dev_put(). Otherwise it crashes
726 * since the wpan_dev has been freed, unlike with a netdev where
727 * we need the dev_put() for the netdev to really be freed.
729 if (!wpan_dev
->netdev
)
730 info
->user_ptr
[1] = NULL
;
732 return rdev_del_virtual_intf(rdev
, wpan_dev
);
735 static int nl802154_set_channel(struct sk_buff
*skb
, struct genl_info
*info
)
737 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
740 if (!info
->attrs
[NL802154_ATTR_PAGE
] ||
741 !info
->attrs
[NL802154_ATTR_CHANNEL
])
744 page
= nla_get_u8(info
->attrs
[NL802154_ATTR_PAGE
]);
745 channel
= nla_get_u8(info
->attrs
[NL802154_ATTR_CHANNEL
]);
747 /* check 802.15.4 constraints */
748 if (page
> IEEE802154_MAX_PAGE
|| channel
> IEEE802154_MAX_CHANNEL
||
749 !(rdev
->wpan_phy
.supported
.channels
[page
] & BIT(channel
)))
752 return rdev_set_channel(rdev
, page
, channel
);
755 static int nl802154_set_cca_mode(struct sk_buff
*skb
, struct genl_info
*info
)
757 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
758 struct wpan_phy_cca cca
;
760 if (!(rdev
->wpan_phy
.flags
& WPAN_PHY_FLAG_CCA_MODE
))
763 if (!info
->attrs
[NL802154_ATTR_CCA_MODE
])
766 cca
.mode
= nla_get_u32(info
->attrs
[NL802154_ATTR_CCA_MODE
]);
767 /* checking 802.15.4 constraints */
768 if (cca
.mode
< NL802154_CCA_ENERGY
||
769 cca
.mode
> NL802154_CCA_ATTR_MAX
||
770 !(rdev
->wpan_phy
.supported
.cca_modes
& BIT(cca
.mode
)))
773 if (cca
.mode
== NL802154_CCA_ENERGY_CARRIER
) {
774 if (!info
->attrs
[NL802154_ATTR_CCA_OPT
])
777 cca
.opt
= nla_get_u32(info
->attrs
[NL802154_ATTR_CCA_OPT
]);
778 if (cca
.opt
> NL802154_CCA_OPT_ATTR_MAX
||
779 !(rdev
->wpan_phy
.supported
.cca_opts
& BIT(cca
.opt
)))
783 return rdev_set_cca_mode(rdev
, &cca
);
786 static int nl802154_set_pan_id(struct sk_buff
*skb
, struct genl_info
*info
)
788 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
789 struct net_device
*dev
= info
->user_ptr
[1];
790 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
793 /* conflict here while tx/rx calls */
794 if (netif_running(dev
))
797 /* don't change address fields on monitor */
798 if (wpan_dev
->iftype
== NL802154_IFTYPE_MONITOR
||
799 !info
->attrs
[NL802154_ATTR_PAN_ID
])
802 pan_id
= nla_get_le16(info
->attrs
[NL802154_ATTR_PAN_ID
]);
805 * I am not sure about to check here on broadcast pan_id.
806 * Broadcast is a valid setting, comment from 802.15.4:
807 * If this value is 0xffff, the device is not associated.
809 * This could useful to simple deassociate an device.
811 if (pan_id
== cpu_to_le16(IEEE802154_PAN_ID_BROADCAST
))
814 return rdev_set_pan_id(rdev
, wpan_dev
, pan_id
);
817 static int nl802154_set_short_addr(struct sk_buff
*skb
, struct genl_info
*info
)
819 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
820 struct net_device
*dev
= info
->user_ptr
[1];
821 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
824 /* conflict here while tx/rx calls */
825 if (netif_running(dev
))
828 /* don't change address fields on monitor */
829 if (wpan_dev
->iftype
== NL802154_IFTYPE_MONITOR
||
830 !info
->attrs
[NL802154_ATTR_SHORT_ADDR
])
833 short_addr
= nla_get_le16(info
->attrs
[NL802154_ATTR_SHORT_ADDR
]);
836 * I am not sure about to check here on broadcast short_addr.
837 * Broadcast is a valid setting, comment from 802.15.4:
838 * A value of 0xfffe indicates that the device has
839 * associated but has not been allocated an address. A
840 * value of 0xffff indicates that the device does not
841 * have a short address.
843 * I think we should allow to set these settings but
844 * don't allow to allow socket communication with it.
846 if (short_addr
== cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC
) ||
847 short_addr
== cpu_to_le16(IEEE802154_ADDR_SHORT_BROADCAST
))
850 return rdev_set_short_addr(rdev
, wpan_dev
, short_addr
);
854 nl802154_set_backoff_exponent(struct sk_buff
*skb
, struct genl_info
*info
)
856 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
857 struct net_device
*dev
= info
->user_ptr
[1];
858 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
861 /* should be set on netif open inside phy settings */
862 if (netif_running(dev
))
865 if (!info
->attrs
[NL802154_ATTR_MIN_BE
] ||
866 !info
->attrs
[NL802154_ATTR_MAX_BE
])
869 min_be
= nla_get_u8(info
->attrs
[NL802154_ATTR_MIN_BE
]);
870 max_be
= nla_get_u8(info
->attrs
[NL802154_ATTR_MAX_BE
]);
872 /* check 802.15.4 constraints */
873 if (min_be
< rdev
->wpan_phy
.supported
.min_minbe
||
874 min_be
> rdev
->wpan_phy
.supported
.max_minbe
||
875 max_be
< rdev
->wpan_phy
.supported
.min_maxbe
||
876 max_be
> rdev
->wpan_phy
.supported
.max_maxbe
||
880 return rdev_set_backoff_exponent(rdev
, wpan_dev
, min_be
, max_be
);
884 nl802154_set_max_csma_backoffs(struct sk_buff
*skb
, struct genl_info
*info
)
886 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
887 struct net_device
*dev
= info
->user_ptr
[1];
888 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
889 u8 max_csma_backoffs
;
891 /* conflict here while other running iface settings */
892 if (netif_running(dev
))
895 if (!info
->attrs
[NL802154_ATTR_MAX_CSMA_BACKOFFS
])
898 max_csma_backoffs
= nla_get_u8(
899 info
->attrs
[NL802154_ATTR_MAX_CSMA_BACKOFFS
]);
901 /* check 802.15.4 constraints */
902 if (max_csma_backoffs
< rdev
->wpan_phy
.supported
.min_csma_backoffs
||
903 max_csma_backoffs
> rdev
->wpan_phy
.supported
.max_csma_backoffs
)
906 return rdev_set_max_csma_backoffs(rdev
, wpan_dev
, max_csma_backoffs
);
910 nl802154_set_max_frame_retries(struct sk_buff
*skb
, struct genl_info
*info
)
912 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
913 struct net_device
*dev
= info
->user_ptr
[1];
914 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
915 s8 max_frame_retries
;
917 if (netif_running(dev
))
920 if (!info
->attrs
[NL802154_ATTR_MAX_FRAME_RETRIES
])
923 max_frame_retries
= nla_get_s8(
924 info
->attrs
[NL802154_ATTR_MAX_FRAME_RETRIES
]);
926 /* check 802.15.4 constraints */
927 if (max_frame_retries
< rdev
->wpan_phy
.supported
.min_frame_retries
||
928 max_frame_retries
> rdev
->wpan_phy
.supported
.max_frame_retries
)
931 return rdev_set_max_frame_retries(rdev
, wpan_dev
, max_frame_retries
);
934 static int nl802154_set_lbt_mode(struct sk_buff
*skb
, struct genl_info
*info
)
936 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
937 struct net_device
*dev
= info
->user_ptr
[1];
938 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
941 if (netif_running(dev
))
944 if (!info
->attrs
[NL802154_ATTR_LBT_MODE
])
947 mode
= !!nla_get_u8(info
->attrs
[NL802154_ATTR_LBT_MODE
]);
948 if (!wpan_phy_supported_bool(mode
, rdev
->wpan_phy
.supported
.lbt
))
951 return rdev_set_lbt_mode(rdev
, wpan_dev
, mode
);
954 #define NL802154_FLAG_NEED_WPAN_PHY 0x01
955 #define NL802154_FLAG_NEED_NETDEV 0x02
956 #define NL802154_FLAG_NEED_RTNL 0x04
957 #define NL802154_FLAG_CHECK_NETDEV_UP 0x08
958 #define NL802154_FLAG_NEED_NETDEV_UP (NL802154_FLAG_NEED_NETDEV |\
959 NL802154_FLAG_CHECK_NETDEV_UP)
960 #define NL802154_FLAG_NEED_WPAN_DEV 0x10
961 #define NL802154_FLAG_NEED_WPAN_DEV_UP (NL802154_FLAG_NEED_WPAN_DEV |\
962 NL802154_FLAG_CHECK_NETDEV_UP)
964 static int nl802154_pre_doit(const struct genl_ops
*ops
, struct sk_buff
*skb
,
965 struct genl_info
*info
)
967 struct cfg802154_registered_device
*rdev
;
968 struct wpan_dev
*wpan_dev
;
969 struct net_device
*dev
;
970 bool rtnl
= ops
->internal_flags
& NL802154_FLAG_NEED_RTNL
;
975 if (ops
->internal_flags
& NL802154_FLAG_NEED_WPAN_PHY
) {
976 rdev
= cfg802154_get_dev_from_info(genl_info_net(info
), info
);
980 return PTR_ERR(rdev
);
982 info
->user_ptr
[0] = rdev
;
983 } else if (ops
->internal_flags
& NL802154_FLAG_NEED_NETDEV
||
984 ops
->internal_flags
& NL802154_FLAG_NEED_WPAN_DEV
) {
986 wpan_dev
= __cfg802154_wpan_dev_from_attrs(genl_info_net(info
),
988 if (IS_ERR(wpan_dev
)) {
991 return PTR_ERR(wpan_dev
);
994 dev
= wpan_dev
->netdev
;
995 rdev
= wpan_phy_to_rdev(wpan_dev
->wpan_phy
);
997 if (ops
->internal_flags
& NL802154_FLAG_NEED_NETDEV
) {
1004 info
->user_ptr
[1] = dev
;
1006 info
->user_ptr
[1] = wpan_dev
;
1010 if (ops
->internal_flags
& NL802154_FLAG_CHECK_NETDEV_UP
&&
1011 !netif_running(dev
)) {
1020 info
->user_ptr
[0] = rdev
;
1026 static void nl802154_post_doit(const struct genl_ops
*ops
, struct sk_buff
*skb
,
1027 struct genl_info
*info
)
1029 if (info
->user_ptr
[1]) {
1030 if (ops
->internal_flags
& NL802154_FLAG_NEED_WPAN_DEV
) {
1031 struct wpan_dev
*wpan_dev
= info
->user_ptr
[1];
1033 if (wpan_dev
->netdev
)
1034 dev_put(wpan_dev
->netdev
);
1036 dev_put(info
->user_ptr
[1]);
1040 if (ops
->internal_flags
& NL802154_FLAG_NEED_RTNL
)
1044 static const struct genl_ops nl802154_ops
[] = {
1046 .cmd
= NL802154_CMD_GET_WPAN_PHY
,
1047 .doit
= nl802154_get_wpan_phy
,
1048 .dumpit
= nl802154_dump_wpan_phy
,
1049 .done
= nl802154_dump_wpan_phy_done
,
1050 .policy
= nl802154_policy
,
1051 /* can be retrieved by unprivileged users */
1052 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1053 NL802154_FLAG_NEED_RTNL
,
1056 .cmd
= NL802154_CMD_GET_INTERFACE
,
1057 .doit
= nl802154_get_interface
,
1058 .dumpit
= nl802154_dump_interface
,
1059 .policy
= nl802154_policy
,
1060 /* can be retrieved by unprivileged users */
1061 .internal_flags
= NL802154_FLAG_NEED_WPAN_DEV
|
1062 NL802154_FLAG_NEED_RTNL
,
1065 .cmd
= NL802154_CMD_NEW_INTERFACE
,
1066 .doit
= nl802154_new_interface
,
1067 .policy
= nl802154_policy
,
1068 .flags
= GENL_ADMIN_PERM
,
1069 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1070 NL802154_FLAG_NEED_RTNL
,
1073 .cmd
= NL802154_CMD_DEL_INTERFACE
,
1074 .doit
= nl802154_del_interface
,
1075 .policy
= nl802154_policy
,
1076 .flags
= GENL_ADMIN_PERM
,
1077 .internal_flags
= NL802154_FLAG_NEED_WPAN_DEV
|
1078 NL802154_FLAG_NEED_RTNL
,
1081 .cmd
= NL802154_CMD_SET_CHANNEL
,
1082 .doit
= nl802154_set_channel
,
1083 .policy
= nl802154_policy
,
1084 .flags
= GENL_ADMIN_PERM
,
1085 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1086 NL802154_FLAG_NEED_RTNL
,
1089 .cmd
= NL802154_CMD_SET_CCA_MODE
,
1090 .doit
= nl802154_set_cca_mode
,
1091 .policy
= nl802154_policy
,
1092 .flags
= GENL_ADMIN_PERM
,
1093 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
1094 NL802154_FLAG_NEED_RTNL
,
1097 .cmd
= NL802154_CMD_SET_PAN_ID
,
1098 .doit
= nl802154_set_pan_id
,
1099 .policy
= nl802154_policy
,
1100 .flags
= GENL_ADMIN_PERM
,
1101 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1102 NL802154_FLAG_NEED_RTNL
,
1105 .cmd
= NL802154_CMD_SET_SHORT_ADDR
,
1106 .doit
= nl802154_set_short_addr
,
1107 .policy
= nl802154_policy
,
1108 .flags
= GENL_ADMIN_PERM
,
1109 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1110 NL802154_FLAG_NEED_RTNL
,
1113 .cmd
= NL802154_CMD_SET_BACKOFF_EXPONENT
,
1114 .doit
= nl802154_set_backoff_exponent
,
1115 .policy
= nl802154_policy
,
1116 .flags
= GENL_ADMIN_PERM
,
1117 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1118 NL802154_FLAG_NEED_RTNL
,
1121 .cmd
= NL802154_CMD_SET_MAX_CSMA_BACKOFFS
,
1122 .doit
= nl802154_set_max_csma_backoffs
,
1123 .policy
= nl802154_policy
,
1124 .flags
= GENL_ADMIN_PERM
,
1125 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1126 NL802154_FLAG_NEED_RTNL
,
1129 .cmd
= NL802154_CMD_SET_MAX_FRAME_RETRIES
,
1130 .doit
= nl802154_set_max_frame_retries
,
1131 .policy
= nl802154_policy
,
1132 .flags
= GENL_ADMIN_PERM
,
1133 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1134 NL802154_FLAG_NEED_RTNL
,
1137 .cmd
= NL802154_CMD_SET_LBT_MODE
,
1138 .doit
= nl802154_set_lbt_mode
,
1139 .policy
= nl802154_policy
,
1140 .flags
= GENL_ADMIN_PERM
,
1141 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1142 NL802154_FLAG_NEED_RTNL
,
1146 /* initialisation/exit functions */
1147 int nl802154_init(void)
1149 return genl_register_family_with_ops_groups(&nl802154_fam
, nl802154_ops
,
1153 void nl802154_exit(void)
1155 genl_unregister_family(&nl802154_fam
);