1 // SPDX-License-Identifier: GPL-2.0-or-later 1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /* 2 /*
3 * SR-IPv6 implementation 3 * SR-IPv6 implementation
4 * 4 *
5 * Author: 5 * Author:
6 * David Lebrun <david.lebrun@uclouvain.be> 6 * David Lebrun <david.lebrun@uclouvain.be>
7 */ 7 */
8 8
9 #include <linux/errno.h> 9 #include <linux/errno.h>
10 #include <linux/types.h> 10 #include <linux/types.h>
11 #include <linux/socket.h> 11 #include <linux/socket.h>
12 #include <linux/net.h> 12 #include <linux/net.h>
13 #include <linux/in6.h> 13 #include <linux/in6.h>
14 #include <linux/slab.h> 14 #include <linux/slab.h>
15 #include <linux/rhashtable.h> 15 #include <linux/rhashtable.h>
16 16
17 #include <net/ipv6.h> 17 #include <net/ipv6.h>
18 #include <net/protocol.h> 18 #include <net/protocol.h>
19 19
20 #include <net/seg6.h> 20 #include <net/seg6.h>
21 #include <net/genetlink.h> 21 #include <net/genetlink.h>
22 #include <linux/seg6.h> 22 #include <linux/seg6.h>
23 #include <linux/seg6_genl.h> 23 #include <linux/seg6_genl.h>
>> 24 #ifdef CONFIG_IPV6_SEG6_HMAC
24 #include <net/seg6_hmac.h> 25 #include <net/seg6_hmac.h>
>> 26 #endif
25 27
26 bool seg6_validate_srh(struct ipv6_sr_hdr *srh 28 bool seg6_validate_srh(struct ipv6_sr_hdr *srh, int len, bool reduced)
27 { 29 {
28 unsigned int tlv_offset; 30 unsigned int tlv_offset;
29 int max_last_entry; 31 int max_last_entry;
30 int trailing; 32 int trailing;
31 33
32 if (srh->type != IPV6_SRCRT_TYPE_4) 34 if (srh->type != IPV6_SRCRT_TYPE_4)
33 return false; 35 return false;
34 36
35 if (((srh->hdrlen + 1) << 3) != len) 37 if (((srh->hdrlen + 1) << 3) != len)
36 return false; 38 return false;
37 39
38 if (!reduced && srh->segments_left > s 40 if (!reduced && srh->segments_left > srh->first_segment) {
39 return false; 41 return false;
40 } else { 42 } else {
41 max_last_entry = (srh->hdrlen 43 max_last_entry = (srh->hdrlen / 2) - 1;
42 44
43 if (srh->first_segment > max_l 45 if (srh->first_segment > max_last_entry)
44 return false; 46 return false;
45 47
46 if (srh->segments_left > srh-> 48 if (srh->segments_left > srh->first_segment + 1)
47 return false; 49 return false;
48 } 50 }
49 51
50 tlv_offset = sizeof(*srh) + ((srh->fir 52 tlv_offset = sizeof(*srh) + ((srh->first_segment + 1) << 4);
51 53
52 trailing = len - tlv_offset; 54 trailing = len - tlv_offset;
53 if (trailing < 0) 55 if (trailing < 0)
54 return false; 56 return false;
55 57
56 while (trailing) { 58 while (trailing) {
57 struct sr6_tlv *tlv; 59 struct sr6_tlv *tlv;
58 unsigned int tlv_len; 60 unsigned int tlv_len;
59 61
60 if (trailing < sizeof(*tlv)) 62 if (trailing < sizeof(*tlv))
61 return false; 63 return false;
62 64
63 tlv = (struct sr6_tlv *)((unsi 65 tlv = (struct sr6_tlv *)((unsigned char *)srh + tlv_offset);
64 tlv_len = sizeof(*tlv) + tlv-> 66 tlv_len = sizeof(*tlv) + tlv->len;
65 67
66 trailing -= tlv_len; 68 trailing -= tlv_len;
67 if (trailing < 0) 69 if (trailing < 0)
68 return false; 70 return false;
69 71
70 tlv_offset += tlv_len; 72 tlv_offset += tlv_len;
71 } 73 }
72 74
73 return true; 75 return true;
74 } 76 }
75 77
76 struct ipv6_sr_hdr *seg6_get_srh(struct sk_buf 78 struct ipv6_sr_hdr *seg6_get_srh(struct sk_buff *skb, int flags)
77 { 79 {
78 struct ipv6_sr_hdr *srh; 80 struct ipv6_sr_hdr *srh;
79 int len, srhoff = 0; 81 int len, srhoff = 0;
80 82
81 if (ipv6_find_hdr(skb, &srhoff, IPPROT 83 if (ipv6_find_hdr(skb, &srhoff, IPPROTO_ROUTING, NULL, &flags) < 0)
82 return NULL; 84 return NULL;
83 85
84 if (!pskb_may_pull(skb, srhoff + sizeo 86 if (!pskb_may_pull(skb, srhoff + sizeof(*srh)))
85 return NULL; 87 return NULL;
86 88
87 srh = (struct ipv6_sr_hdr *)(skb->data 89 srh = (struct ipv6_sr_hdr *)(skb->data + srhoff);
88 90
89 len = (srh->hdrlen + 1) << 3; 91 len = (srh->hdrlen + 1) << 3;
90 92
91 if (!pskb_may_pull(skb, srhoff + len)) 93 if (!pskb_may_pull(skb, srhoff + len))
92 return NULL; 94 return NULL;
93 95
94 /* note that pskb_may_pull may change 96 /* note that pskb_may_pull may change pointers in header;
95 * for this reason it is necessary to 97 * for this reason it is necessary to reload them when needed.
96 */ 98 */
97 srh = (struct ipv6_sr_hdr *)(skb->data 99 srh = (struct ipv6_sr_hdr *)(skb->data + srhoff);
98 100
99 if (!seg6_validate_srh(srh, len, true) 101 if (!seg6_validate_srh(srh, len, true))
100 return NULL; 102 return NULL;
101 103
102 return srh; 104 return srh;
103 } 105 }
104 106
105 /* Determine if an ICMP invoking packet contai 107 /* Determine if an ICMP invoking packet contains a segment routing
106 * header. If it does, extract the offset to 108 * header. If it does, extract the offset to the true destination
107 * address, which is in the first segment addr 109 * address, which is in the first segment address.
108 */ 110 */
109 void seg6_icmp_srh(struct sk_buff *skb, struct 111 void seg6_icmp_srh(struct sk_buff *skb, struct inet6_skb_parm *opt)
110 { 112 {
111 __u16 network_header = skb->network_he 113 __u16 network_header = skb->network_header;
112 struct ipv6_sr_hdr *srh; 114 struct ipv6_sr_hdr *srh;
113 115
114 /* Update network header to point to t 116 /* Update network header to point to the invoking packet
115 * inside the ICMP packet, so we can u 117 * inside the ICMP packet, so we can use the seg6_get_srh()
116 * helper. 118 * helper.
117 */ 119 */
118 skb_reset_network_header(skb); 120 skb_reset_network_header(skb);
119 121
120 srh = seg6_get_srh(skb, 0); 122 srh = seg6_get_srh(skb, 0);
121 if (!srh) 123 if (!srh)
122 goto out; 124 goto out;
123 125
124 if (srh->type != IPV6_SRCRT_TYPE_4) 126 if (srh->type != IPV6_SRCRT_TYPE_4)
125 goto out; 127 goto out;
126 128
127 opt->flags |= IP6SKB_SEG6; 129 opt->flags |= IP6SKB_SEG6;
128 opt->srhoff = (unsigned char *)srh - s 130 opt->srhoff = (unsigned char *)srh - skb->data;
129 131
130 out: 132 out:
131 /* Restore the network header back to 133 /* Restore the network header back to the ICMP packet */
132 skb->network_header = network_header; 134 skb->network_header = network_header;
133 } 135 }
134 136
135 static struct genl_family seg6_genl_family; 137 static struct genl_family seg6_genl_family;
136 138
137 static const struct nla_policy seg6_genl_polic 139 static const struct nla_policy seg6_genl_policy[SEG6_ATTR_MAX + 1] = {
138 [SEG6_ATTR_DST] 140 [SEG6_ATTR_DST] = { .type = NLA_BINARY,
139 .len = sizeof(struct in6_addr) 141 .len = sizeof(struct in6_addr) },
140 [SEG6_ATTR_DSTLEN] 142 [SEG6_ATTR_DSTLEN] = { .type = NLA_S32, },
141 [SEG6_ATTR_HMACKEYID] = { .t 143 [SEG6_ATTR_HMACKEYID] = { .type = NLA_U32, },
142 [SEG6_ATTR_SECRET] 144 [SEG6_ATTR_SECRET] = { .type = NLA_BINARY, },
143 [SEG6_ATTR_SECRETLEN] = { .t 145 [SEG6_ATTR_SECRETLEN] = { .type = NLA_U8, },
144 [SEG6_ATTR_ALGID] 146 [SEG6_ATTR_ALGID] = { .type = NLA_U8, },
145 [SEG6_ATTR_HMACINFO] = { .t 147 [SEG6_ATTR_HMACINFO] = { .type = NLA_NESTED, },
146 }; 148 };
147 149
148 #ifdef CONFIG_IPV6_SEG6_HMAC 150 #ifdef CONFIG_IPV6_SEG6_HMAC
149 151
150 static int seg6_genl_sethmac(struct sk_buff *s 152 static int seg6_genl_sethmac(struct sk_buff *skb, struct genl_info *info)
151 { 153 {
152 struct net *net = genl_info_net(info); 154 struct net *net = genl_info_net(info);
153 struct seg6_pernet_data *sdata; 155 struct seg6_pernet_data *sdata;
154 struct seg6_hmac_info *hinfo; 156 struct seg6_hmac_info *hinfo;
155 u32 hmackeyid; 157 u32 hmackeyid;
156 char *secret; 158 char *secret;
157 int err = 0; 159 int err = 0;
158 u8 algid; 160 u8 algid;
159 u8 slen; 161 u8 slen;
160 162
161 sdata = seg6_pernet(net); 163 sdata = seg6_pernet(net);
162 164
163 if (!info->attrs[SEG6_ATTR_HMACKEYID] 165 if (!info->attrs[SEG6_ATTR_HMACKEYID] ||
164 !info->attrs[SEG6_ATTR_SECRETLEN] 166 !info->attrs[SEG6_ATTR_SECRETLEN] ||
165 !info->attrs[SEG6_ATTR_ALGID]) 167 !info->attrs[SEG6_ATTR_ALGID])
166 return -EINVAL; 168 return -EINVAL;
167 169
168 hmackeyid = nla_get_u32(info->attrs[SE 170 hmackeyid = nla_get_u32(info->attrs[SEG6_ATTR_HMACKEYID]);
169 slen = nla_get_u8(info->attrs[SEG6_ATT 171 slen = nla_get_u8(info->attrs[SEG6_ATTR_SECRETLEN]);
170 algid = nla_get_u8(info->attrs[SEG6_AT 172 algid = nla_get_u8(info->attrs[SEG6_ATTR_ALGID]);
171 173
172 if (hmackeyid == 0) 174 if (hmackeyid == 0)
173 return -EINVAL; 175 return -EINVAL;
174 176
175 if (slen > SEG6_HMAC_SECRET_LEN) 177 if (slen > SEG6_HMAC_SECRET_LEN)
176 return -EINVAL; 178 return -EINVAL;
177 179
178 mutex_lock(&sdata->lock); 180 mutex_lock(&sdata->lock);
179 hinfo = seg6_hmac_info_lookup(net, hma 181 hinfo = seg6_hmac_info_lookup(net, hmackeyid);
180 182
181 if (!slen) { 183 if (!slen) {
182 err = seg6_hmac_info_del(net, 184 err = seg6_hmac_info_del(net, hmackeyid);
183 185
184 goto out_unlock; 186 goto out_unlock;
185 } 187 }
186 188
187 if (!info->attrs[SEG6_ATTR_SECRET]) { 189 if (!info->attrs[SEG6_ATTR_SECRET]) {
188 err = -EINVAL; 190 err = -EINVAL;
189 goto out_unlock; 191 goto out_unlock;
190 } 192 }
191 193
192 if (slen > nla_len(info->attrs[SEG6_AT <<
193 err = -EINVAL; <<
194 goto out_unlock; <<
195 } <<
196 <<
197 if (hinfo) { 194 if (hinfo) {
198 err = seg6_hmac_info_del(net, 195 err = seg6_hmac_info_del(net, hmackeyid);
199 if (err) 196 if (err)
200 goto out_unlock; 197 goto out_unlock;
201 } 198 }
202 199
203 secret = (char *)nla_data(info->attrs[ 200 secret = (char *)nla_data(info->attrs[SEG6_ATTR_SECRET]);
204 201
205 hinfo = kzalloc(sizeof(*hinfo), GFP_KE 202 hinfo = kzalloc(sizeof(*hinfo), GFP_KERNEL);
206 if (!hinfo) { 203 if (!hinfo) {
207 err = -ENOMEM; 204 err = -ENOMEM;
208 goto out_unlock; 205 goto out_unlock;
209 } 206 }
210 207
211 memcpy(hinfo->secret, secret, slen); 208 memcpy(hinfo->secret, secret, slen);
212 hinfo->slen = slen; 209 hinfo->slen = slen;
213 hinfo->alg_id = algid; 210 hinfo->alg_id = algid;
214 hinfo->hmackeyid = hmackeyid; 211 hinfo->hmackeyid = hmackeyid;
215 212
216 err = seg6_hmac_info_add(net, hmackeyi 213 err = seg6_hmac_info_add(net, hmackeyid, hinfo);
217 if (err) 214 if (err)
218 kfree(hinfo); 215 kfree(hinfo);
219 216
220 out_unlock: 217 out_unlock:
221 mutex_unlock(&sdata->lock); 218 mutex_unlock(&sdata->lock);
222 return err; 219 return err;
223 } 220 }
224 221
225 #else 222 #else
226 223
227 static int seg6_genl_sethmac(struct sk_buff *s 224 static int seg6_genl_sethmac(struct sk_buff *skb, struct genl_info *info)
228 { 225 {
229 return -ENOTSUPP; 226 return -ENOTSUPP;
230 } 227 }
231 228
232 #endif 229 #endif
233 230
234 static int seg6_genl_set_tunsrc(struct sk_buff 231 static int seg6_genl_set_tunsrc(struct sk_buff *skb, struct genl_info *info)
235 { 232 {
236 struct net *net = genl_info_net(info); 233 struct net *net = genl_info_net(info);
237 struct in6_addr *val, *t_old, *t_new; 234 struct in6_addr *val, *t_old, *t_new;
238 struct seg6_pernet_data *sdata; 235 struct seg6_pernet_data *sdata;
239 236
240 sdata = seg6_pernet(net); 237 sdata = seg6_pernet(net);
241 238
242 if (!info->attrs[SEG6_ATTR_DST]) 239 if (!info->attrs[SEG6_ATTR_DST])
243 return -EINVAL; 240 return -EINVAL;
244 241
245 val = nla_data(info->attrs[SEG6_ATTR_D 242 val = nla_data(info->attrs[SEG6_ATTR_DST]);
246 t_new = kmemdup(val, sizeof(*val), GFP 243 t_new = kmemdup(val, sizeof(*val), GFP_KERNEL);
247 if (!t_new) 244 if (!t_new)
248 return -ENOMEM; 245 return -ENOMEM;
249 246
250 mutex_lock(&sdata->lock); 247 mutex_lock(&sdata->lock);
251 248
252 t_old = sdata->tun_src; 249 t_old = sdata->tun_src;
253 rcu_assign_pointer(sdata->tun_src, t_n 250 rcu_assign_pointer(sdata->tun_src, t_new);
254 251
255 mutex_unlock(&sdata->lock); 252 mutex_unlock(&sdata->lock);
256 253
257 synchronize_net(); 254 synchronize_net();
258 kfree(t_old); 255 kfree(t_old);
259 256
260 return 0; 257 return 0;
261 } 258 }
262 259
263 static int seg6_genl_get_tunsrc(struct sk_buff 260 static int seg6_genl_get_tunsrc(struct sk_buff *skb, struct genl_info *info)
264 { 261 {
265 struct net *net = genl_info_net(info); 262 struct net *net = genl_info_net(info);
266 struct in6_addr *tun_src; 263 struct in6_addr *tun_src;
267 struct sk_buff *msg; 264 struct sk_buff *msg;
268 void *hdr; 265 void *hdr;
269 266
270 msg = genlmsg_new(NLMSG_DEFAULT_SIZE, 267 msg = genlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
271 if (!msg) 268 if (!msg)
272 return -ENOMEM; 269 return -ENOMEM;
273 270
274 hdr = genlmsg_put(msg, info->snd_porti 271 hdr = genlmsg_put(msg, info->snd_portid, info->snd_seq,
275 &seg6_genl_family, 0 272 &seg6_genl_family, 0, SEG6_CMD_GET_TUNSRC);
276 if (!hdr) 273 if (!hdr)
277 goto free_msg; 274 goto free_msg;
278 275
279 rcu_read_lock(); 276 rcu_read_lock();
280 tun_src = rcu_dereference(seg6_pernet( 277 tun_src = rcu_dereference(seg6_pernet(net)->tun_src);
281 278
282 if (nla_put(msg, SEG6_ATTR_DST, sizeof 279 if (nla_put(msg, SEG6_ATTR_DST, sizeof(struct in6_addr), tun_src))
283 goto nla_put_failure; 280 goto nla_put_failure;
284 281
285 rcu_read_unlock(); 282 rcu_read_unlock();
286 283
287 genlmsg_end(msg, hdr); 284 genlmsg_end(msg, hdr);
288 return genlmsg_reply(msg, info); 285 return genlmsg_reply(msg, info);
289 286
290 nla_put_failure: 287 nla_put_failure:
291 rcu_read_unlock(); 288 rcu_read_unlock();
292 free_msg: 289 free_msg:
293 nlmsg_free(msg); 290 nlmsg_free(msg);
294 return -ENOMEM; 291 return -ENOMEM;
295 } 292 }
296 293
297 #ifdef CONFIG_IPV6_SEG6_HMAC 294 #ifdef CONFIG_IPV6_SEG6_HMAC
298 295
299 static int __seg6_hmac_fill_info(struct seg6_h 296 static int __seg6_hmac_fill_info(struct seg6_hmac_info *hinfo,
300 struct sk_buf 297 struct sk_buff *msg)
301 { 298 {
302 if (nla_put_u32(msg, SEG6_ATTR_HMACKEY 299 if (nla_put_u32(msg, SEG6_ATTR_HMACKEYID, hinfo->hmackeyid) ||
303 nla_put_u8(msg, SEG6_ATTR_SECRETLE 300 nla_put_u8(msg, SEG6_ATTR_SECRETLEN, hinfo->slen) ||
304 nla_put(msg, SEG6_ATTR_SECRET, hin 301 nla_put(msg, SEG6_ATTR_SECRET, hinfo->slen, hinfo->secret) ||
305 nla_put_u8(msg, SEG6_ATTR_ALGID, h 302 nla_put_u8(msg, SEG6_ATTR_ALGID, hinfo->alg_id))
306 return -1; 303 return -1;
307 304
308 return 0; 305 return 0;
309 } 306 }
310 307
311 static int __seg6_genl_dumphmac_element(struct 308 static int __seg6_genl_dumphmac_element(struct seg6_hmac_info *hinfo,
312 u32 po 309 u32 portid, u32 seq, u32 flags,
313 struct 310 struct sk_buff *skb, u8 cmd)
314 { 311 {
315 void *hdr; 312 void *hdr;
316 313
317 hdr = genlmsg_put(skb, portid, seq, &s 314 hdr = genlmsg_put(skb, portid, seq, &seg6_genl_family, flags, cmd);
318 if (!hdr) 315 if (!hdr)
319 return -ENOMEM; 316 return -ENOMEM;
320 317
321 if (__seg6_hmac_fill_info(hinfo, skb) 318 if (__seg6_hmac_fill_info(hinfo, skb) < 0)
322 goto nla_put_failure; 319 goto nla_put_failure;
323 320
324 genlmsg_end(skb, hdr); 321 genlmsg_end(skb, hdr);
325 return 0; 322 return 0;
326 323
327 nla_put_failure: 324 nla_put_failure:
328 genlmsg_cancel(skb, hdr); 325 genlmsg_cancel(skb, hdr);
329 return -EMSGSIZE; 326 return -EMSGSIZE;
330 } 327 }
331 328
332 static int seg6_genl_dumphmac_start(struct net 329 static int seg6_genl_dumphmac_start(struct netlink_callback *cb)
333 { 330 {
334 struct net *net = sock_net(cb->skb->sk 331 struct net *net = sock_net(cb->skb->sk);
335 struct seg6_pernet_data *sdata; 332 struct seg6_pernet_data *sdata;
336 struct rhashtable_iter *iter; 333 struct rhashtable_iter *iter;
337 334
338 sdata = seg6_pernet(net); 335 sdata = seg6_pernet(net);
339 iter = (struct rhashtable_iter *)cb->a 336 iter = (struct rhashtable_iter *)cb->args[0];
340 337
341 if (!iter) { 338 if (!iter) {
342 iter = kmalloc(sizeof(*iter), 339 iter = kmalloc(sizeof(*iter), GFP_KERNEL);
343 if (!iter) 340 if (!iter)
344 return -ENOMEM; 341 return -ENOMEM;
345 342
346 cb->args[0] = (long)iter; 343 cb->args[0] = (long)iter;
347 } 344 }
348 345
349 rhashtable_walk_enter(&sdata->hmac_inf 346 rhashtable_walk_enter(&sdata->hmac_infos, iter);
350 347
351 return 0; 348 return 0;
352 } 349 }
353 350
354 static int seg6_genl_dumphmac_done(struct netl 351 static int seg6_genl_dumphmac_done(struct netlink_callback *cb)
355 { 352 {
356 struct rhashtable_iter *iter = (struct 353 struct rhashtable_iter *iter = (struct rhashtable_iter *)cb->args[0];
357 354
358 rhashtable_walk_exit(iter); 355 rhashtable_walk_exit(iter);
359 356
360 kfree(iter); 357 kfree(iter);
361 358
362 return 0; 359 return 0;
363 } 360 }
364 361
365 static int seg6_genl_dumphmac(struct sk_buff * 362 static int seg6_genl_dumphmac(struct sk_buff *skb, struct netlink_callback *cb)
366 { 363 {
367 struct rhashtable_iter *iter = (struct 364 struct rhashtable_iter *iter = (struct rhashtable_iter *)cb->args[0];
368 struct seg6_hmac_info *hinfo; 365 struct seg6_hmac_info *hinfo;
369 int ret; 366 int ret;
370 367
371 rhashtable_walk_start(iter); 368 rhashtable_walk_start(iter);
372 369
373 for (;;) { 370 for (;;) {
374 hinfo = rhashtable_walk_next(i 371 hinfo = rhashtable_walk_next(iter);
375 372
376 if (IS_ERR(hinfo)) { 373 if (IS_ERR(hinfo)) {
377 if (PTR_ERR(hinfo) == 374 if (PTR_ERR(hinfo) == -EAGAIN)
378 continue; 375 continue;
379 ret = PTR_ERR(hinfo); 376 ret = PTR_ERR(hinfo);
380 goto done; 377 goto done;
381 } else if (!hinfo) { 378 } else if (!hinfo) {
382 break; 379 break;
383 } 380 }
384 381
385 ret = __seg6_genl_dumphmac_ele 382 ret = __seg6_genl_dumphmac_element(hinfo,
386 383 NETLINK_CB(cb->skb).portid,
387 384 cb->nlh->nlmsg_seq,
388 385 NLM_F_MULTI,
389 386 skb, SEG6_CMD_DUMPHMAC);
390 if (ret) 387 if (ret)
391 goto done; 388 goto done;
392 } 389 }
393 390
394 ret = skb->len; 391 ret = skb->len;
395 392
396 done: 393 done:
397 rhashtable_walk_stop(iter); 394 rhashtable_walk_stop(iter);
398 return ret; 395 return ret;
399 } 396 }
400 397
401 #else 398 #else
402 399
403 static int seg6_genl_dumphmac_start(struct net 400 static int seg6_genl_dumphmac_start(struct netlink_callback *cb)
404 { 401 {
405 return 0; 402 return 0;
406 } 403 }
407 404
408 static int seg6_genl_dumphmac_done(struct netl 405 static int seg6_genl_dumphmac_done(struct netlink_callback *cb)
409 { 406 {
410 return 0; 407 return 0;
411 } 408 }
412 409
413 static int seg6_genl_dumphmac(struct sk_buff * 410 static int seg6_genl_dumphmac(struct sk_buff *skb, struct netlink_callback *cb)
414 { 411 {
415 return -ENOTSUPP; 412 return -ENOTSUPP;
416 } 413 }
417 414
418 #endif 415 #endif
419 416
420 static int __net_init seg6_net_init(struct net 417 static int __net_init seg6_net_init(struct net *net)
421 { 418 {
422 struct seg6_pernet_data *sdata; 419 struct seg6_pernet_data *sdata;
423 420
424 sdata = kzalloc(sizeof(*sdata), GFP_KE 421 sdata = kzalloc(sizeof(*sdata), GFP_KERNEL);
425 if (!sdata) 422 if (!sdata)
426 return -ENOMEM; 423 return -ENOMEM;
427 424
428 mutex_init(&sdata->lock); 425 mutex_init(&sdata->lock);
429 426
430 sdata->tun_src = kzalloc(sizeof(*sdata 427 sdata->tun_src = kzalloc(sizeof(*sdata->tun_src), GFP_KERNEL);
431 if (!sdata->tun_src) { 428 if (!sdata->tun_src) {
432 kfree(sdata); 429 kfree(sdata);
433 return -ENOMEM; 430 return -ENOMEM;
434 } 431 }
435 432
436 net->ipv6.seg6_data = sdata; 433 net->ipv6.seg6_data = sdata;
437 434
>> 435 #ifdef CONFIG_IPV6_SEG6_HMAC
438 if (seg6_hmac_net_init(net)) { 436 if (seg6_hmac_net_init(net)) {
439 kfree(rcu_dereference_raw(sdat 437 kfree(rcu_dereference_raw(sdata->tun_src));
440 kfree(sdata); 438 kfree(sdata);
441 return -ENOMEM; 439 return -ENOMEM;
442 } 440 }
>> 441 #endif
443 442
444 return 0; 443 return 0;
445 } 444 }
446 445
447 static void __net_exit seg6_net_exit(struct ne 446 static void __net_exit seg6_net_exit(struct net *net)
448 { 447 {
449 struct seg6_pernet_data *sdata = seg6_ 448 struct seg6_pernet_data *sdata = seg6_pernet(net);
450 449
>> 450 #ifdef CONFIG_IPV6_SEG6_HMAC
451 seg6_hmac_net_exit(net); 451 seg6_hmac_net_exit(net);
>> 452 #endif
452 453
453 kfree(rcu_dereference_raw(sdata->tun_s 454 kfree(rcu_dereference_raw(sdata->tun_src));
454 kfree(sdata); 455 kfree(sdata);
455 } 456 }
456 457
457 static struct pernet_operations ip6_segments_o 458 static struct pernet_operations ip6_segments_ops = {
458 .init = seg6_net_init, 459 .init = seg6_net_init,
459 .exit = seg6_net_exit, 460 .exit = seg6_net_exit,
460 }; 461 };
461 462
462 static const struct genl_ops seg6_genl_ops[] = 463 static const struct genl_ops seg6_genl_ops[] = {
463 { 464 {
464 .cmd = SEG6_CMD_SETHMAC, 465 .cmd = SEG6_CMD_SETHMAC,
465 .validate = GENL_DONT_VALIDATE 466 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
466 .doit = seg6_genl_sethmac, 467 .doit = seg6_genl_sethmac,
467 .flags = GENL_ADMIN_PERM, 468 .flags = GENL_ADMIN_PERM,
468 }, 469 },
469 { 470 {
470 .cmd = SEG6_CMD_DUMPHMAC, 471 .cmd = SEG6_CMD_DUMPHMAC,
471 .validate = GENL_DONT_VALIDATE 472 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
472 .start = seg6_genl_dumphmac_s 473 .start = seg6_genl_dumphmac_start,
473 .dumpit = seg6_genl_dumphmac, 474 .dumpit = seg6_genl_dumphmac,
474 .done = seg6_genl_dumphmac_d 475 .done = seg6_genl_dumphmac_done,
475 .flags = GENL_ADMIN_PERM, 476 .flags = GENL_ADMIN_PERM,
476 }, 477 },
477 { 478 {
478 .cmd = SEG6_CMD_SET_TUNSRC, 479 .cmd = SEG6_CMD_SET_TUNSRC,
479 .validate = GENL_DONT_VALIDATE 480 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
480 .doit = seg6_genl_set_tunsrc 481 .doit = seg6_genl_set_tunsrc,
481 .flags = GENL_ADMIN_PERM, 482 .flags = GENL_ADMIN_PERM,
482 }, 483 },
483 { 484 {
484 .cmd = SEG6_CMD_GET_TUNSRC, 485 .cmd = SEG6_CMD_GET_TUNSRC,
485 .validate = GENL_DONT_VALIDATE 486 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
486 .doit = seg6_genl_get_tunsrc 487 .doit = seg6_genl_get_tunsrc,
487 .flags = GENL_ADMIN_PERM, 488 .flags = GENL_ADMIN_PERM,
488 }, 489 },
489 }; 490 };
490 491
491 static struct genl_family seg6_genl_family __r 492 static struct genl_family seg6_genl_family __ro_after_init = {
492 .hdrsize = 0, 493 .hdrsize = 0,
493 .name = SEG6_GENL_NAME, 494 .name = SEG6_GENL_NAME,
494 .version = SEG6_GENL_VERSION, 495 .version = SEG6_GENL_VERSION,
495 .maxattr = SEG6_ATTR_MAX, 496 .maxattr = SEG6_ATTR_MAX,
496 .policy = seg6_genl_policy, 497 .policy = seg6_genl_policy,
497 .netnsok = true, 498 .netnsok = true,
498 .parallel_ops = true, 499 .parallel_ops = true,
499 .ops = seg6_genl_ops, 500 .ops = seg6_genl_ops,
500 .n_ops = ARRAY_SIZE(seg6_genl 501 .n_ops = ARRAY_SIZE(seg6_genl_ops),
501 .resv_start_op = SEG6_CMD_GET_TUNSRC <<
502 .module = THIS_MODULE, 502 .module = THIS_MODULE,
503 }; 503 };
504 504
505 int __init seg6_init(void) 505 int __init seg6_init(void)
506 { 506 {
507 int err; 507 int err;
508 508
509 err = register_pernet_subsys(&ip6_segm !! 509 err = genl_register_family(&seg6_genl_family);
510 if (err) 510 if (err)
511 goto out; 511 goto out;
512 512
513 err = genl_register_family(&seg6_genl_ !! 513 err = register_pernet_subsys(&ip6_segments_ops);
514 if (err) 514 if (err)
515 goto out_unregister_pernet; !! 515 goto out_unregister_genl;
516 516
>> 517 #ifdef CONFIG_IPV6_SEG6_LWTUNNEL
517 err = seg6_iptunnel_init(); 518 err = seg6_iptunnel_init();
518 if (err) 519 if (err)
519 goto out_unregister_genl; !! 520 goto out_unregister_pernet;
520 521
521 err = seg6_local_init(); 522 err = seg6_local_init();
522 if (err) 523 if (err)
523 goto out_unregister_iptun; !! 524 goto out_unregister_pernet;
>> 525 #endif
524 526
>> 527 #ifdef CONFIG_IPV6_SEG6_HMAC
525 err = seg6_hmac_init(); 528 err = seg6_hmac_init();
526 if (err) 529 if (err)
527 goto out_unregister_seg6; !! 530 goto out_unregister_iptun;
>> 531 #endif
528 532
529 pr_info("Segment Routing with IPv6\n") 533 pr_info("Segment Routing with IPv6\n");
530 534
531 out: 535 out:
532 return err; 536 return err;
533 out_unregister_seg6: !! 537 #ifdef CONFIG_IPV6_SEG6_HMAC
534 seg6_local_exit(); <<
535 out_unregister_iptun: 538 out_unregister_iptun:
>> 539 #ifdef CONFIG_IPV6_SEG6_LWTUNNEL
>> 540 seg6_local_exit();
536 seg6_iptunnel_exit(); 541 seg6_iptunnel_exit();
537 out_unregister_genl: !! 542 #endif
538 genl_unregister_family(&seg6_genl_fami !! 543 #endif
>> 544 #ifdef CONFIG_IPV6_SEG6_LWTUNNEL
539 out_unregister_pernet: 545 out_unregister_pernet:
540 unregister_pernet_subsys(&ip6_segments 546 unregister_pernet_subsys(&ip6_segments_ops);
>> 547 #endif
>> 548 out_unregister_genl:
>> 549 genl_unregister_family(&seg6_genl_family);
541 goto out; 550 goto out;
542 } 551 }
543 552
544 void seg6_exit(void) 553 void seg6_exit(void)
545 { 554 {
>> 555 #ifdef CONFIG_IPV6_SEG6_HMAC
546 seg6_hmac_exit(); 556 seg6_hmac_exit();
547 seg6_local_exit(); !! 557 #endif
>> 558 #ifdef CONFIG_IPV6_SEG6_LWTUNNEL
548 seg6_iptunnel_exit(); 559 seg6_iptunnel_exit();
549 genl_unregister_family(&seg6_genl_fami !! 560 #endif
550 unregister_pernet_subsys(&ip6_segments 561 unregister_pernet_subsys(&ip6_segments_ops);
>> 562 genl_unregister_family(&seg6_genl_family);
551 } 563 }
552 564
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.