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