1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37#include "core.h"
38#include "config.h"
39#include <net/genetlink.h>
40
41static int handle_cmd(struct sk_buff *skb, struct genl_info *info)
42{
43 struct sk_buff *rep_buf;
44 struct nlmsghdr *rep_nlh;
45 struct nlmsghdr *req_nlh = info->nlhdr;
46 struct tipc_genlmsghdr *req_userhdr = info->userhdr;
47 int hdr_space = NLMSG_SPACE(GENL_HDRLEN + TIPC_GENL_HDRLEN);
48 u16 cmd;
49
50 if ((req_userhdr->cmd & 0xC000) && (!capable(CAP_NET_ADMIN)))
51 cmd = TIPC_CMD_NOT_NET_ADMIN;
52 else
53 cmd = req_userhdr->cmd;
54
55 rep_buf = tipc_cfg_do_cmd(req_userhdr->dest, cmd,
56 NLMSG_DATA(req_nlh) + GENL_HDRLEN + TIPC_GENL_HDRLEN,
57 NLMSG_PAYLOAD(req_nlh, GENL_HDRLEN + TIPC_GENL_HDRLEN),
58 hdr_space);
59
60 if (rep_buf) {
61 skb_push(rep_buf, hdr_space);
62 rep_nlh = nlmsg_hdr(rep_buf);
63 memcpy(rep_nlh, req_nlh, hdr_space);
64 rep_nlh->nlmsg_len = rep_buf->len;
65 genlmsg_unicast(rep_buf, NETLINK_CB(skb).pid);
66 }
67
68 return 0;
69}
70
71static struct genl_family family = {
72 .id = GENL_ID_GENERATE,
73 .name = TIPC_GENL_NAME,
74 .version = TIPC_GENL_VERSION,
75 .hdrsize = TIPC_GENL_HDRLEN,
76 .maxattr = 0,
77};
78
79static struct genl_ops ops = {
80 .cmd = TIPC_GENL_CMD,
81 .doit = handle_cmd,
82};
83
84static int family_registered = 0;
85
86int tipc_netlink_start(void)
87{
88
89
90 if (genl_register_family(&family))
91 goto err;
92
93 family_registered = 1;
94
95 if (genl_register_ops(&family, &ops))
96 goto err_unregister;
97
98 return 0;
99
100 err_unregister:
101 genl_unregister_family(&family);
102 family_registered = 0;
103 err:
104 err("Failed to register netlink interface\n");
105 return -EFAULT;
106}
107
108void tipc_netlink_stop(void)
109{
110 if (family_registered) {
111 genl_unregister_family(&family);
112 family_registered = 0;
113 }
114}
115