netlink.c

  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Netlink interface for IEEE 802.15.4 stack
  4 *
  5 * Copyright 2007, 2008 Siemens AG
  6 *
  7 * Written by:
  8 * Sergey Lapin <slapin@ossfans.org>
  9 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
 10 * Maxim Osipov <maxim.osipov@siemens.com>
 11 */
 12
 13#include <linux/kernel.h>
 14#include <linux/gfp.h>
 15#include <net/genetlink.h>
 16#include <linux/nl802154.h>
 17
 18#include "ieee802154.h"
 19
 20static unsigned int ieee802154_seq_num;
 21static DEFINE_SPINLOCK(ieee802154_seq_lock);
 22
 23/* Requests to userspace */
 24struct sk_buff *ieee802154_nl_create(int flags, u8 req)
 25{
 26	void *hdr;
 27	struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
 28	unsigned long f;
 29
 30	if (!msg)
 31		return NULL;
 32
 33	spin_lock_irqsave(&ieee802154_seq_lock, f);
 34	hdr = genlmsg_put(msg, 0, ieee802154_seq_num++,
 35			  &nl802154_family, flags, req);
 36	spin_unlock_irqrestore(&ieee802154_seq_lock, f);
 37	if (!hdr) {
 38		nlmsg_free(msg);
 39		return NULL;
 40	}
 41
 42	return msg;
 43}
 44
 45int ieee802154_nl_mcast(struct sk_buff *msg, unsigned int group)
 46{
 47	struct nlmsghdr *nlh = nlmsg_hdr(msg);
 48	void *hdr = genlmsg_data(nlmsg_data(nlh));
 49
 50	genlmsg_end(msg, hdr);
 51
 52	return genlmsg_multicast(&nl802154_family, msg, 0, group, GFP_ATOMIC);
 53}
 54
 55struct sk_buff *ieee802154_nl_new_reply(struct genl_info *info,
 56					int flags, u8 req)
 57{
 58	void *hdr;
 59	struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
 60
 61	if (!msg)
 62		return NULL;
 63
 64	hdr = genlmsg_put_reply(msg, info,
 65				&nl802154_family, flags, req);
 66	if (!hdr) {
 67		nlmsg_free(msg);
 68		return NULL;
 69	}
 70
 71	return msg;
 72}
 73
 74int ieee802154_nl_reply(struct sk_buff *msg, struct genl_info *info)
 75{
 76	struct nlmsghdr *nlh = nlmsg_hdr(msg);
 77	void *hdr = genlmsg_data(nlmsg_data(nlh));
 78
 79	genlmsg_end(msg, hdr);
 80
 81	return genlmsg_reply(msg, info);
 82}
 83
 84static const struct genl_small_ops ieee802154_ops[] = {
 85	/* see nl-phy.c */
 86	IEEE802154_DUMP(IEEE802154_LIST_PHY, ieee802154_list_phy,
 87			ieee802154_dump_phy),
 88	IEEE802154_OP(IEEE802154_ADD_IFACE, ieee802154_add_iface),
 89	IEEE802154_OP(IEEE802154_DEL_IFACE, ieee802154_del_iface),
 90	/* see nl-mac.c */
 91	IEEE802154_OP(IEEE802154_ASSOCIATE_REQ, ieee802154_associate_req),
 92	IEEE802154_OP(IEEE802154_ASSOCIATE_RESP, ieee802154_associate_resp),
 93	IEEE802154_OP(IEEE802154_DISASSOCIATE_REQ, ieee802154_disassociate_req),
 94	IEEE802154_OP(IEEE802154_SCAN_REQ, ieee802154_scan_req),
 95	IEEE802154_OP(IEEE802154_START_REQ, ieee802154_start_req),
 96	IEEE802154_DUMP(IEEE802154_LIST_IFACE, ieee802154_list_iface,
 97			ieee802154_dump_iface),
 98	IEEE802154_OP(IEEE802154_SET_MACPARAMS, ieee802154_set_macparams),
 99	IEEE802154_OP(IEEE802154_LLSEC_GETPARAMS, ieee802154_llsec_getparams),
100	IEEE802154_OP(IEEE802154_LLSEC_SETPARAMS, ieee802154_llsec_setparams),
101	IEEE802154_DUMP(IEEE802154_LLSEC_LIST_KEY, NULL,
102			ieee802154_llsec_dump_keys),
103	IEEE802154_OP(IEEE802154_LLSEC_ADD_KEY, ieee802154_llsec_add_key),
104	IEEE802154_OP(IEEE802154_LLSEC_DEL_KEY, ieee802154_llsec_del_key),
105	IEEE802154_DUMP(IEEE802154_LLSEC_LIST_DEV, NULL,
106			ieee802154_llsec_dump_devs),
107	IEEE802154_OP(IEEE802154_LLSEC_ADD_DEV, ieee802154_llsec_add_dev),
108	IEEE802154_OP(IEEE802154_LLSEC_DEL_DEV, ieee802154_llsec_del_dev),
109	IEEE802154_DUMP(IEEE802154_LLSEC_LIST_DEVKEY, NULL,
110			ieee802154_llsec_dump_devkeys),
111	IEEE802154_OP(IEEE802154_LLSEC_ADD_DEVKEY, ieee802154_llsec_add_devkey),
112	IEEE802154_OP(IEEE802154_LLSEC_DEL_DEVKEY, ieee802154_llsec_del_devkey),
113	IEEE802154_DUMP(IEEE802154_LLSEC_LIST_SECLEVEL, NULL,
114			ieee802154_llsec_dump_seclevels),
115	IEEE802154_OP(IEEE802154_LLSEC_ADD_SECLEVEL,
116		      ieee802154_llsec_add_seclevel),
117	IEEE802154_OP(IEEE802154_LLSEC_DEL_SECLEVEL,
118		      ieee802154_llsec_del_seclevel),
119};
120
121static const struct genl_multicast_group ieee802154_mcgrps[] = {
122	[IEEE802154_COORD_MCGRP] = { .name = IEEE802154_MCAST_COORD_NAME, },
123	[IEEE802154_BEACON_MCGRP] = { .name = IEEE802154_MCAST_BEACON_NAME, },
124};
125
126struct genl_family nl802154_family __ro_after_init = {
127	.hdrsize	= 0,
128	.name		= IEEE802154_NL_NAME,
129	.version	= 1,
130	.maxattr	= IEEE802154_ATTR_MAX,
131	.policy		= ieee802154_policy,
132	.module		= THIS_MODULE,
133	.small_ops	= ieee802154_ops,
134	.n_small_ops	= ARRAY_SIZE(ieee802154_ops),
135	.resv_start_op	= IEEE802154_LLSEC_DEL_SECLEVEL + 1,
136	.mcgrps		= ieee802154_mcgrps,
137	.n_mcgrps	= ARRAY_SIZE(ieee802154_mcgrps),
138};
139
140int __init ieee802154_nl_init(void)
141{
142	return genl_register_family(&nl802154_family);
143}
144
145void ieee802154_nl_exit(void)
146{
147	genl_unregister_family(&nl802154_family);
148}