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
, },
230 /* message building helper */
231 static inline void *nl802154hdr_put(struct sk_buff
*skb
, u32 portid
, u32 seq
,
234 /* since there is no private header just add the generic one */
235 return genlmsg_put(skb
, portid
, seq
, &nl802154_fam
, flags
, cmd
);
239 nl802154_send_wpan_phy_channels(struct cfg802154_registered_device
*rdev
,
242 struct nlattr
*nl_page
;
245 nl_page
= nla_nest_start(msg
, NL802154_ATTR_CHANNELS_SUPPORTED
);
249 for (page
= 0; page
<= IEEE802154_MAX_PAGE
; page
++) {
250 if (nla_put_u32(msg
, NL802154_ATTR_SUPPORTED_CHANNEL
,
251 rdev
->wpan_phy
.supported
.channels
[page
]))
254 nla_nest_end(msg
, nl_page
);
259 static int nl802154_send_wpan_phy(struct cfg802154_registered_device
*rdev
,
260 enum nl802154_commands cmd
,
261 struct sk_buff
*msg
, u32 portid
, u32 seq
,
266 hdr
= nl802154hdr_put(msg
, portid
, seq
, flags
, cmd
);
270 if (nla_put_u32(msg
, NL802154_ATTR_WPAN_PHY
, rdev
->wpan_phy_idx
) ||
271 nla_put_string(msg
, NL802154_ATTR_WPAN_PHY_NAME
,
272 wpan_phy_name(&rdev
->wpan_phy
)) ||
273 nla_put_u32(msg
, NL802154_ATTR_GENERATION
,
274 cfg802154_rdev_list_generation
))
275 goto nla_put_failure
;
277 if (cmd
!= NL802154_CMD_NEW_WPAN_PHY
)
282 /* current channel settings */
283 if (nla_put_u8(msg
, NL802154_ATTR_PAGE
,
284 rdev
->wpan_phy
.current_page
) ||
285 nla_put_u8(msg
, NL802154_ATTR_CHANNEL
,
286 rdev
->wpan_phy
.current_channel
))
287 goto nla_put_failure
;
289 /* supported channels array */
290 if (nl802154_send_wpan_phy_channels(rdev
, msg
))
291 goto nla_put_failure
;
294 if (nla_put_u32(msg
, NL802154_ATTR_CCA_MODE
,
295 rdev
->wpan_phy
.cca
.mode
))
296 goto nla_put_failure
;
298 if (rdev
->wpan_phy
.cca
.mode
== NL802154_CCA_ENERGY_CARRIER
) {
299 if (nla_put_u32(msg
, NL802154_ATTR_CCA_OPT
,
300 rdev
->wpan_phy
.cca
.opt
))
301 goto nla_put_failure
;
304 if (nla_put_s32(msg
, NL802154_ATTR_TX_POWER
,
305 rdev
->wpan_phy
.transmit_power
))
306 goto nla_put_failure
;
309 genlmsg_end(msg
, hdr
);
313 genlmsg_cancel(msg
, hdr
);
317 struct nl802154_dump_wpan_phy_state
{
323 static int nl802154_dump_wpan_phy_parse(struct sk_buff
*skb
,
324 struct netlink_callback
*cb
,
325 struct nl802154_dump_wpan_phy_state
*state
)
327 struct nlattr
**tb
= nl802154_fam
.attrbuf
;
328 int ret
= nlmsg_parse(cb
->nlh
, GENL_HDRLEN
+ nl802154_fam
.hdrsize
,
329 tb
, nl802154_fam
.maxattr
, nl802154_policy
);
331 /* TODO check if we can handle error here,
332 * we have no backward compatibility
337 if (tb
[NL802154_ATTR_WPAN_PHY
])
338 state
->filter_wpan_phy
= nla_get_u32(tb
[NL802154_ATTR_WPAN_PHY
]);
339 if (tb
[NL802154_ATTR_WPAN_DEV
])
340 state
->filter_wpan_phy
= nla_get_u64(tb
[NL802154_ATTR_WPAN_DEV
]) >> 32;
341 if (tb
[NL802154_ATTR_IFINDEX
]) {
342 struct net_device
*netdev
;
343 struct cfg802154_registered_device
*rdev
;
344 int ifidx
= nla_get_u32(tb
[NL802154_ATTR_IFINDEX
]);
347 netdev
= __dev_get_by_index(&init_net
, ifidx
);
350 if (netdev
->ieee802154_ptr
) {
351 rdev
= wpan_phy_to_rdev(
352 netdev
->ieee802154_ptr
->wpan_phy
);
353 state
->filter_wpan_phy
= rdev
->wpan_phy_idx
;
361 nl802154_dump_wpan_phy(struct sk_buff
*skb
, struct netlink_callback
*cb
)
364 struct nl802154_dump_wpan_phy_state
*state
= (void *)cb
->args
[0];
365 struct cfg802154_registered_device
*rdev
;
369 state
= kzalloc(sizeof(*state
), GFP_KERNEL
);
374 state
->filter_wpan_phy
= -1;
375 ret
= nl802154_dump_wpan_phy_parse(skb
, cb
, state
);
381 cb
->args
[0] = (long)state
;
384 list_for_each_entry(rdev
, &cfg802154_rdev_list
, list
) {
385 /* TODO net ns compare */
386 if (++idx
<= state
->start
)
388 if (state
->filter_wpan_phy
!= -1 &&
389 state
->filter_wpan_phy
!= rdev
->wpan_phy_idx
)
391 /* attempt to fit multiple wpan_phy data chunks into the skb */
392 ret
= nl802154_send_wpan_phy(rdev
,
393 NL802154_CMD_NEW_WPAN_PHY
,
395 NETLINK_CB(cb
->skb
).portid
,
396 cb
->nlh
->nlmsg_seq
, NLM_F_MULTI
);
398 if ((ret
== -ENOBUFS
|| ret
== -EMSGSIZE
) &&
399 !skb
->len
&& cb
->min_dump_alloc
< 4096) {
400 cb
->min_dump_alloc
= 4096;
416 static int nl802154_dump_wpan_phy_done(struct netlink_callback
*cb
)
418 kfree((void *)cb
->args
[0]);
422 static int nl802154_get_wpan_phy(struct sk_buff
*skb
, struct genl_info
*info
)
425 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
427 msg
= nlmsg_new(NLMSG_DEFAULT_SIZE
, GFP_KERNEL
);
431 if (nl802154_send_wpan_phy(rdev
, NL802154_CMD_NEW_WPAN_PHY
, msg
,
432 info
->snd_portid
, info
->snd_seq
, 0) < 0) {
437 return genlmsg_reply(msg
, info
);
440 static inline u64
wpan_dev_id(struct wpan_dev
*wpan_dev
)
442 return (u64
)wpan_dev
->identifier
|
443 ((u64
)wpan_phy_to_rdev(wpan_dev
->wpan_phy
)->wpan_phy_idx
<< 32);
447 nl802154_send_iface(struct sk_buff
*msg
, u32 portid
, u32 seq
, int flags
,
448 struct cfg802154_registered_device
*rdev
,
449 struct wpan_dev
*wpan_dev
)
451 struct net_device
*dev
= wpan_dev
->netdev
;
454 hdr
= nl802154hdr_put(msg
, portid
, seq
, flags
,
455 NL802154_CMD_NEW_INTERFACE
);
460 (nla_put_u32(msg
, NL802154_ATTR_IFINDEX
, dev
->ifindex
) ||
461 nla_put_string(msg
, NL802154_ATTR_IFNAME
, dev
->name
)))
462 goto nla_put_failure
;
464 if (nla_put_u32(msg
, NL802154_ATTR_WPAN_PHY
, rdev
->wpan_phy_idx
) ||
465 nla_put_u32(msg
, NL802154_ATTR_IFTYPE
, wpan_dev
->iftype
) ||
466 nla_put_u64(msg
, NL802154_ATTR_WPAN_DEV
, wpan_dev_id(wpan_dev
)) ||
467 nla_put_u32(msg
, NL802154_ATTR_GENERATION
,
468 rdev
->devlist_generation
^
469 (cfg802154_rdev_list_generation
<< 2)))
470 goto nla_put_failure
;
472 /* address settings */
473 if (nla_put_le64(msg
, NL802154_ATTR_EXTENDED_ADDR
,
474 wpan_dev
->extended_addr
) ||
475 nla_put_le16(msg
, NL802154_ATTR_SHORT_ADDR
,
476 wpan_dev
->short_addr
) ||
477 nla_put_le16(msg
, NL802154_ATTR_PAN_ID
, wpan_dev
->pan_id
))
478 goto nla_put_failure
;
481 if (nla_put_s8(msg
, NL802154_ATTR_MAX_FRAME_RETRIES
,
482 wpan_dev
->frame_retries
) ||
483 nla_put_u8(msg
, NL802154_ATTR_MAX_BE
, wpan_dev
->max_be
) ||
484 nla_put_u8(msg
, NL802154_ATTR_MAX_CSMA_BACKOFFS
,
485 wpan_dev
->csma_retries
) ||
486 nla_put_u8(msg
, NL802154_ATTR_MIN_BE
, wpan_dev
->min_be
))
487 goto nla_put_failure
;
489 /* listen before transmit */
490 if (nla_put_u8(msg
, NL802154_ATTR_LBT_MODE
, wpan_dev
->lbt
))
491 goto nla_put_failure
;
493 genlmsg_end(msg
, hdr
);
497 genlmsg_cancel(msg
, hdr
);
502 nl802154_dump_interface(struct sk_buff
*skb
, struct netlink_callback
*cb
)
506 int wp_start
= cb
->args
[0];
507 int if_start
= cb
->args
[1];
508 struct cfg802154_registered_device
*rdev
;
509 struct wpan_dev
*wpan_dev
;
512 list_for_each_entry(rdev
, &cfg802154_rdev_list
, list
) {
513 /* TODO netns compare */
514 if (wp_idx
< wp_start
) {
520 list_for_each_entry(wpan_dev
, &rdev
->wpan_dev_list
, list
) {
521 if (if_idx
< if_start
) {
525 if (nl802154_send_iface(skb
, NETLINK_CB(cb
->skb
).portid
,
526 cb
->nlh
->nlmsg_seq
, NLM_F_MULTI
,
527 rdev
, wpan_dev
) < 0) {
538 cb
->args
[0] = wp_idx
;
539 cb
->args
[1] = if_idx
;
544 static int nl802154_get_interface(struct sk_buff
*skb
, struct genl_info
*info
)
547 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
548 struct wpan_dev
*wdev
= info
->user_ptr
[1];
550 msg
= nlmsg_new(NLMSG_DEFAULT_SIZE
, GFP_KERNEL
);
554 if (nl802154_send_iface(msg
, info
->snd_portid
, info
->snd_seq
, 0,
560 return genlmsg_reply(msg
, info
);
563 static int nl802154_new_interface(struct sk_buff
*skb
, struct genl_info
*info
)
565 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
566 enum nl802154_iftype type
= NL802154_IFTYPE_UNSPEC
;
567 __le64 extended_addr
= cpu_to_le64(0x0000000000000000ULL
);
569 /* TODO avoid failing a new interface
570 * creation due to pending removal?
573 if (!info
->attrs
[NL802154_ATTR_IFNAME
])
576 if (info
->attrs
[NL802154_ATTR_IFTYPE
]) {
577 type
= nla_get_u32(info
->attrs
[NL802154_ATTR_IFTYPE
]);
578 if (type
> NL802154_IFTYPE_MAX
)
582 /* TODO add nla_get_le64 to netlink */
583 if (info
->attrs
[NL802154_ATTR_EXTENDED_ADDR
])
584 extended_addr
= (__force __le64
)nla_get_u64(
585 info
->attrs
[NL802154_ATTR_EXTENDED_ADDR
]);
587 if (!rdev
->ops
->add_virtual_intf
)
590 return rdev_add_virtual_intf(rdev
,
591 nla_data(info
->attrs
[NL802154_ATTR_IFNAME
]),
592 NET_NAME_USER
, type
, extended_addr
);
595 static int nl802154_del_interface(struct sk_buff
*skb
, struct genl_info
*info
)
597 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
598 struct wpan_dev
*wpan_dev
= info
->user_ptr
[1];
600 if (!rdev
->ops
->del_virtual_intf
)
603 /* If we remove a wpan device without a netdev then clear
604 * user_ptr[1] so that nl802154_post_doit won't dereference it
605 * to check if it needs to do dev_put(). Otherwise it crashes
606 * since the wpan_dev has been freed, unlike with a netdev where
607 * we need the dev_put() for the netdev to really be freed.
609 if (!wpan_dev
->netdev
)
610 info
->user_ptr
[1] = NULL
;
612 return rdev_del_virtual_intf(rdev
, wpan_dev
);
615 static int nl802154_set_channel(struct sk_buff
*skb
, struct genl_info
*info
)
617 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
620 if (!info
->attrs
[NL802154_ATTR_PAGE
] ||
621 !info
->attrs
[NL802154_ATTR_CHANNEL
])
624 page
= nla_get_u8(info
->attrs
[NL802154_ATTR_PAGE
]);
625 channel
= nla_get_u8(info
->attrs
[NL802154_ATTR_CHANNEL
]);
627 /* check 802.15.4 constraints */
628 if (page
> IEEE802154_MAX_PAGE
|| channel
> IEEE802154_MAX_CHANNEL
||
629 !(rdev
->wpan_phy
.supported
.channels
[page
] & BIT(channel
)))
632 return rdev_set_channel(rdev
, page
, channel
);
635 static int nl802154_set_cca_mode(struct sk_buff
*skb
, struct genl_info
*info
)
637 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
638 struct wpan_phy_cca cca
;
640 if (!info
->attrs
[NL802154_ATTR_CCA_MODE
])
643 cca
.mode
= nla_get_u32(info
->attrs
[NL802154_ATTR_CCA_MODE
]);
644 /* checking 802.15.4 constraints */
645 if (cca
.mode
< NL802154_CCA_ENERGY
||
646 cca
.mode
> NL802154_CCA_ATTR_MAX
||
647 !(rdev
->wpan_phy
.supported
.cca_modes
& BIT(cca
.mode
)))
650 if (cca
.mode
== NL802154_CCA_ENERGY_CARRIER
) {
651 if (!info
->attrs
[NL802154_ATTR_CCA_OPT
])
654 cca
.opt
= nla_get_u32(info
->attrs
[NL802154_ATTR_CCA_OPT
]);
655 if (cca
.opt
> NL802154_CCA_OPT_ATTR_MAX
||
656 !(rdev
->wpan_phy
.supported
.cca_opts
& BIT(cca
.opt
)))
660 return rdev_set_cca_mode(rdev
, &cca
);
663 static int nl802154_set_pan_id(struct sk_buff
*skb
, struct genl_info
*info
)
665 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
666 struct net_device
*dev
= info
->user_ptr
[1];
667 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
670 /* conflict here while tx/rx calls */
671 if (netif_running(dev
))
674 /* don't change address fields on monitor */
675 if (wpan_dev
->iftype
== NL802154_IFTYPE_MONITOR
||
676 !info
->attrs
[NL802154_ATTR_PAN_ID
])
679 pan_id
= nla_get_le16(info
->attrs
[NL802154_ATTR_PAN_ID
]);
682 * I am not sure about to check here on broadcast pan_id.
683 * Broadcast is a valid setting, comment from 802.15.4:
684 * If this value is 0xffff, the device is not associated.
686 * This could useful to simple deassociate an device.
688 if (pan_id
== cpu_to_le16(IEEE802154_PAN_ID_BROADCAST
))
691 return rdev_set_pan_id(rdev
, wpan_dev
, pan_id
);
694 static int nl802154_set_short_addr(struct sk_buff
*skb
, struct genl_info
*info
)
696 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
697 struct net_device
*dev
= info
->user_ptr
[1];
698 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
701 /* conflict here while tx/rx calls */
702 if (netif_running(dev
))
705 /* don't change address fields on monitor */
706 if (wpan_dev
->iftype
== NL802154_IFTYPE_MONITOR
||
707 !info
->attrs
[NL802154_ATTR_SHORT_ADDR
])
710 short_addr
= nla_get_le16(info
->attrs
[NL802154_ATTR_SHORT_ADDR
]);
713 * I am not sure about to check here on broadcast short_addr.
714 * Broadcast is a valid setting, comment from 802.15.4:
715 * A value of 0xfffe indicates that the device has
716 * associated but has not been allocated an address. A
717 * value of 0xffff indicates that the device does not
718 * have a short address.
720 * I think we should allow to set these settings but
721 * don't allow to allow socket communication with it.
723 if (short_addr
== cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC
) ||
724 short_addr
== cpu_to_le16(IEEE802154_ADDR_SHORT_BROADCAST
))
727 return rdev_set_short_addr(rdev
, wpan_dev
, short_addr
);
731 nl802154_set_backoff_exponent(struct sk_buff
*skb
, struct genl_info
*info
)
733 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
734 struct net_device
*dev
= info
->user_ptr
[1];
735 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
738 /* should be set on netif open inside phy settings */
739 if (netif_running(dev
))
742 if (!info
->attrs
[NL802154_ATTR_MIN_BE
] ||
743 !info
->attrs
[NL802154_ATTR_MAX_BE
])
746 min_be
= nla_get_u8(info
->attrs
[NL802154_ATTR_MIN_BE
]);
747 max_be
= nla_get_u8(info
->attrs
[NL802154_ATTR_MAX_BE
]);
749 /* check 802.15.4 constraints */
750 if (min_be
< rdev
->wpan_phy
.supported
.min_minbe
||
751 min_be
> rdev
->wpan_phy
.supported
.max_minbe
||
752 max_be
< rdev
->wpan_phy
.supported
.min_maxbe
||
753 max_be
> rdev
->wpan_phy
.supported
.max_maxbe
||
757 return rdev_set_backoff_exponent(rdev
, wpan_dev
, min_be
, max_be
);
761 nl802154_set_max_csma_backoffs(struct sk_buff
*skb
, struct genl_info
*info
)
763 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
764 struct net_device
*dev
= info
->user_ptr
[1];
765 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
766 u8 max_csma_backoffs
;
768 /* conflict here while other running iface settings */
769 if (netif_running(dev
))
772 if (!info
->attrs
[NL802154_ATTR_MAX_CSMA_BACKOFFS
])
775 max_csma_backoffs
= nla_get_u8(
776 info
->attrs
[NL802154_ATTR_MAX_CSMA_BACKOFFS
]);
778 /* check 802.15.4 constraints */
779 if (max_csma_backoffs
< rdev
->wpan_phy
.supported
.min_csma_backoffs
||
780 max_csma_backoffs
> rdev
->wpan_phy
.supported
.max_csma_backoffs
)
783 return rdev_set_max_csma_backoffs(rdev
, wpan_dev
, max_csma_backoffs
);
787 nl802154_set_max_frame_retries(struct sk_buff
*skb
, struct genl_info
*info
)
789 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
790 struct net_device
*dev
= info
->user_ptr
[1];
791 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
792 s8 max_frame_retries
;
794 if (netif_running(dev
))
797 if (!info
->attrs
[NL802154_ATTR_MAX_FRAME_RETRIES
])
800 max_frame_retries
= nla_get_s8(
801 info
->attrs
[NL802154_ATTR_MAX_FRAME_RETRIES
]);
803 /* check 802.15.4 constraints */
804 if (max_frame_retries
< rdev
->wpan_phy
.supported
.min_frame_retries
||
805 max_frame_retries
> rdev
->wpan_phy
.supported
.max_frame_retries
)
808 return rdev_set_max_frame_retries(rdev
, wpan_dev
, max_frame_retries
);
811 static int nl802154_set_lbt_mode(struct sk_buff
*skb
, struct genl_info
*info
)
813 struct cfg802154_registered_device
*rdev
= info
->user_ptr
[0];
814 struct net_device
*dev
= info
->user_ptr
[1];
815 struct wpan_dev
*wpan_dev
= dev
->ieee802154_ptr
;
818 if (netif_running(dev
))
821 if (!info
->attrs
[NL802154_ATTR_LBT_MODE
])
824 mode
= !!nla_get_u8(info
->attrs
[NL802154_ATTR_LBT_MODE
]);
825 if (!wpan_phy_supported_bool(mode
, rdev
->wpan_phy
.supported
.lbt
))
828 return rdev_set_lbt_mode(rdev
, wpan_dev
, mode
);
831 #define NL802154_FLAG_NEED_WPAN_PHY 0x01
832 #define NL802154_FLAG_NEED_NETDEV 0x02
833 #define NL802154_FLAG_NEED_RTNL 0x04
834 #define NL802154_FLAG_CHECK_NETDEV_UP 0x08
835 #define NL802154_FLAG_NEED_NETDEV_UP (NL802154_FLAG_NEED_NETDEV |\
836 NL802154_FLAG_CHECK_NETDEV_UP)
837 #define NL802154_FLAG_NEED_WPAN_DEV 0x10
838 #define NL802154_FLAG_NEED_WPAN_DEV_UP (NL802154_FLAG_NEED_WPAN_DEV |\
839 NL802154_FLAG_CHECK_NETDEV_UP)
841 static int nl802154_pre_doit(const struct genl_ops
*ops
, struct sk_buff
*skb
,
842 struct genl_info
*info
)
844 struct cfg802154_registered_device
*rdev
;
845 struct wpan_dev
*wpan_dev
;
846 struct net_device
*dev
;
847 bool rtnl
= ops
->internal_flags
& NL802154_FLAG_NEED_RTNL
;
852 if (ops
->internal_flags
& NL802154_FLAG_NEED_WPAN_PHY
) {
853 rdev
= cfg802154_get_dev_from_info(genl_info_net(info
), info
);
857 return PTR_ERR(rdev
);
859 info
->user_ptr
[0] = rdev
;
860 } else if (ops
->internal_flags
& NL802154_FLAG_NEED_NETDEV
||
861 ops
->internal_flags
& NL802154_FLAG_NEED_WPAN_DEV
) {
863 wpan_dev
= __cfg802154_wpan_dev_from_attrs(genl_info_net(info
),
865 if (IS_ERR(wpan_dev
)) {
868 return PTR_ERR(wpan_dev
);
871 dev
= wpan_dev
->netdev
;
872 rdev
= wpan_phy_to_rdev(wpan_dev
->wpan_phy
);
874 if (ops
->internal_flags
& NL802154_FLAG_NEED_NETDEV
) {
881 info
->user_ptr
[1] = dev
;
883 info
->user_ptr
[1] = wpan_dev
;
887 if (ops
->internal_flags
& NL802154_FLAG_CHECK_NETDEV_UP
&&
888 !netif_running(dev
)) {
897 info
->user_ptr
[0] = rdev
;
903 static void nl802154_post_doit(const struct genl_ops
*ops
, struct sk_buff
*skb
,
904 struct genl_info
*info
)
906 if (info
->user_ptr
[1]) {
907 if (ops
->internal_flags
& NL802154_FLAG_NEED_WPAN_DEV
) {
908 struct wpan_dev
*wpan_dev
= info
->user_ptr
[1];
910 if (wpan_dev
->netdev
)
911 dev_put(wpan_dev
->netdev
);
913 dev_put(info
->user_ptr
[1]);
917 if (ops
->internal_flags
& NL802154_FLAG_NEED_RTNL
)
921 static const struct genl_ops nl802154_ops
[] = {
923 .cmd
= NL802154_CMD_GET_WPAN_PHY
,
924 .doit
= nl802154_get_wpan_phy
,
925 .dumpit
= nl802154_dump_wpan_phy
,
926 .done
= nl802154_dump_wpan_phy_done
,
927 .policy
= nl802154_policy
,
928 /* can be retrieved by unprivileged users */
929 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
930 NL802154_FLAG_NEED_RTNL
,
933 .cmd
= NL802154_CMD_GET_INTERFACE
,
934 .doit
= nl802154_get_interface
,
935 .dumpit
= nl802154_dump_interface
,
936 .policy
= nl802154_policy
,
937 /* can be retrieved by unprivileged users */
938 .internal_flags
= NL802154_FLAG_NEED_WPAN_DEV
|
939 NL802154_FLAG_NEED_RTNL
,
942 .cmd
= NL802154_CMD_NEW_INTERFACE
,
943 .doit
= nl802154_new_interface
,
944 .policy
= nl802154_policy
,
945 .flags
= GENL_ADMIN_PERM
,
946 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
947 NL802154_FLAG_NEED_RTNL
,
950 .cmd
= NL802154_CMD_DEL_INTERFACE
,
951 .doit
= nl802154_del_interface
,
952 .policy
= nl802154_policy
,
953 .flags
= GENL_ADMIN_PERM
,
954 .internal_flags
= NL802154_FLAG_NEED_WPAN_DEV
|
955 NL802154_FLAG_NEED_RTNL
,
958 .cmd
= NL802154_CMD_SET_CHANNEL
,
959 .doit
= nl802154_set_channel
,
960 .policy
= nl802154_policy
,
961 .flags
= GENL_ADMIN_PERM
,
962 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
963 NL802154_FLAG_NEED_RTNL
,
966 .cmd
= NL802154_CMD_SET_CCA_MODE
,
967 .doit
= nl802154_set_cca_mode
,
968 .policy
= nl802154_policy
,
969 .flags
= GENL_ADMIN_PERM
,
970 .internal_flags
= NL802154_FLAG_NEED_WPAN_PHY
|
971 NL802154_FLAG_NEED_RTNL
,
974 .cmd
= NL802154_CMD_SET_PAN_ID
,
975 .doit
= nl802154_set_pan_id
,
976 .policy
= nl802154_policy
,
977 .flags
= GENL_ADMIN_PERM
,
978 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
979 NL802154_FLAG_NEED_RTNL
,
982 .cmd
= NL802154_CMD_SET_SHORT_ADDR
,
983 .doit
= nl802154_set_short_addr
,
984 .policy
= nl802154_policy
,
985 .flags
= GENL_ADMIN_PERM
,
986 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
987 NL802154_FLAG_NEED_RTNL
,
990 .cmd
= NL802154_CMD_SET_BACKOFF_EXPONENT
,
991 .doit
= nl802154_set_backoff_exponent
,
992 .policy
= nl802154_policy
,
993 .flags
= GENL_ADMIN_PERM
,
994 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
995 NL802154_FLAG_NEED_RTNL
,
998 .cmd
= NL802154_CMD_SET_MAX_CSMA_BACKOFFS
,
999 .doit
= nl802154_set_max_csma_backoffs
,
1000 .policy
= nl802154_policy
,
1001 .flags
= GENL_ADMIN_PERM
,
1002 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1003 NL802154_FLAG_NEED_RTNL
,
1006 .cmd
= NL802154_CMD_SET_MAX_FRAME_RETRIES
,
1007 .doit
= nl802154_set_max_frame_retries
,
1008 .policy
= nl802154_policy
,
1009 .flags
= GENL_ADMIN_PERM
,
1010 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1011 NL802154_FLAG_NEED_RTNL
,
1014 .cmd
= NL802154_CMD_SET_LBT_MODE
,
1015 .doit
= nl802154_set_lbt_mode
,
1016 .policy
= nl802154_policy
,
1017 .flags
= GENL_ADMIN_PERM
,
1018 .internal_flags
= NL802154_FLAG_NEED_NETDEV
|
1019 NL802154_FLAG_NEED_RTNL
,
1023 /* initialisation/exit functions */
1024 int nl802154_init(void)
1026 return genl_register_family_with_ops_groups(&nl802154_fam
, nl802154_ops
,
1030 void nl802154_exit(void)
1032 genl_unregister_family(&nl802154_fam
);