2 * Netlink inteface for IEEE 802.15.4 stack
4 * Copyright 2007, 2008 Siemens AG
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2
8 * as published by the Free Software Foundation.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 * Sergey Lapin <slapin@ossfans.org>
21 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
24 #include <linux/kernel.h>
25 #include <linux/if_arp.h>
26 #include <linux/netdevice.h>
27 #include <net/netlink.h>
28 #include <net/genetlink.h>
29 #include <linux/nl802154.h>
30 #include <net/ieee802154/af_ieee802154.h>
31 #include <net/ieee802154/nl802154.h>
32 #include <net/ieee802154/netdevice.h>
34 static unsigned int ieee802154_seq_num
;
36 static struct genl_family ieee802154_coordinator_family
= {
37 .id
= GENL_ID_GENERATE
,
39 .name
= IEEE802154_NL_NAME
,
41 .maxattr
= IEEE802154_ATTR_MAX
,
44 static struct genl_multicast_group ieee802154_coord_mcgrp
= {
45 .name
= IEEE802154_MCAST_COORD_NAME
,
48 static struct genl_multicast_group ieee802154_beacon_mcgrp
= {
49 .name
= IEEE802154_MCAST_BEACON_NAME
,
52 /* Requests to userspace */
53 static struct sk_buff
*ieee802154_nl_create(int flags
, u8 req
)
56 struct sk_buff
*msg
= nlmsg_new(NLMSG_GOODSIZE
, GFP_ATOMIC
);
61 hdr
= genlmsg_put(msg
, 0, ieee802154_seq_num
++,
62 &ieee802154_coordinator_family
, flags
, req
);
71 static int ieee802154_nl_finish(struct sk_buff
*msg
)
73 /* XXX: nlh is right at the start of msg */
74 void *hdr
= genlmsg_data(NLMSG_DATA(msg
->data
));
76 if (!genlmsg_end(msg
, hdr
))
79 return genlmsg_multicast(msg
, 0, ieee802154_coord_mcgrp
.id
,
86 int ieee802154_nl_assoc_indic(struct net_device
*dev
,
87 struct ieee802154_addr
*addr
, u8 cap
)
91 pr_debug("%s\n", __func__
);
93 if (addr
->addr_type
!= IEEE802154_ADDR_LONG
) {
94 pr_err("%s: received non-long source address!\n", __func__
);
98 msg
= ieee802154_nl_create(0, IEEE802154_ASSOCIATE_INDIC
);
102 NLA_PUT_STRING(msg
, IEEE802154_ATTR_DEV_NAME
, dev
->name
);
103 NLA_PUT_U32(msg
, IEEE802154_ATTR_DEV_INDEX
, dev
->ifindex
);
104 NLA_PUT(msg
, IEEE802154_ATTR_HW_ADDR
, IEEE802154_ADDR_LEN
,
107 NLA_PUT(msg
, IEEE802154_ATTR_SRC_HW_ADDR
, IEEE802154_ADDR_LEN
,
110 NLA_PUT_U8(msg
, IEEE802154_ATTR_CAPABILITY
, cap
);
112 return ieee802154_nl_finish(msg
);
118 EXPORT_SYMBOL(ieee802154_nl_assoc_indic
);
120 int ieee802154_nl_assoc_confirm(struct net_device
*dev
, u16 short_addr
,
125 pr_debug("%s\n", __func__
);
127 msg
= ieee802154_nl_create(0, IEEE802154_ASSOCIATE_CONF
);
131 NLA_PUT_STRING(msg
, IEEE802154_ATTR_DEV_NAME
, dev
->name
);
132 NLA_PUT_U32(msg
, IEEE802154_ATTR_DEV_INDEX
, dev
->ifindex
);
133 NLA_PUT(msg
, IEEE802154_ATTR_HW_ADDR
, IEEE802154_ADDR_LEN
,
136 NLA_PUT_U16(msg
, IEEE802154_ATTR_SHORT_ADDR
, short_addr
);
137 NLA_PUT_U8(msg
, IEEE802154_ATTR_STATUS
, status
);
139 return ieee802154_nl_finish(msg
);
145 EXPORT_SYMBOL(ieee802154_nl_assoc_confirm
);
147 int ieee802154_nl_disassoc_indic(struct net_device
*dev
,
148 struct ieee802154_addr
*addr
, u8 reason
)
152 pr_debug("%s\n", __func__
);
154 msg
= ieee802154_nl_create(0, IEEE802154_DISASSOCIATE_INDIC
);
158 NLA_PUT_STRING(msg
, IEEE802154_ATTR_DEV_NAME
, dev
->name
);
159 NLA_PUT_U32(msg
, IEEE802154_ATTR_DEV_INDEX
, dev
->ifindex
);
160 NLA_PUT(msg
, IEEE802154_ATTR_HW_ADDR
, IEEE802154_ADDR_LEN
,
163 if (addr
->addr_type
== IEEE802154_ADDR_LONG
)
164 NLA_PUT(msg
, IEEE802154_ATTR_SRC_HW_ADDR
, IEEE802154_ADDR_LEN
,
167 NLA_PUT_U16(msg
, IEEE802154_ATTR_SRC_SHORT_ADDR
,
170 NLA_PUT_U8(msg
, IEEE802154_ATTR_REASON
, reason
);
172 return ieee802154_nl_finish(msg
);
178 EXPORT_SYMBOL(ieee802154_nl_disassoc_indic
);
180 int ieee802154_nl_disassoc_confirm(struct net_device
*dev
, u8 status
)
184 pr_debug("%s\n", __func__
);
186 msg
= ieee802154_nl_create(0, IEEE802154_DISASSOCIATE_CONF
);
190 NLA_PUT_STRING(msg
, IEEE802154_ATTR_DEV_NAME
, dev
->name
);
191 NLA_PUT_U32(msg
, IEEE802154_ATTR_DEV_INDEX
, dev
->ifindex
);
192 NLA_PUT(msg
, IEEE802154_ATTR_HW_ADDR
, IEEE802154_ADDR_LEN
,
195 NLA_PUT_U8(msg
, IEEE802154_ATTR_STATUS
, status
);
197 return ieee802154_nl_finish(msg
);
203 EXPORT_SYMBOL(ieee802154_nl_disassoc_confirm
);
205 int ieee802154_nl_beacon_indic(struct net_device
*dev
,
206 u16 panid
, u16 coord_addr
)
210 pr_debug("%s\n", __func__
);
212 msg
= ieee802154_nl_create(0, IEEE802154_BEACON_NOTIFY_INDIC
);
216 NLA_PUT_STRING(msg
, IEEE802154_ATTR_DEV_NAME
, dev
->name
);
217 NLA_PUT_U32(msg
, IEEE802154_ATTR_DEV_INDEX
, dev
->ifindex
);
218 NLA_PUT(msg
, IEEE802154_ATTR_HW_ADDR
, IEEE802154_ADDR_LEN
,
220 NLA_PUT_U16(msg
, IEEE802154_ATTR_COORD_SHORT_ADDR
, coord_addr
);
221 NLA_PUT_U16(msg
, IEEE802154_ATTR_COORD_PAN_ID
, panid
);
223 return ieee802154_nl_finish(msg
);
229 EXPORT_SYMBOL(ieee802154_nl_beacon_indic
);
231 int ieee802154_nl_scan_confirm(struct net_device
*dev
,
232 u8 status
, u8 scan_type
, u32 unscanned
,
233 u8
*edl
/* , struct list_head *pan_desc_list */)
237 pr_debug("%s\n", __func__
);
239 msg
= ieee802154_nl_create(0, IEEE802154_SCAN_CONF
);
243 NLA_PUT_STRING(msg
, IEEE802154_ATTR_DEV_NAME
, dev
->name
);
244 NLA_PUT_U32(msg
, IEEE802154_ATTR_DEV_INDEX
, dev
->ifindex
);
245 NLA_PUT(msg
, IEEE802154_ATTR_HW_ADDR
, IEEE802154_ADDR_LEN
,
248 NLA_PUT_U8(msg
, IEEE802154_ATTR_STATUS
, status
);
249 NLA_PUT_U8(msg
, IEEE802154_ATTR_SCAN_TYPE
, scan_type
);
250 NLA_PUT_U32(msg
, IEEE802154_ATTR_CHANNELS
, unscanned
);
253 NLA_PUT(msg
, IEEE802154_ATTR_ED_LIST
, 27, edl
);
255 return ieee802154_nl_finish(msg
);
261 EXPORT_SYMBOL(ieee802154_nl_scan_confirm
);
263 /* Requests from userspace */
264 static struct net_device
*ieee802154_nl_get_dev(struct genl_info
*info
)
266 struct net_device
*dev
;
268 if (info
->attrs
[IEEE802154_ATTR_DEV_NAME
]) {
269 char name
[IFNAMSIZ
+ 1];
270 nla_strlcpy(name
, info
->attrs
[IEEE802154_ATTR_DEV_NAME
],
272 dev
= dev_get_by_name(&init_net
, name
);
273 } else if (info
->attrs
[IEEE802154_ATTR_DEV_INDEX
])
274 dev
= dev_get_by_index(&init_net
,
275 nla_get_u32(info
->attrs
[IEEE802154_ATTR_DEV_INDEX
]));
279 if (dev
->type
!= ARPHRD_IEEE802154
) {
287 static int ieee802154_associate_req(struct sk_buff
*skb
,
288 struct genl_info
*info
)
290 struct net_device
*dev
;
291 struct ieee802154_addr addr
;
294 if (!info
->attrs
[IEEE802154_ATTR_CHANNEL
] ||
295 !info
->attrs
[IEEE802154_ATTR_COORD_PAN_ID
] ||
296 (!info
->attrs
[IEEE802154_ATTR_COORD_HW_ADDR
] &&
297 !info
->attrs
[IEEE802154_ATTR_COORD_SHORT_ADDR
]) ||
298 !info
->attrs
[IEEE802154_ATTR_CAPABILITY
])
301 dev
= ieee802154_nl_get_dev(info
);
305 if (info
->attrs
[IEEE802154_ATTR_COORD_HW_ADDR
]) {
306 addr
.addr_type
= IEEE802154_ADDR_LONG
;
307 nla_memcpy(addr
.hwaddr
,
308 info
->attrs
[IEEE802154_ATTR_COORD_HW_ADDR
],
309 IEEE802154_ADDR_LEN
);
311 addr
.addr_type
= IEEE802154_ADDR_SHORT
;
312 addr
.short_addr
= nla_get_u16(
313 info
->attrs
[IEEE802154_ATTR_COORD_SHORT_ADDR
]);
315 addr
.pan_id
= nla_get_u16(info
->attrs
[IEEE802154_ATTR_COORD_PAN_ID
]);
317 ret
= ieee802154_mlme_ops(dev
)->assoc_req(dev
, &addr
,
318 nla_get_u8(info
->attrs
[IEEE802154_ATTR_CHANNEL
]),
319 nla_get_u8(info
->attrs
[IEEE802154_ATTR_CAPABILITY
]));
325 static int ieee802154_associate_resp(struct sk_buff
*skb
,
326 struct genl_info
*info
)
328 struct net_device
*dev
;
329 struct ieee802154_addr addr
;
332 if (!info
->attrs
[IEEE802154_ATTR_STATUS
] ||
333 !info
->attrs
[IEEE802154_ATTR_DEST_HW_ADDR
] ||
334 !info
->attrs
[IEEE802154_ATTR_DEST_SHORT_ADDR
])
337 dev
= ieee802154_nl_get_dev(info
);
341 addr
.addr_type
= IEEE802154_ADDR_LONG
;
342 nla_memcpy(addr
.hwaddr
, info
->attrs
[IEEE802154_ATTR_DEST_HW_ADDR
],
343 IEEE802154_ADDR_LEN
);
344 addr
.pan_id
= ieee802154_mlme_ops(dev
)->get_pan_id(dev
);
347 ret
= ieee802154_mlme_ops(dev
)->assoc_resp(dev
, &addr
,
348 nla_get_u16(info
->attrs
[IEEE802154_ATTR_DEST_SHORT_ADDR
]),
349 nla_get_u8(info
->attrs
[IEEE802154_ATTR_STATUS
]));
355 static int ieee802154_disassociate_req(struct sk_buff
*skb
,
356 struct genl_info
*info
)
358 struct net_device
*dev
;
359 struct ieee802154_addr addr
;
362 if ((!info
->attrs
[IEEE802154_ATTR_DEST_HW_ADDR
] &&
363 !info
->attrs
[IEEE802154_ATTR_DEST_SHORT_ADDR
]) ||
364 !info
->attrs
[IEEE802154_ATTR_REASON
])
367 dev
= ieee802154_nl_get_dev(info
);
371 if (info
->attrs
[IEEE802154_ATTR_DEST_HW_ADDR
]) {
372 addr
.addr_type
= IEEE802154_ADDR_LONG
;
373 nla_memcpy(addr
.hwaddr
,
374 info
->attrs
[IEEE802154_ATTR_DEST_HW_ADDR
],
375 IEEE802154_ADDR_LEN
);
377 addr
.addr_type
= IEEE802154_ADDR_SHORT
;
378 addr
.short_addr
= nla_get_u16(
379 info
->attrs
[IEEE802154_ATTR_DEST_SHORT_ADDR
]);
381 addr
.pan_id
= ieee802154_mlme_ops(dev
)->get_pan_id(dev
);
383 ret
= ieee802154_mlme_ops(dev
)->disassoc_req(dev
, &addr
,
384 nla_get_u8(info
->attrs
[IEEE802154_ATTR_REASON
]));
391 * PANid, channel, beacon_order = 15, superframe_order = 15,
392 * PAN_coordinator, battery_life_extension = 0,
393 * coord_realignment = 0, security_enable = 0
395 static int ieee802154_start_req(struct sk_buff
*skb
, struct genl_info
*info
)
397 struct net_device
*dev
;
398 struct ieee802154_addr addr
;
400 u8 channel
, bcn_ord
, sf_ord
;
401 int pan_coord
, blx
, coord_realign
;
404 if (!info
->attrs
[IEEE802154_ATTR_COORD_PAN_ID
] ||
405 !info
->attrs
[IEEE802154_ATTR_COORD_SHORT_ADDR
] ||
406 !info
->attrs
[IEEE802154_ATTR_CHANNEL
] ||
407 !info
->attrs
[IEEE802154_ATTR_BCN_ORD
] ||
408 !info
->attrs
[IEEE802154_ATTR_SF_ORD
] ||
409 !info
->attrs
[IEEE802154_ATTR_PAN_COORD
] ||
410 !info
->attrs
[IEEE802154_ATTR_BAT_EXT
] ||
411 !info
->attrs
[IEEE802154_ATTR_COORD_REALIGN
]
415 dev
= ieee802154_nl_get_dev(info
);
419 addr
.addr_type
= IEEE802154_ADDR_SHORT
;
420 addr
.short_addr
= nla_get_u16(
421 info
->attrs
[IEEE802154_ATTR_COORD_SHORT_ADDR
]);
422 addr
.pan_id
= nla_get_u16(info
->attrs
[IEEE802154_ATTR_COORD_PAN_ID
]);
424 channel
= nla_get_u8(info
->attrs
[IEEE802154_ATTR_CHANNEL
]);
425 bcn_ord
= nla_get_u8(info
->attrs
[IEEE802154_ATTR_BCN_ORD
]);
426 sf_ord
= nla_get_u8(info
->attrs
[IEEE802154_ATTR_SF_ORD
]);
427 pan_coord
= nla_get_u8(info
->attrs
[IEEE802154_ATTR_PAN_COORD
]);
428 blx
= nla_get_u8(info
->attrs
[IEEE802154_ATTR_BAT_EXT
]);
429 coord_realign
= nla_get_u8(info
->attrs
[IEEE802154_ATTR_COORD_REALIGN
]);
431 ret
= ieee802154_mlme_ops(dev
)->start_req(dev
, &addr
, channel
,
432 bcn_ord
, sf_ord
, pan_coord
, blx
, coord_realign
);
438 static int ieee802154_scan_req(struct sk_buff
*skb
, struct genl_info
*info
)
440 struct net_device
*dev
;
446 if (!info
->attrs
[IEEE802154_ATTR_SCAN_TYPE
] ||
447 !info
->attrs
[IEEE802154_ATTR_CHANNELS
] ||
448 !info
->attrs
[IEEE802154_ATTR_DURATION
])
451 dev
= ieee802154_nl_get_dev(info
);
455 type
= nla_get_u8(info
->attrs
[IEEE802154_ATTR_SCAN_TYPE
]);
456 channels
= nla_get_u32(info
->attrs
[IEEE802154_ATTR_CHANNELS
]);
457 duration
= nla_get_u8(info
->attrs
[IEEE802154_ATTR_DURATION
]);
459 ret
= ieee802154_mlme_ops(dev
)->scan_req(dev
, type
, channels
,
466 #define IEEE802154_OP(_cmd, _func) \
469 .policy = ieee802154_policy, \
472 .flags = GENL_ADMIN_PERM, \
475 static struct genl_ops ieee802154_coordinator_ops
[] = {
476 IEEE802154_OP(IEEE802154_ASSOCIATE_REQ
, ieee802154_associate_req
),
477 IEEE802154_OP(IEEE802154_ASSOCIATE_RESP
, ieee802154_associate_resp
),
478 IEEE802154_OP(IEEE802154_DISASSOCIATE_REQ
, ieee802154_disassociate_req
),
479 IEEE802154_OP(IEEE802154_SCAN_REQ
, ieee802154_scan_req
),
480 IEEE802154_OP(IEEE802154_START_REQ
, ieee802154_start_req
),
483 static int __init
ieee802154_nl_init(void)
488 rc
= genl_register_family(&ieee802154_coordinator_family
);
492 rc
= genl_register_mc_group(&ieee802154_coordinator_family
,
493 &ieee802154_coord_mcgrp
);
497 rc
= genl_register_mc_group(&ieee802154_coordinator_family
,
498 &ieee802154_beacon_mcgrp
);
503 for (i
= 0; i
< ARRAY_SIZE(ieee802154_coordinator_ops
); i
++) {
504 rc
= genl_register_ops(&ieee802154_coordinator_family
,
505 &ieee802154_coordinator_ops
[i
]);
513 genl_unregister_family(&ieee802154_coordinator_family
);
516 module_init(ieee802154_nl_init
);
518 static void __exit
ieee802154_nl_exit(void)
520 genl_unregister_family(&ieee802154_coordinator_family
);
522 module_exit(ieee802154_nl_exit
);