1 /* xfrm_user.c: User interface to configure xfrm engine.
3 * Copyright (C) 2002 David S. Miller (davem@redhat.com)
7 * Kazunori MIYAZAWA @USAGI
8 * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
13 #include <linux/crypto.h>
14 #include <linux/module.h>
15 #include <linux/kernel.h>
16 #include <linux/types.h>
17 #include <linux/slab.h>
18 #include <linux/socket.h>
19 #include <linux/string.h>
20 #include <linux/net.h>
21 #include <linux/skbuff.h>
22 #include <linux/rtnetlink.h>
23 #include <linux/pfkeyv2.h>
24 #include <linux/ipsec.h>
25 #include <linux/init.h>
26 #include <linux/security.h>
29 #include <net/netlink.h>
30 #include <asm/uaccess.h>
31 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
32 #include <linux/in6.h>
35 static int verify_one_alg(struct rtattr
**xfrma
, enum xfrm_attr_type_t type
)
37 struct rtattr
*rt
= xfrma
[type
- 1];
38 struct xfrm_algo
*algp
;
44 len
= (rt
->rta_len
- sizeof(*rt
)) - sizeof(*algp
);
50 len
-= (algp
->alg_key_len
+ 7U) / 8;
56 if (!algp
->alg_key_len
&&
57 strcmp(algp
->alg_name
, "digest_null") != 0)
62 if (!algp
->alg_key_len
&&
63 strcmp(algp
->alg_name
, "cipher_null") != 0)
68 /* Zero length keys are legal. */
75 algp
->alg_name
[CRYPTO_MAX_ALG_NAME
- 1] = '\0';
79 static int verify_encap_tmpl(struct rtattr
**xfrma
)
81 struct rtattr
*rt
= xfrma
[XFRMA_ENCAP
- 1];
82 struct xfrm_encap_tmpl
*encap
;
87 if ((rt
->rta_len
- sizeof(*rt
)) < sizeof(*encap
))
93 static int verify_one_addr(struct rtattr
**xfrma
, enum xfrm_attr_type_t type
,
94 xfrm_address_t
**addrp
)
96 struct rtattr
*rt
= xfrma
[type
- 1];
101 if ((rt
->rta_len
- sizeof(*rt
)) < sizeof(**addrp
))
105 *addrp
= RTA_DATA(rt
);
110 static inline int verify_sec_ctx_len(struct rtattr
**xfrma
)
112 struct rtattr
*rt
= xfrma
[XFRMA_SEC_CTX
- 1];
113 struct xfrm_user_sec_ctx
*uctx
;
119 if (rt
->rta_len
< sizeof(*uctx
))
124 len
+= sizeof(struct xfrm_user_sec_ctx
);
125 len
+= uctx
->ctx_len
;
127 if (uctx
->len
!= len
)
134 static int verify_newsa_info(struct xfrm_usersa_info
*p
,
135 struct rtattr
**xfrma
)
145 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
157 switch (p
->id
.proto
) {
159 if (!xfrma
[XFRMA_ALG_AUTH
-1] ||
160 xfrma
[XFRMA_ALG_CRYPT
-1] ||
161 xfrma
[XFRMA_ALG_COMP
-1])
166 if ((!xfrma
[XFRMA_ALG_AUTH
-1] &&
167 !xfrma
[XFRMA_ALG_CRYPT
-1]) ||
168 xfrma
[XFRMA_ALG_COMP
-1])
173 if (!xfrma
[XFRMA_ALG_COMP
-1] ||
174 xfrma
[XFRMA_ALG_AUTH
-1] ||
175 xfrma
[XFRMA_ALG_CRYPT
-1])
179 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
180 case IPPROTO_DSTOPTS
:
181 case IPPROTO_ROUTING
:
182 if (xfrma
[XFRMA_ALG_COMP
-1] ||
183 xfrma
[XFRMA_ALG_AUTH
-1] ||
184 xfrma
[XFRMA_ALG_CRYPT
-1] ||
185 xfrma
[XFRMA_ENCAP
-1] ||
186 xfrma
[XFRMA_SEC_CTX
-1] ||
187 !xfrma
[XFRMA_COADDR
-1])
196 if ((err
= verify_one_alg(xfrma
, XFRMA_ALG_AUTH
)))
198 if ((err
= verify_one_alg(xfrma
, XFRMA_ALG_CRYPT
)))
200 if ((err
= verify_one_alg(xfrma
, XFRMA_ALG_COMP
)))
202 if ((err
= verify_encap_tmpl(xfrma
)))
204 if ((err
= verify_sec_ctx_len(xfrma
)))
206 if ((err
= verify_one_addr(xfrma
, XFRMA_COADDR
, NULL
)))
211 case XFRM_MODE_TRANSPORT
:
212 case XFRM_MODE_TUNNEL
:
213 case XFRM_MODE_ROUTEOPTIMIZATION
:
227 static int attach_one_algo(struct xfrm_algo
**algpp
, u8
*props
,
228 struct xfrm_algo_desc
*(*get_byname
)(char *, int),
229 struct rtattr
*u_arg
)
231 struct rtattr
*rta
= u_arg
;
232 struct xfrm_algo
*p
, *ualg
;
233 struct xfrm_algo_desc
*algo
;
239 ualg
= RTA_DATA(rta
);
241 algo
= get_byname(ualg
->alg_name
, 1);
244 *props
= algo
->desc
.sadb_alg_id
;
246 len
= sizeof(*ualg
) + (ualg
->alg_key_len
+ 7U) / 8;
247 p
= kmalloc(len
, GFP_KERNEL
);
251 memcpy(p
, ualg
, len
);
252 strcpy(p
->alg_name
, algo
->name
);
257 static int attach_encap_tmpl(struct xfrm_encap_tmpl
**encapp
, struct rtattr
*u_arg
)
259 struct rtattr
*rta
= u_arg
;
260 struct xfrm_encap_tmpl
*p
, *uencap
;
265 uencap
= RTA_DATA(rta
);
266 p
= kmalloc(sizeof(*p
), GFP_KERNEL
);
270 memcpy(p
, uencap
, sizeof(*p
));
276 static inline int xfrm_user_sec_ctx_size(struct xfrm_policy
*xp
)
278 struct xfrm_sec_ctx
*xfrm_ctx
= xp
->security
;
282 len
+= sizeof(struct xfrm_user_sec_ctx
);
283 len
+= xfrm_ctx
->ctx_len
;
288 static int attach_sec_ctx(struct xfrm_state
*x
, struct rtattr
*u_arg
)
290 struct xfrm_user_sec_ctx
*uctx
;
295 uctx
= RTA_DATA(u_arg
);
296 return security_xfrm_state_alloc(x
, uctx
);
299 static int attach_one_addr(xfrm_address_t
**addrpp
, struct rtattr
*u_arg
)
301 struct rtattr
*rta
= u_arg
;
302 xfrm_address_t
*p
, *uaddrp
;
307 uaddrp
= RTA_DATA(rta
);
308 p
= kmalloc(sizeof(*p
), GFP_KERNEL
);
312 memcpy(p
, uaddrp
, sizeof(*p
));
317 static void copy_from_user_state(struct xfrm_state
*x
, struct xfrm_usersa_info
*p
)
319 memcpy(&x
->id
, &p
->id
, sizeof(x
->id
));
320 memcpy(&x
->sel
, &p
->sel
, sizeof(x
->sel
));
321 memcpy(&x
->lft
, &p
->lft
, sizeof(x
->lft
));
322 x
->props
.mode
= p
->mode
;
323 x
->props
.replay_window
= p
->replay_window
;
324 x
->props
.reqid
= p
->reqid
;
325 x
->props
.family
= p
->family
;
326 x
->props
.saddr
= p
->saddr
;
327 x
->props
.flags
= p
->flags
;
331 * someday when pfkey also has support, we could have the code
332 * somehow made shareable and move it to xfrm_state.c - JHS
335 static int xfrm_update_ae_params(struct xfrm_state
*x
, struct rtattr
**xfrma
)
338 struct rtattr
*rp
= xfrma
[XFRMA_REPLAY_VAL
-1];
339 struct rtattr
*lt
= xfrma
[XFRMA_LTIME_VAL
-1];
340 struct rtattr
*et
= xfrma
[XFRMA_ETIMER_THRESH
-1];
341 struct rtattr
*rt
= xfrma
[XFRMA_REPLAY_THRESH
-1];
344 struct xfrm_replay_state
*replay
;
345 if (RTA_PAYLOAD(rp
) < sizeof(*replay
))
347 replay
= RTA_DATA(rp
);
348 memcpy(&x
->replay
, replay
, sizeof(*replay
));
349 memcpy(&x
->preplay
, replay
, sizeof(*replay
));
353 struct xfrm_lifetime_cur
*ltime
;
354 if (RTA_PAYLOAD(lt
) < sizeof(*ltime
))
356 ltime
= RTA_DATA(lt
);
357 x
->curlft
.bytes
= ltime
->bytes
;
358 x
->curlft
.packets
= ltime
->packets
;
359 x
->curlft
.add_time
= ltime
->add_time
;
360 x
->curlft
.use_time
= ltime
->use_time
;
364 if (RTA_PAYLOAD(et
) < sizeof(u32
))
366 x
->replay_maxage
= *(u32
*)RTA_DATA(et
);
370 if (RTA_PAYLOAD(rt
) < sizeof(u32
))
372 x
->replay_maxdiff
= *(u32
*)RTA_DATA(rt
);
380 static struct xfrm_state
*xfrm_state_construct(struct xfrm_usersa_info
*p
,
381 struct rtattr
**xfrma
,
384 struct xfrm_state
*x
= xfrm_state_alloc();
390 copy_from_user_state(x
, p
);
392 if ((err
= attach_one_algo(&x
->aalg
, &x
->props
.aalgo
,
393 xfrm_aalg_get_byname
,
394 xfrma
[XFRMA_ALG_AUTH
-1])))
396 if ((err
= attach_one_algo(&x
->ealg
, &x
->props
.ealgo
,
397 xfrm_ealg_get_byname
,
398 xfrma
[XFRMA_ALG_CRYPT
-1])))
400 if ((err
= attach_one_algo(&x
->calg
, &x
->props
.calgo
,
401 xfrm_calg_get_byname
,
402 xfrma
[XFRMA_ALG_COMP
-1])))
404 if ((err
= attach_encap_tmpl(&x
->encap
, xfrma
[XFRMA_ENCAP
-1])))
406 if ((err
= attach_one_addr(&x
->coaddr
, xfrma
[XFRMA_COADDR
-1])))
408 err
= xfrm_init_state(x
);
412 if ((err
= attach_sec_ctx(x
, xfrma
[XFRMA_SEC_CTX
-1])))
416 x
->replay_maxdiff
= sysctl_xfrm_aevent_rseqth
;
417 /* sysctl_xfrm_aevent_etime is in 100ms units */
418 x
->replay_maxage
= (sysctl_xfrm_aevent_etime
*HZ
)/XFRM_AE_ETH_M
;
419 x
->preplay
.bitmap
= 0;
420 x
->preplay
.seq
= x
->replay
.seq
+x
->replay_maxdiff
;
421 x
->preplay
.oseq
= x
->replay
.oseq
+x
->replay_maxdiff
;
423 /* override default values from above */
425 err
= xfrm_update_ae_params(x
, (struct rtattr
**)xfrma
);
432 x
->km
.state
= XFRM_STATE_DEAD
;
439 static int xfrm_add_sa(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
441 struct xfrm_usersa_info
*p
= NLMSG_DATA(nlh
);
442 struct xfrm_state
*x
;
446 err
= verify_newsa_info(p
, (struct rtattr
**)xfrma
);
450 x
= xfrm_state_construct(p
, (struct rtattr
**)xfrma
, &err
);
455 if (nlh
->nlmsg_type
== XFRM_MSG_NEWSA
)
456 err
= xfrm_state_add(x
);
458 err
= xfrm_state_update(x
);
461 x
->km
.state
= XFRM_STATE_DEAD
;
466 c
.seq
= nlh
->nlmsg_seq
;
467 c
.pid
= nlh
->nlmsg_pid
;
468 c
.event
= nlh
->nlmsg_type
;
470 km_state_notify(x
, &c
);
476 static struct xfrm_state
*xfrm_user_state_lookup(struct xfrm_usersa_id
*p
,
477 struct rtattr
**xfrma
,
480 struct xfrm_state
*x
= NULL
;
483 if (xfrm_id_proto_match(p
->proto
, IPSEC_PROTO_ANY
)) {
485 x
= xfrm_state_lookup(&p
->daddr
, p
->spi
, p
->proto
, p
->family
);
487 xfrm_address_t
*saddr
= NULL
;
489 err
= verify_one_addr(xfrma
, XFRMA_SRCADDR
, &saddr
);
498 x
= xfrm_state_lookup_byaddr(&p
->daddr
, saddr
, p
->proto
,
508 static int xfrm_del_sa(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
510 struct xfrm_state
*x
;
513 struct xfrm_usersa_id
*p
= NLMSG_DATA(nlh
);
515 x
= xfrm_user_state_lookup(p
, (struct rtattr
**)xfrma
, &err
);
519 if ((err
= security_xfrm_state_delete(x
)) != 0)
522 if (xfrm_state_kern(x
)) {
527 err
= xfrm_state_delete(x
);
531 c
.seq
= nlh
->nlmsg_seq
;
532 c
.pid
= nlh
->nlmsg_pid
;
533 c
.event
= nlh
->nlmsg_type
;
534 km_state_notify(x
, &c
);
541 static void copy_to_user_state(struct xfrm_state
*x
, struct xfrm_usersa_info
*p
)
543 memcpy(&p
->id
, &x
->id
, sizeof(p
->id
));
544 memcpy(&p
->sel
, &x
->sel
, sizeof(p
->sel
));
545 memcpy(&p
->lft
, &x
->lft
, sizeof(p
->lft
));
546 memcpy(&p
->curlft
, &x
->curlft
, sizeof(p
->curlft
));
547 memcpy(&p
->stats
, &x
->stats
, sizeof(p
->stats
));
548 p
->saddr
= x
->props
.saddr
;
549 p
->mode
= x
->props
.mode
;
550 p
->replay_window
= x
->props
.replay_window
;
551 p
->reqid
= x
->props
.reqid
;
552 p
->family
= x
->props
.family
;
553 p
->flags
= x
->props
.flags
;
557 struct xfrm_dump_info
{
558 struct sk_buff
*in_skb
;
559 struct sk_buff
*out_skb
;
566 static int dump_one_state(struct xfrm_state
*x
, int count
, void *ptr
)
568 struct xfrm_dump_info
*sp
= ptr
;
569 struct sk_buff
*in_skb
= sp
->in_skb
;
570 struct sk_buff
*skb
= sp
->out_skb
;
571 struct xfrm_usersa_info
*p
;
572 struct nlmsghdr
*nlh
;
573 unsigned char *b
= skb
->tail
;
575 if (sp
->this_idx
< sp
->start_idx
)
578 nlh
= NLMSG_PUT(skb
, NETLINK_CB(in_skb
).pid
,
580 XFRM_MSG_NEWSA
, sizeof(*p
));
581 nlh
->nlmsg_flags
= sp
->nlmsg_flags
;
584 copy_to_user_state(x
, p
);
587 RTA_PUT(skb
, XFRMA_ALG_AUTH
,
588 sizeof(*(x
->aalg
))+(x
->aalg
->alg_key_len
+7)/8, x
->aalg
);
590 RTA_PUT(skb
, XFRMA_ALG_CRYPT
,
591 sizeof(*(x
->ealg
))+(x
->ealg
->alg_key_len
+7)/8, x
->ealg
);
593 RTA_PUT(skb
, XFRMA_ALG_COMP
, sizeof(*(x
->calg
)), x
->calg
);
596 RTA_PUT(skb
, XFRMA_ENCAP
, sizeof(*x
->encap
), x
->encap
);
599 int ctx_size
= sizeof(struct xfrm_sec_ctx
) +
600 x
->security
->ctx_len
;
601 struct rtattr
*rt
= __RTA_PUT(skb
, XFRMA_SEC_CTX
, ctx_size
);
602 struct xfrm_user_sec_ctx
*uctx
= RTA_DATA(rt
);
604 uctx
->exttype
= XFRMA_SEC_CTX
;
605 uctx
->len
= ctx_size
;
606 uctx
->ctx_doi
= x
->security
->ctx_doi
;
607 uctx
->ctx_alg
= x
->security
->ctx_alg
;
608 uctx
->ctx_len
= x
->security
->ctx_len
;
609 memcpy(uctx
+ 1, x
->security
->ctx_str
, x
->security
->ctx_len
);
613 RTA_PUT(skb
, XFRMA_COADDR
, sizeof(*x
->coaddr
), x
->coaddr
);
616 RTA_PUT(skb
, XFRMA_LASTUSED
, sizeof(x
->lastused
), &x
->lastused
);
618 nlh
->nlmsg_len
= skb
->tail
- b
;
625 skb_trim(skb
, b
- skb
->data
);
629 static int xfrm_dump_sa(struct sk_buff
*skb
, struct netlink_callback
*cb
)
631 struct xfrm_dump_info info
;
633 info
.in_skb
= cb
->skb
;
635 info
.nlmsg_seq
= cb
->nlh
->nlmsg_seq
;
636 info
.nlmsg_flags
= NLM_F_MULTI
;
638 info
.start_idx
= cb
->args
[0];
639 (void) xfrm_state_walk(0, dump_one_state
, &info
);
640 cb
->args
[0] = info
.this_idx
;
645 static struct sk_buff
*xfrm_state_netlink(struct sk_buff
*in_skb
,
646 struct xfrm_state
*x
, u32 seq
)
648 struct xfrm_dump_info info
;
651 skb
= alloc_skb(NLMSG_GOODSIZE
, GFP_ATOMIC
);
653 return ERR_PTR(-ENOMEM
);
655 NETLINK_CB(skb
).dst_pid
= NETLINK_CB(in_skb
).pid
;
656 info
.in_skb
= in_skb
;
658 info
.nlmsg_seq
= seq
;
659 info
.nlmsg_flags
= 0;
660 info
.this_idx
= info
.start_idx
= 0;
662 if (dump_one_state(x
, 0, &info
)) {
670 static int xfrm_get_sa(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
672 struct xfrm_usersa_id
*p
= NLMSG_DATA(nlh
);
673 struct xfrm_state
*x
;
674 struct sk_buff
*resp_skb
;
677 x
= xfrm_user_state_lookup(p
, (struct rtattr
**)xfrma
, &err
);
681 resp_skb
= xfrm_state_netlink(skb
, x
, nlh
->nlmsg_seq
);
682 if (IS_ERR(resp_skb
)) {
683 err
= PTR_ERR(resp_skb
);
685 err
= netlink_unicast(xfrm_nl
, resp_skb
,
686 NETLINK_CB(skb
).pid
, MSG_DONTWAIT
);
693 static int verify_userspi_info(struct xfrm_userspi_info
*p
)
695 switch (p
->info
.id
.proto
) {
701 /* IPCOMP spi is 16-bits. */
702 if (p
->max
>= 0x10000)
716 static int xfrm_alloc_userspi(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
718 struct xfrm_state
*x
;
719 struct xfrm_userspi_info
*p
;
720 struct sk_buff
*resp_skb
;
721 xfrm_address_t
*daddr
;
726 err
= verify_userspi_info(p
);
730 family
= p
->info
.family
;
731 daddr
= &p
->info
.id
.daddr
;
735 x
= xfrm_find_acq_byseq(p
->info
.seq
);
736 if (x
&& xfrm_addr_cmp(&x
->id
.daddr
, daddr
, family
)) {
743 x
= xfrm_find_acq(p
->info
.mode
, p
->info
.reqid
,
744 p
->info
.id
.proto
, daddr
,
751 resp_skb
= ERR_PTR(-ENOENT
);
753 spin_lock_bh(&x
->lock
);
754 if (x
->km
.state
!= XFRM_STATE_DEAD
) {
755 xfrm_alloc_spi(x
, htonl(p
->min
), htonl(p
->max
));
757 resp_skb
= xfrm_state_netlink(skb
, x
, nlh
->nlmsg_seq
);
759 spin_unlock_bh(&x
->lock
);
761 if (IS_ERR(resp_skb
)) {
762 err
= PTR_ERR(resp_skb
);
766 err
= netlink_unicast(xfrm_nl
, resp_skb
,
767 NETLINK_CB(skb
).pid
, MSG_DONTWAIT
);
775 static int verify_policy_dir(__u8 dir
)
779 case XFRM_POLICY_OUT
:
780 case XFRM_POLICY_FWD
:
790 static int verify_policy_type(__u8 type
)
793 case XFRM_POLICY_TYPE_MAIN
:
794 #ifdef CONFIG_XFRM_SUB_POLICY
795 case XFRM_POLICY_TYPE_SUB
:
806 static int verify_newpolicy_info(struct xfrm_userpolicy_info
*p
)
810 case XFRM_SHARE_SESSION
:
811 case XFRM_SHARE_USER
:
812 case XFRM_SHARE_UNIQUE
:
820 case XFRM_POLICY_ALLOW
:
821 case XFRM_POLICY_BLOCK
:
828 switch (p
->sel
.family
) {
833 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
836 return -EAFNOSUPPORT
;
843 return verify_policy_dir(p
->dir
);
846 static int copy_from_user_sec_ctx(struct xfrm_policy
*pol
, struct rtattr
**xfrma
)
848 struct rtattr
*rt
= xfrma
[XFRMA_SEC_CTX
-1];
849 struct xfrm_user_sec_ctx
*uctx
;
855 return security_xfrm_policy_alloc(pol
, uctx
);
858 static void copy_templates(struct xfrm_policy
*xp
, struct xfrm_user_tmpl
*ut
,
864 for (i
= 0; i
< nr
; i
++, ut
++) {
865 struct xfrm_tmpl
*t
= &xp
->xfrm_vec
[i
];
867 memcpy(&t
->id
, &ut
->id
, sizeof(struct xfrm_id
));
868 memcpy(&t
->saddr
, &ut
->saddr
,
869 sizeof(xfrm_address_t
));
870 t
->reqid
= ut
->reqid
;
872 t
->share
= ut
->share
;
873 t
->optional
= ut
->optional
;
874 t
->aalgos
= ut
->aalgos
;
875 t
->ealgos
= ut
->ealgos
;
876 t
->calgos
= ut
->calgos
;
880 static int copy_from_user_tmpl(struct xfrm_policy
*pol
, struct rtattr
**xfrma
)
882 struct rtattr
*rt
= xfrma
[XFRMA_TMPL
-1];
883 struct xfrm_user_tmpl
*utmpl
;
889 nr
= (rt
->rta_len
- sizeof(*rt
)) / sizeof(*utmpl
);
891 if (nr
> XFRM_MAX_DEPTH
)
894 copy_templates(pol
, RTA_DATA(rt
), nr
);
899 static int copy_from_user_policy_type(u8
*tp
, struct rtattr
**xfrma
)
901 struct rtattr
*rt
= xfrma
[XFRMA_POLICY_TYPE
-1];
902 struct xfrm_userpolicy_type
*upt
;
903 __u8 type
= XFRM_POLICY_TYPE_MAIN
;
907 if (rt
->rta_len
< sizeof(*upt
))
914 err
= verify_policy_type(type
);
922 static void copy_from_user_policy(struct xfrm_policy
*xp
, struct xfrm_userpolicy_info
*p
)
924 xp
->priority
= p
->priority
;
925 xp
->index
= p
->index
;
926 memcpy(&xp
->selector
, &p
->sel
, sizeof(xp
->selector
));
927 memcpy(&xp
->lft
, &p
->lft
, sizeof(xp
->lft
));
928 xp
->action
= p
->action
;
929 xp
->flags
= p
->flags
;
930 xp
->family
= p
->sel
.family
;
931 /* XXX xp->share = p->share; */
934 static void copy_to_user_policy(struct xfrm_policy
*xp
, struct xfrm_userpolicy_info
*p
, int dir
)
936 memcpy(&p
->sel
, &xp
->selector
, sizeof(p
->sel
));
937 memcpy(&p
->lft
, &xp
->lft
, sizeof(p
->lft
));
938 memcpy(&p
->curlft
, &xp
->curlft
, sizeof(p
->curlft
));
939 p
->priority
= xp
->priority
;
940 p
->index
= xp
->index
;
941 p
->sel
.family
= xp
->family
;
943 p
->action
= xp
->action
;
944 p
->flags
= xp
->flags
;
945 p
->share
= XFRM_SHARE_ANY
; /* XXX xp->share */
948 static struct xfrm_policy
*xfrm_policy_construct(struct xfrm_userpolicy_info
*p
, struct rtattr
**xfrma
, int *errp
)
950 struct xfrm_policy
*xp
= xfrm_policy_alloc(GFP_KERNEL
);
958 copy_from_user_policy(xp
, p
);
960 err
= copy_from_user_policy_type(&xp
->type
, xfrma
);
964 if (!(err
= copy_from_user_tmpl(xp
, xfrma
)))
965 err
= copy_from_user_sec_ctx(xp
, xfrma
);
976 static int xfrm_add_policy(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
978 struct xfrm_userpolicy_info
*p
= NLMSG_DATA(nlh
);
979 struct xfrm_policy
*xp
;
984 err
= verify_newpolicy_info(p
);
987 err
= verify_sec_ctx_len((struct rtattr
**)xfrma
);
991 xp
= xfrm_policy_construct(p
, (struct rtattr
**)xfrma
, &err
);
995 /* shouldnt excl be based on nlh flags??
996 * Aha! this is anti-netlink really i.e more pfkey derived
997 * in netlink excl is a flag and you wouldnt need
998 * a type XFRM_MSG_UPDPOLICY - JHS */
999 excl
= nlh
->nlmsg_type
== XFRM_MSG_NEWPOLICY
;
1000 err
= xfrm_policy_insert(p
->dir
, xp
, excl
);
1002 security_xfrm_policy_free(xp
);
1007 c
.event
= nlh
->nlmsg_type
;
1008 c
.seq
= nlh
->nlmsg_seq
;
1009 c
.pid
= nlh
->nlmsg_pid
;
1010 km_policy_notify(xp
, p
->dir
, &c
);
1017 static int copy_to_user_tmpl(struct xfrm_policy
*xp
, struct sk_buff
*skb
)
1019 struct xfrm_user_tmpl vec
[XFRM_MAX_DEPTH
];
1022 if (xp
->xfrm_nr
== 0)
1025 for (i
= 0; i
< xp
->xfrm_nr
; i
++) {
1026 struct xfrm_user_tmpl
*up
= &vec
[i
];
1027 struct xfrm_tmpl
*kp
= &xp
->xfrm_vec
[i
];
1029 memcpy(&up
->id
, &kp
->id
, sizeof(up
->id
));
1030 up
->family
= xp
->family
;
1031 memcpy(&up
->saddr
, &kp
->saddr
, sizeof(up
->saddr
));
1032 up
->reqid
= kp
->reqid
;
1033 up
->mode
= kp
->mode
;
1034 up
->share
= kp
->share
;
1035 up
->optional
= kp
->optional
;
1036 up
->aalgos
= kp
->aalgos
;
1037 up
->ealgos
= kp
->ealgos
;
1038 up
->calgos
= kp
->calgos
;
1040 RTA_PUT(skb
, XFRMA_TMPL
,
1041 (sizeof(struct xfrm_user_tmpl
) * xp
->xfrm_nr
),
1050 static int copy_sec_ctx(struct xfrm_sec_ctx
*s
, struct sk_buff
*skb
)
1052 int ctx_size
= sizeof(struct xfrm_sec_ctx
) + s
->ctx_len
;
1053 struct rtattr
*rt
= __RTA_PUT(skb
, XFRMA_SEC_CTX
, ctx_size
);
1054 struct xfrm_user_sec_ctx
*uctx
= RTA_DATA(rt
);
1056 uctx
->exttype
= XFRMA_SEC_CTX
;
1057 uctx
->len
= ctx_size
;
1058 uctx
->ctx_doi
= s
->ctx_doi
;
1059 uctx
->ctx_alg
= s
->ctx_alg
;
1060 uctx
->ctx_len
= s
->ctx_len
;
1061 memcpy(uctx
+ 1, s
->ctx_str
, s
->ctx_len
);
1068 static inline int copy_to_user_state_sec_ctx(struct xfrm_state
*x
, struct sk_buff
*skb
)
1071 return copy_sec_ctx(x
->security
, skb
);
1076 static inline int copy_to_user_sec_ctx(struct xfrm_policy
*xp
, struct sk_buff
*skb
)
1079 return copy_sec_ctx(xp
->security
, skb
);
1084 #ifdef CONFIG_XFRM_SUB_POLICY
1085 static int copy_to_user_policy_type(struct xfrm_policy
*xp
, struct sk_buff
*skb
)
1087 struct xfrm_userpolicy_type upt
;
1089 memset(&upt
, 0, sizeof(upt
));
1090 upt
.type
= xp
->type
;
1092 RTA_PUT(skb
, XFRMA_POLICY_TYPE
, sizeof(upt
), &upt
);
1101 static inline int copy_to_user_policy_type(struct xfrm_policy
*xp
, struct sk_buff
*skb
)
1107 static int dump_one_policy(struct xfrm_policy
*xp
, int dir
, int count
, void *ptr
)
1109 struct xfrm_dump_info
*sp
= ptr
;
1110 struct xfrm_userpolicy_info
*p
;
1111 struct sk_buff
*in_skb
= sp
->in_skb
;
1112 struct sk_buff
*skb
= sp
->out_skb
;
1113 struct nlmsghdr
*nlh
;
1114 unsigned char *b
= skb
->tail
;
1116 if (sp
->this_idx
< sp
->start_idx
)
1119 nlh
= NLMSG_PUT(skb
, NETLINK_CB(in_skb
).pid
,
1121 XFRM_MSG_NEWPOLICY
, sizeof(*p
));
1122 p
= NLMSG_DATA(nlh
);
1123 nlh
->nlmsg_flags
= sp
->nlmsg_flags
;
1125 copy_to_user_policy(xp
, p
, dir
);
1126 if (copy_to_user_tmpl(xp
, skb
) < 0)
1128 if (copy_to_user_sec_ctx(xp
, skb
))
1130 if (copy_to_user_policy_type(xp
, skb
) < 0)
1133 nlh
->nlmsg_len
= skb
->tail
- b
;
1139 skb_trim(skb
, b
- skb
->data
);
1143 static int xfrm_dump_policy(struct sk_buff
*skb
, struct netlink_callback
*cb
)
1145 struct xfrm_dump_info info
;
1147 info
.in_skb
= cb
->skb
;
1149 info
.nlmsg_seq
= cb
->nlh
->nlmsg_seq
;
1150 info
.nlmsg_flags
= NLM_F_MULTI
;
1152 info
.start_idx
= cb
->args
[0];
1153 (void) xfrm_policy_walk(XFRM_POLICY_TYPE_MAIN
, dump_one_policy
, &info
);
1154 #ifdef CONFIG_XFRM_SUB_POLICY
1155 (void) xfrm_policy_walk(XFRM_POLICY_TYPE_SUB
, dump_one_policy
, &info
);
1157 cb
->args
[0] = info
.this_idx
;
1162 static struct sk_buff
*xfrm_policy_netlink(struct sk_buff
*in_skb
,
1163 struct xfrm_policy
*xp
,
1166 struct xfrm_dump_info info
;
1167 struct sk_buff
*skb
;
1169 skb
= alloc_skb(NLMSG_GOODSIZE
, GFP_KERNEL
);
1171 return ERR_PTR(-ENOMEM
);
1173 NETLINK_CB(skb
).dst_pid
= NETLINK_CB(in_skb
).pid
;
1174 info
.in_skb
= in_skb
;
1176 info
.nlmsg_seq
= seq
;
1177 info
.nlmsg_flags
= 0;
1178 info
.this_idx
= info
.start_idx
= 0;
1180 if (dump_one_policy(xp
, dir
, 0, &info
) < 0) {
1188 static int xfrm_get_policy(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
1190 struct xfrm_policy
*xp
;
1191 struct xfrm_userpolicy_id
*p
;
1192 __u8 type
= XFRM_POLICY_TYPE_MAIN
;
1197 p
= NLMSG_DATA(nlh
);
1198 delete = nlh
->nlmsg_type
== XFRM_MSG_DELPOLICY
;
1200 err
= copy_from_user_policy_type(&type
, (struct rtattr
**)xfrma
);
1204 err
= verify_policy_dir(p
->dir
);
1209 xp
= xfrm_policy_byid(type
, p
->dir
, p
->index
, delete);
1211 struct rtattr
**rtattrs
= (struct rtattr
**)xfrma
;
1212 struct rtattr
*rt
= rtattrs
[XFRMA_SEC_CTX
-1];
1213 struct xfrm_policy tmp
;
1215 err
= verify_sec_ctx_len(rtattrs
);
1219 memset(&tmp
, 0, sizeof(struct xfrm_policy
));
1221 struct xfrm_user_sec_ctx
*uctx
= RTA_DATA(rt
);
1223 if ((err
= security_xfrm_policy_alloc(&tmp
, uctx
)))
1226 xp
= xfrm_policy_bysel_ctx(type
, p
->dir
, &p
->sel
, tmp
.security
, delete);
1227 security_xfrm_policy_free(&tmp
);
1233 struct sk_buff
*resp_skb
;
1235 resp_skb
= xfrm_policy_netlink(skb
, xp
, p
->dir
, nlh
->nlmsg_seq
);
1236 if (IS_ERR(resp_skb
)) {
1237 err
= PTR_ERR(resp_skb
);
1239 err
= netlink_unicast(xfrm_nl
, resp_skb
,
1240 NETLINK_CB(skb
).pid
,
1244 if ((err
= security_xfrm_policy_delete(xp
)) != 0)
1246 c
.data
.byid
= p
->index
;
1247 c
.event
= nlh
->nlmsg_type
;
1248 c
.seq
= nlh
->nlmsg_seq
;
1249 c
.pid
= nlh
->nlmsg_pid
;
1250 km_policy_notify(xp
, p
->dir
, &c
);
1259 static int xfrm_flush_sa(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
1262 struct xfrm_usersa_flush
*p
= NLMSG_DATA(nlh
);
1264 xfrm_state_flush(p
->proto
);
1265 c
.data
.proto
= p
->proto
;
1266 c
.event
= nlh
->nlmsg_type
;
1267 c
.seq
= nlh
->nlmsg_seq
;
1268 c
.pid
= nlh
->nlmsg_pid
;
1269 km_state_notify(NULL
, &c
);
1275 static int build_aevent(struct sk_buff
*skb
, struct xfrm_state
*x
, struct km_event
*c
)
1277 struct xfrm_aevent_id
*id
;
1278 struct nlmsghdr
*nlh
;
1279 struct xfrm_lifetime_cur ltime
;
1280 unsigned char *b
= skb
->tail
;
1282 nlh
= NLMSG_PUT(skb
, c
->pid
, c
->seq
, XFRM_MSG_NEWAE
, sizeof(*id
));
1283 id
= NLMSG_DATA(nlh
);
1284 nlh
->nlmsg_flags
= 0;
1286 id
->sa_id
.daddr
= x
->id
.daddr
;
1287 id
->sa_id
.spi
= x
->id
.spi
;
1288 id
->sa_id
.family
= x
->props
.family
;
1289 id
->sa_id
.proto
= x
->id
.proto
;
1290 id
->flags
= c
->data
.aevent
;
1292 RTA_PUT(skb
, XFRMA_REPLAY_VAL
, sizeof(x
->replay
), &x
->replay
);
1294 ltime
.bytes
= x
->curlft
.bytes
;
1295 ltime
.packets
= x
->curlft
.packets
;
1296 ltime
.add_time
= x
->curlft
.add_time
;
1297 ltime
.use_time
= x
->curlft
.use_time
;
1299 RTA_PUT(skb
, XFRMA_LTIME_VAL
, sizeof(struct xfrm_lifetime_cur
), <ime
);
1301 if (id
->flags
&XFRM_AE_RTHR
) {
1302 RTA_PUT(skb
,XFRMA_REPLAY_THRESH
,sizeof(u32
),&x
->replay_maxdiff
);
1305 if (id
->flags
&XFRM_AE_ETHR
) {
1306 u32 etimer
= x
->replay_maxage
*10/HZ
;
1307 RTA_PUT(skb
,XFRMA_ETIMER_THRESH
,sizeof(u32
),&etimer
);
1310 nlh
->nlmsg_len
= skb
->tail
- b
;
1315 skb_trim(skb
, b
- skb
->data
);
1319 static int xfrm_get_ae(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
1321 struct xfrm_state
*x
;
1322 struct sk_buff
*r_skb
;
1325 struct xfrm_aevent_id
*p
= NLMSG_DATA(nlh
);
1326 int len
= NLMSG_LENGTH(sizeof(struct xfrm_aevent_id
));
1327 struct xfrm_usersa_id
*id
= &p
->sa_id
;
1329 len
+= RTA_SPACE(sizeof(struct xfrm_replay_state
));
1330 len
+= RTA_SPACE(sizeof(struct xfrm_lifetime_cur
));
1332 if (p
->flags
&XFRM_AE_RTHR
)
1333 len
+=RTA_SPACE(sizeof(u32
));
1335 if (p
->flags
&XFRM_AE_ETHR
)
1336 len
+=RTA_SPACE(sizeof(u32
));
1338 r_skb
= alloc_skb(len
, GFP_ATOMIC
);
1342 x
= xfrm_state_lookup(&id
->daddr
, id
->spi
, id
->proto
, id
->family
);
1349 * XXX: is this lock really needed - none of the other
1350 * gets lock (the concern is things getting updated
1351 * while we are still reading) - jhs
1353 spin_lock_bh(&x
->lock
);
1354 c
.data
.aevent
= p
->flags
;
1355 c
.seq
= nlh
->nlmsg_seq
;
1356 c
.pid
= nlh
->nlmsg_pid
;
1358 if (build_aevent(r_skb
, x
, &c
) < 0)
1360 err
= netlink_unicast(xfrm_nl
, r_skb
,
1361 NETLINK_CB(skb
).pid
, MSG_DONTWAIT
);
1362 spin_unlock_bh(&x
->lock
);
1367 static int xfrm_new_ae(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
1369 struct xfrm_state
*x
;
1372 struct xfrm_aevent_id
*p
= NLMSG_DATA(nlh
);
1373 struct rtattr
*rp
= xfrma
[XFRMA_REPLAY_VAL
-1];
1374 struct rtattr
*lt
= xfrma
[XFRMA_LTIME_VAL
-1];
1379 /* pedantic mode - thou shalt sayeth replaceth */
1380 if (!(nlh
->nlmsg_flags
&NLM_F_REPLACE
))
1383 x
= xfrm_state_lookup(&p
->sa_id
.daddr
, p
->sa_id
.spi
, p
->sa_id
.proto
, p
->sa_id
.family
);
1387 if (x
->km
.state
!= XFRM_STATE_VALID
)
1390 spin_lock_bh(&x
->lock
);
1391 err
= xfrm_update_ae_params(x
,(struct rtattr
**)xfrma
);
1392 spin_unlock_bh(&x
->lock
);
1396 c
.event
= nlh
->nlmsg_type
;
1397 c
.seq
= nlh
->nlmsg_seq
;
1398 c
.pid
= nlh
->nlmsg_pid
;
1399 c
.data
.aevent
= XFRM_AE_CU
;
1400 km_state_notify(x
, &c
);
1407 static int xfrm_flush_policy(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
1410 __u8 type
= XFRM_POLICY_TYPE_MAIN
;
1413 err
= copy_from_user_policy_type(&type
, (struct rtattr
**)xfrma
);
1417 xfrm_policy_flush(type
);
1419 c
.event
= nlh
->nlmsg_type
;
1420 c
.seq
= nlh
->nlmsg_seq
;
1421 c
.pid
= nlh
->nlmsg_pid
;
1422 km_policy_notify(NULL
, 0, &c
);
1426 static int xfrm_add_pol_expire(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
1428 struct xfrm_policy
*xp
;
1429 struct xfrm_user_polexpire
*up
= NLMSG_DATA(nlh
);
1430 struct xfrm_userpolicy_info
*p
= &up
->pol
;
1431 __u8 type
= XFRM_POLICY_TYPE_MAIN
;
1434 err
= copy_from_user_policy_type(&type
, (struct rtattr
**)xfrma
);
1439 xp
= xfrm_policy_byid(type
, p
->dir
, p
->index
, 0);
1441 struct rtattr
**rtattrs
= (struct rtattr
**)xfrma
;
1442 struct rtattr
*rt
= rtattrs
[XFRMA_SEC_CTX
-1];
1443 struct xfrm_policy tmp
;
1445 err
= verify_sec_ctx_len(rtattrs
);
1449 memset(&tmp
, 0, sizeof(struct xfrm_policy
));
1451 struct xfrm_user_sec_ctx
*uctx
= RTA_DATA(rt
);
1453 if ((err
= security_xfrm_policy_alloc(&tmp
, uctx
)))
1456 xp
= xfrm_policy_bysel_ctx(type
, p
->dir
, &p
->sel
, tmp
.security
, 0);
1457 security_xfrm_policy_free(&tmp
);
1462 read_lock(&xp
->lock
);
1464 read_unlock(&xp
->lock
);
1468 read_unlock(&xp
->lock
);
1471 xfrm_policy_delete(xp
, p
->dir
);
1473 // reset the timers here?
1474 printk("Dont know what to do with soft policy expire\n");
1476 km_policy_expired(xp
, p
->dir
, up
->hard
, current
->pid
);
1483 static int xfrm_add_sa_expire(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
1485 struct xfrm_state
*x
;
1487 struct xfrm_user_expire
*ue
= NLMSG_DATA(nlh
);
1488 struct xfrm_usersa_info
*p
= &ue
->state
;
1490 x
= xfrm_state_lookup(&p
->id
.daddr
, p
->id
.spi
, p
->id
.proto
, p
->family
);
1498 spin_lock_bh(&x
->lock
);
1499 if (x
->km
.state
!= XFRM_STATE_VALID
)
1501 km_state_expired(x
, ue
->hard
, current
->pid
);
1504 __xfrm_state_delete(x
);
1506 spin_unlock_bh(&x
->lock
);
1511 static int xfrm_add_acquire(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void **xfrma
)
1513 struct xfrm_policy
*xp
;
1514 struct xfrm_user_tmpl
*ut
;
1516 struct rtattr
*rt
= xfrma
[XFRMA_TMPL
-1];
1518 struct xfrm_user_acquire
*ua
= NLMSG_DATA(nlh
);
1519 struct xfrm_state
*x
= xfrm_state_alloc();
1525 err
= verify_newpolicy_info(&ua
->policy
);
1527 printk("BAD policy passed\n");
1533 xp
= xfrm_policy_construct(&ua
->policy
, (struct rtattr
**) xfrma
, &err
); if (!xp
) {
1538 memcpy(&x
->id
, &ua
->id
, sizeof(ua
->id
));
1539 memcpy(&x
->props
.saddr
, &ua
->saddr
, sizeof(ua
->saddr
));
1540 memcpy(&x
->sel
, &ua
->sel
, sizeof(ua
->sel
));
1543 /* extract the templates and for each call km_key */
1544 for (i
= 0; i
< xp
->xfrm_nr
; i
++, ut
++) {
1545 struct xfrm_tmpl
*t
= &xp
->xfrm_vec
[i
];
1546 memcpy(&x
->id
, &t
->id
, sizeof(x
->id
));
1547 x
->props
.mode
= t
->mode
;
1548 x
->props
.reqid
= t
->reqid
;
1549 x
->props
.family
= ut
->family
;
1550 t
->aalgos
= ua
->aalgos
;
1551 t
->ealgos
= ua
->ealgos
;
1552 t
->calgos
= ua
->calgos
;
1553 err
= km_query(x
, t
, xp
);
1564 #define XMSGSIZE(type) NLMSG_LENGTH(sizeof(struct type))
1566 static const int xfrm_msg_min
[XFRM_NR_MSGTYPES
] = {
1567 [XFRM_MSG_NEWSA
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_usersa_info
),
1568 [XFRM_MSG_DELSA
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_usersa_id
),
1569 [XFRM_MSG_GETSA
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_usersa_id
),
1570 [XFRM_MSG_NEWPOLICY
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_userpolicy_info
),
1571 [XFRM_MSG_DELPOLICY
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_userpolicy_id
),
1572 [XFRM_MSG_GETPOLICY
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_userpolicy_id
),
1573 [XFRM_MSG_ALLOCSPI
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_userspi_info
),
1574 [XFRM_MSG_ACQUIRE
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_user_acquire
),
1575 [XFRM_MSG_EXPIRE
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_user_expire
),
1576 [XFRM_MSG_UPDPOLICY
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_userpolicy_info
),
1577 [XFRM_MSG_UPDSA
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_usersa_info
),
1578 [XFRM_MSG_POLEXPIRE
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_user_polexpire
),
1579 [XFRM_MSG_FLUSHSA
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_usersa_flush
),
1580 [XFRM_MSG_FLUSHPOLICY
- XFRM_MSG_BASE
] = NLMSG_LENGTH(0),
1581 [XFRM_MSG_NEWAE
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_aevent_id
),
1582 [XFRM_MSG_GETAE
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_aevent_id
),
1583 [XFRM_MSG_REPORT
- XFRM_MSG_BASE
] = XMSGSIZE(xfrm_user_report
),
1588 static struct xfrm_link
{
1589 int (*doit
)(struct sk_buff
*, struct nlmsghdr
*, void **);
1590 int (*dump
)(struct sk_buff
*, struct netlink_callback
*);
1591 } xfrm_dispatch
[XFRM_NR_MSGTYPES
] = {
1592 [XFRM_MSG_NEWSA
- XFRM_MSG_BASE
] = { .doit
= xfrm_add_sa
},
1593 [XFRM_MSG_DELSA
- XFRM_MSG_BASE
] = { .doit
= xfrm_del_sa
},
1594 [XFRM_MSG_GETSA
- XFRM_MSG_BASE
] = { .doit
= xfrm_get_sa
,
1595 .dump
= xfrm_dump_sa
},
1596 [XFRM_MSG_NEWPOLICY
- XFRM_MSG_BASE
] = { .doit
= xfrm_add_policy
},
1597 [XFRM_MSG_DELPOLICY
- XFRM_MSG_BASE
] = { .doit
= xfrm_get_policy
},
1598 [XFRM_MSG_GETPOLICY
- XFRM_MSG_BASE
] = { .doit
= xfrm_get_policy
,
1599 .dump
= xfrm_dump_policy
},
1600 [XFRM_MSG_ALLOCSPI
- XFRM_MSG_BASE
] = { .doit
= xfrm_alloc_userspi
},
1601 [XFRM_MSG_ACQUIRE
- XFRM_MSG_BASE
] = { .doit
= xfrm_add_acquire
},
1602 [XFRM_MSG_EXPIRE
- XFRM_MSG_BASE
] = { .doit
= xfrm_add_sa_expire
},
1603 [XFRM_MSG_UPDPOLICY
- XFRM_MSG_BASE
] = { .doit
= xfrm_add_policy
},
1604 [XFRM_MSG_UPDSA
- XFRM_MSG_BASE
] = { .doit
= xfrm_add_sa
},
1605 [XFRM_MSG_POLEXPIRE
- XFRM_MSG_BASE
] = { .doit
= xfrm_add_pol_expire
},
1606 [XFRM_MSG_FLUSHSA
- XFRM_MSG_BASE
] = { .doit
= xfrm_flush_sa
},
1607 [XFRM_MSG_FLUSHPOLICY
- XFRM_MSG_BASE
] = { .doit
= xfrm_flush_policy
},
1608 [XFRM_MSG_NEWAE
- XFRM_MSG_BASE
] = { .doit
= xfrm_new_ae
},
1609 [XFRM_MSG_GETAE
- XFRM_MSG_BASE
] = { .doit
= xfrm_get_ae
},
1612 static int xfrm_user_rcv_msg(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, int *errp
)
1614 struct rtattr
*xfrma
[XFRMA_MAX
];
1615 struct xfrm_link
*link
;
1618 if (!(nlh
->nlmsg_flags
& NLM_F_REQUEST
))
1621 type
= nlh
->nlmsg_type
;
1623 /* A control message: ignore them */
1624 if (type
< XFRM_MSG_BASE
)
1627 /* Unknown message: reply with EINVAL */
1628 if (type
> XFRM_MSG_MAX
)
1631 type
-= XFRM_MSG_BASE
;
1632 link
= &xfrm_dispatch
[type
];
1634 /* All operations require privileges, even GET */
1635 if (security_netlink_recv(skb
, CAP_NET_ADMIN
)) {
1640 if ((type
== (XFRM_MSG_GETSA
- XFRM_MSG_BASE
) ||
1641 type
== (XFRM_MSG_GETPOLICY
- XFRM_MSG_BASE
)) &&
1642 (nlh
->nlmsg_flags
& NLM_F_DUMP
)) {
1643 if (link
->dump
== NULL
)
1646 if ((*errp
= netlink_dump_start(xfrm_nl
, skb
, nlh
,
1647 link
->dump
, NULL
)) != 0) {
1651 netlink_queue_skip(nlh
, skb
);
1655 memset(xfrma
, 0, sizeof(xfrma
));
1657 if (nlh
->nlmsg_len
< (min_len
= xfrm_msg_min
[type
]))
1660 if (nlh
->nlmsg_len
> min_len
) {
1661 int attrlen
= nlh
->nlmsg_len
- NLMSG_ALIGN(min_len
);
1662 struct rtattr
*attr
= (void *) nlh
+ NLMSG_ALIGN(min_len
);
1664 while (RTA_OK(attr
, attrlen
)) {
1665 unsigned short flavor
= attr
->rta_type
;
1667 if (flavor
> XFRMA_MAX
)
1669 xfrma
[flavor
- 1] = attr
;
1671 attr
= RTA_NEXT(attr
, attrlen
);
1675 if (link
->doit
== NULL
)
1677 *errp
= link
->doit(skb
, nlh
, (void **) &xfrma
);
1686 static void xfrm_netlink_rcv(struct sock
*sk
, int len
)
1688 unsigned int qlen
= 0;
1691 mutex_lock(&xfrm_cfg_mutex
);
1692 netlink_run_queue(sk
, &qlen
, &xfrm_user_rcv_msg
);
1693 mutex_unlock(&xfrm_cfg_mutex
);
1698 static int build_expire(struct sk_buff
*skb
, struct xfrm_state
*x
, struct km_event
*c
)
1700 struct xfrm_user_expire
*ue
;
1701 struct nlmsghdr
*nlh
;
1702 unsigned char *b
= skb
->tail
;
1704 nlh
= NLMSG_PUT(skb
, c
->pid
, 0, XFRM_MSG_EXPIRE
,
1706 ue
= NLMSG_DATA(nlh
);
1707 nlh
->nlmsg_flags
= 0;
1709 copy_to_user_state(x
, &ue
->state
);
1710 ue
->hard
= (c
->data
.hard
!= 0) ? 1 : 0;
1712 nlh
->nlmsg_len
= skb
->tail
- b
;
1716 skb_trim(skb
, b
- skb
->data
);
1720 static int xfrm_exp_state_notify(struct xfrm_state
*x
, struct km_event
*c
)
1722 struct sk_buff
*skb
;
1723 int len
= NLMSG_LENGTH(sizeof(struct xfrm_user_expire
));
1725 skb
= alloc_skb(len
, GFP_ATOMIC
);
1729 if (build_expire(skb
, x
, c
) < 0)
1732 NETLINK_CB(skb
).dst_group
= XFRMNLGRP_EXPIRE
;
1733 return netlink_broadcast(xfrm_nl
, skb
, 0, XFRMNLGRP_EXPIRE
, GFP_ATOMIC
);
1736 static int xfrm_aevent_state_notify(struct xfrm_state
*x
, struct km_event
*c
)
1738 struct sk_buff
*skb
;
1739 int len
= NLMSG_LENGTH(sizeof(struct xfrm_aevent_id
));
1741 len
+= RTA_SPACE(sizeof(struct xfrm_replay_state
));
1742 len
+= RTA_SPACE(sizeof(struct xfrm_lifetime_cur
));
1743 skb
= alloc_skb(len
, GFP_ATOMIC
);
1747 if (build_aevent(skb
, x
, c
) < 0)
1750 NETLINK_CB(skb
).dst_group
= XFRMNLGRP_AEVENTS
;
1751 return netlink_broadcast(xfrm_nl
, skb
, 0, XFRMNLGRP_AEVENTS
, GFP_ATOMIC
);
1754 static int xfrm_notify_sa_flush(struct km_event
*c
)
1756 struct xfrm_usersa_flush
*p
;
1757 struct nlmsghdr
*nlh
;
1758 struct sk_buff
*skb
;
1760 int len
= NLMSG_LENGTH(sizeof(struct xfrm_usersa_flush
));
1762 skb
= alloc_skb(len
, GFP_ATOMIC
);
1767 nlh
= NLMSG_PUT(skb
, c
->pid
, c
->seq
,
1768 XFRM_MSG_FLUSHSA
, sizeof(*p
));
1769 nlh
->nlmsg_flags
= 0;
1771 p
= NLMSG_DATA(nlh
);
1772 p
->proto
= c
->data
.proto
;
1774 nlh
->nlmsg_len
= skb
->tail
- b
;
1776 NETLINK_CB(skb
).dst_group
= XFRMNLGRP_SA
;
1777 return netlink_broadcast(xfrm_nl
, skb
, 0, XFRMNLGRP_SA
, GFP_ATOMIC
);
1784 static int inline xfrm_sa_len(struct xfrm_state
*x
)
1788 l
+= RTA_SPACE(sizeof(*x
->aalg
) + (x
->aalg
->alg_key_len
+7)/8);
1790 l
+= RTA_SPACE(sizeof(*x
->ealg
) + (x
->ealg
->alg_key_len
+7)/8);
1792 l
+= RTA_SPACE(sizeof(*x
->calg
));
1794 l
+= RTA_SPACE(sizeof(*x
->encap
));
1799 static int xfrm_notify_sa(struct xfrm_state
*x
, struct km_event
*c
)
1801 struct xfrm_usersa_info
*p
;
1802 struct xfrm_usersa_id
*id
;
1803 struct nlmsghdr
*nlh
;
1804 struct sk_buff
*skb
;
1806 int len
= xfrm_sa_len(x
);
1809 headlen
= sizeof(*p
);
1810 if (c
->event
== XFRM_MSG_DELSA
) {
1811 len
+= RTA_SPACE(headlen
);
1812 headlen
= sizeof(*id
);
1814 len
+= NLMSG_SPACE(headlen
);
1816 skb
= alloc_skb(len
, GFP_ATOMIC
);
1821 nlh
= NLMSG_PUT(skb
, c
->pid
, c
->seq
, c
->event
, headlen
);
1822 nlh
->nlmsg_flags
= 0;
1824 p
= NLMSG_DATA(nlh
);
1825 if (c
->event
== XFRM_MSG_DELSA
) {
1826 id
= NLMSG_DATA(nlh
);
1827 memcpy(&id
->daddr
, &x
->id
.daddr
, sizeof(id
->daddr
));
1828 id
->spi
= x
->id
.spi
;
1829 id
->family
= x
->props
.family
;
1830 id
->proto
= x
->id
.proto
;
1832 p
= RTA_DATA(__RTA_PUT(skb
, XFRMA_SA
, sizeof(*p
)));
1835 copy_to_user_state(x
, p
);
1838 RTA_PUT(skb
, XFRMA_ALG_AUTH
,
1839 sizeof(*(x
->aalg
))+(x
->aalg
->alg_key_len
+7)/8, x
->aalg
);
1841 RTA_PUT(skb
, XFRMA_ALG_CRYPT
,
1842 sizeof(*(x
->ealg
))+(x
->ealg
->alg_key_len
+7)/8, x
->ealg
);
1844 RTA_PUT(skb
, XFRMA_ALG_COMP
, sizeof(*(x
->calg
)), x
->calg
);
1847 RTA_PUT(skb
, XFRMA_ENCAP
, sizeof(*x
->encap
), x
->encap
);
1849 nlh
->nlmsg_len
= skb
->tail
- b
;
1851 NETLINK_CB(skb
).dst_group
= XFRMNLGRP_SA
;
1852 return netlink_broadcast(xfrm_nl
, skb
, 0, XFRMNLGRP_SA
, GFP_ATOMIC
);
1860 static int xfrm_send_state_notify(struct xfrm_state
*x
, struct km_event
*c
)
1864 case XFRM_MSG_EXPIRE
:
1865 return xfrm_exp_state_notify(x
, c
);
1866 case XFRM_MSG_NEWAE
:
1867 return xfrm_aevent_state_notify(x
, c
);
1868 case XFRM_MSG_DELSA
:
1869 case XFRM_MSG_UPDSA
:
1870 case XFRM_MSG_NEWSA
:
1871 return xfrm_notify_sa(x
, c
);
1872 case XFRM_MSG_FLUSHSA
:
1873 return xfrm_notify_sa_flush(c
);
1875 printk("xfrm_user: Unknown SA event %d\n", c
->event
);
1883 static int build_acquire(struct sk_buff
*skb
, struct xfrm_state
*x
,
1884 struct xfrm_tmpl
*xt
, struct xfrm_policy
*xp
,
1887 struct xfrm_user_acquire
*ua
;
1888 struct nlmsghdr
*nlh
;
1889 unsigned char *b
= skb
->tail
;
1890 __u32 seq
= xfrm_get_acqseq();
1892 nlh
= NLMSG_PUT(skb
, 0, 0, XFRM_MSG_ACQUIRE
,
1894 ua
= NLMSG_DATA(nlh
);
1895 nlh
->nlmsg_flags
= 0;
1897 memcpy(&ua
->id
, &x
->id
, sizeof(ua
->id
));
1898 memcpy(&ua
->saddr
, &x
->props
.saddr
, sizeof(ua
->saddr
));
1899 memcpy(&ua
->sel
, &x
->sel
, sizeof(ua
->sel
));
1900 copy_to_user_policy(xp
, &ua
->policy
, dir
);
1901 ua
->aalgos
= xt
->aalgos
;
1902 ua
->ealgos
= xt
->ealgos
;
1903 ua
->calgos
= xt
->calgos
;
1904 ua
->seq
= x
->km
.seq
= seq
;
1906 if (copy_to_user_tmpl(xp
, skb
) < 0)
1908 if (copy_to_user_state_sec_ctx(x
, skb
))
1910 if (copy_to_user_policy_type(xp
, skb
) < 0)
1913 nlh
->nlmsg_len
= skb
->tail
- b
;
1917 skb_trim(skb
, b
- skb
->data
);
1921 static int xfrm_send_acquire(struct xfrm_state
*x
, struct xfrm_tmpl
*xt
,
1922 struct xfrm_policy
*xp
, int dir
)
1924 struct sk_buff
*skb
;
1927 len
= RTA_SPACE(sizeof(struct xfrm_user_tmpl
) * xp
->xfrm_nr
);
1928 len
+= NLMSG_SPACE(sizeof(struct xfrm_user_acquire
));
1929 len
+= RTA_SPACE(xfrm_user_sec_ctx_size(xp
));
1930 skb
= alloc_skb(len
, GFP_ATOMIC
);
1934 if (build_acquire(skb
, x
, xt
, xp
, dir
) < 0)
1937 NETLINK_CB(skb
).dst_group
= XFRMNLGRP_ACQUIRE
;
1938 return netlink_broadcast(xfrm_nl
, skb
, 0, XFRMNLGRP_ACQUIRE
, GFP_ATOMIC
);
1941 /* User gives us xfrm_user_policy_info followed by an array of 0
1942 * or more templates.
1944 static struct xfrm_policy
*xfrm_compile_policy(struct sock
*sk
, int opt
,
1945 u8
*data
, int len
, int *dir
)
1947 struct xfrm_userpolicy_info
*p
= (struct xfrm_userpolicy_info
*)data
;
1948 struct xfrm_user_tmpl
*ut
= (struct xfrm_user_tmpl
*) (p
+ 1);
1949 struct xfrm_policy
*xp
;
1952 switch (sk
->sk_family
) {
1954 if (opt
!= IP_XFRM_POLICY
) {
1959 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
1961 if (opt
!= IPV6_XFRM_POLICY
) {
1974 if (len
< sizeof(*p
) ||
1975 verify_newpolicy_info(p
))
1978 nr
= ((len
- sizeof(*p
)) / sizeof(*ut
));
1979 if (nr
> XFRM_MAX_DEPTH
)
1982 if (p
->dir
> XFRM_POLICY_OUT
)
1985 xp
= xfrm_policy_alloc(GFP_KERNEL
);
1991 copy_from_user_policy(xp
, p
);
1992 xp
->type
= XFRM_POLICY_TYPE_MAIN
;
1993 copy_templates(xp
, ut
, nr
);
2000 static int build_polexpire(struct sk_buff
*skb
, struct xfrm_policy
*xp
,
2001 int dir
, struct km_event
*c
)
2003 struct xfrm_user_polexpire
*upe
;
2004 struct nlmsghdr
*nlh
;
2005 int hard
= c
->data
.hard
;
2006 unsigned char *b
= skb
->tail
;
2008 nlh
= NLMSG_PUT(skb
, c
->pid
, 0, XFRM_MSG_POLEXPIRE
, sizeof(*upe
));
2009 upe
= NLMSG_DATA(nlh
);
2010 nlh
->nlmsg_flags
= 0;
2012 copy_to_user_policy(xp
, &upe
->pol
, dir
);
2013 if (copy_to_user_tmpl(xp
, skb
) < 0)
2015 if (copy_to_user_sec_ctx(xp
, skb
))
2017 if (copy_to_user_policy_type(xp
, skb
) < 0)
2021 nlh
->nlmsg_len
= skb
->tail
- b
;
2025 skb_trim(skb
, b
- skb
->data
);
2029 static int xfrm_exp_policy_notify(struct xfrm_policy
*xp
, int dir
, struct km_event
*c
)
2031 struct sk_buff
*skb
;
2034 len
= RTA_SPACE(sizeof(struct xfrm_user_tmpl
) * xp
->xfrm_nr
);
2035 len
+= NLMSG_SPACE(sizeof(struct xfrm_user_polexpire
));
2036 len
+= RTA_SPACE(xfrm_user_sec_ctx_size(xp
));
2037 skb
= alloc_skb(len
, GFP_ATOMIC
);
2041 if (build_polexpire(skb
, xp
, dir
, c
) < 0)
2044 NETLINK_CB(skb
).dst_group
= XFRMNLGRP_EXPIRE
;
2045 return netlink_broadcast(xfrm_nl
, skb
, 0, XFRMNLGRP_EXPIRE
, GFP_ATOMIC
);
2048 static int xfrm_notify_policy(struct xfrm_policy
*xp
, int dir
, struct km_event
*c
)
2050 struct xfrm_userpolicy_info
*p
;
2051 struct xfrm_userpolicy_id
*id
;
2052 struct nlmsghdr
*nlh
;
2053 struct sk_buff
*skb
;
2055 int len
= RTA_SPACE(sizeof(struct xfrm_user_tmpl
) * xp
->xfrm_nr
);
2058 headlen
= sizeof(*p
);
2059 if (c
->event
== XFRM_MSG_DELPOLICY
) {
2060 len
+= RTA_SPACE(headlen
);
2061 headlen
= sizeof(*id
);
2063 len
+= NLMSG_SPACE(headlen
);
2065 skb
= alloc_skb(len
, GFP_ATOMIC
);
2070 nlh
= NLMSG_PUT(skb
, c
->pid
, c
->seq
, c
->event
, headlen
);
2072 p
= NLMSG_DATA(nlh
);
2073 if (c
->event
== XFRM_MSG_DELPOLICY
) {
2074 id
= NLMSG_DATA(nlh
);
2075 memset(id
, 0, sizeof(*id
));
2078 id
->index
= xp
->index
;
2080 memcpy(&id
->sel
, &xp
->selector
, sizeof(id
->sel
));
2082 p
= RTA_DATA(__RTA_PUT(skb
, XFRMA_POLICY
, sizeof(*p
)));
2085 nlh
->nlmsg_flags
= 0;
2087 copy_to_user_policy(xp
, p
, dir
);
2088 if (copy_to_user_tmpl(xp
, skb
) < 0)
2090 if (copy_to_user_policy_type(xp
, skb
) < 0)
2093 nlh
->nlmsg_len
= skb
->tail
- b
;
2095 NETLINK_CB(skb
).dst_group
= XFRMNLGRP_POLICY
;
2096 return netlink_broadcast(xfrm_nl
, skb
, 0, XFRMNLGRP_POLICY
, GFP_ATOMIC
);
2104 static int xfrm_notify_policy_flush(struct km_event
*c
)
2106 struct nlmsghdr
*nlh
;
2107 struct sk_buff
*skb
;
2109 #ifdef CONFIG_XFRM_SUB_POLICY
2110 struct xfrm_userpolicy_type upt
;
2112 int len
= NLMSG_LENGTH(0);
2114 skb
= alloc_skb(len
, GFP_ATOMIC
);
2120 nlh
= NLMSG_PUT(skb
, c
->pid
, c
->seq
, XFRM_MSG_FLUSHPOLICY
, 0);
2121 nlh
->nlmsg_flags
= 0;
2123 #ifdef CONFIG_XFRM_SUB_POLICY
2124 memset(&upt
, 0, sizeof(upt
));
2125 upt
.type
= c
->data
.type
;
2126 RTA_PUT(skb
, XFRMA_POLICY_TYPE
, sizeof(upt
), &upt
);
2129 nlh
->nlmsg_len
= skb
->tail
- b
;
2131 NETLINK_CB(skb
).dst_group
= XFRMNLGRP_POLICY
;
2132 return netlink_broadcast(xfrm_nl
, skb
, 0, XFRMNLGRP_POLICY
, GFP_ATOMIC
);
2135 #ifdef CONFIG_XFRM_SUB_POLICY
2142 static int xfrm_send_policy_notify(struct xfrm_policy
*xp
, int dir
, struct km_event
*c
)
2146 case XFRM_MSG_NEWPOLICY
:
2147 case XFRM_MSG_UPDPOLICY
:
2148 case XFRM_MSG_DELPOLICY
:
2149 return xfrm_notify_policy(xp
, dir
, c
);
2150 case XFRM_MSG_FLUSHPOLICY
:
2151 return xfrm_notify_policy_flush(c
);
2152 case XFRM_MSG_POLEXPIRE
:
2153 return xfrm_exp_policy_notify(xp
, dir
, c
);
2155 printk("xfrm_user: Unknown Policy event %d\n", c
->event
);
2162 static int build_report(struct sk_buff
*skb
, u8 proto
,
2163 struct xfrm_selector
*sel
, xfrm_address_t
*addr
)
2165 struct xfrm_user_report
*ur
;
2166 struct nlmsghdr
*nlh
;
2167 unsigned char *b
= skb
->tail
;
2169 nlh
= NLMSG_PUT(skb
, 0, 0, XFRM_MSG_REPORT
, sizeof(*ur
));
2170 ur
= NLMSG_DATA(nlh
);
2171 nlh
->nlmsg_flags
= 0;
2174 memcpy(&ur
->sel
, sel
, sizeof(ur
->sel
));
2177 RTA_PUT(skb
, XFRMA_COADDR
, sizeof(*addr
), addr
);
2179 nlh
->nlmsg_len
= skb
->tail
- b
;
2184 skb_trim(skb
, b
- skb
->data
);
2188 static int xfrm_send_report(u8 proto
, struct xfrm_selector
*sel
,
2189 xfrm_address_t
*addr
)
2191 struct sk_buff
*skb
;
2194 len
= NLMSG_ALIGN(NLMSG_LENGTH(sizeof(struct xfrm_user_report
)));
2195 skb
= alloc_skb(len
, GFP_ATOMIC
);
2199 if (build_report(skb
, proto
, sel
, addr
) < 0)
2202 NETLINK_CB(skb
).dst_group
= XFRMNLGRP_REPORT
;
2203 return netlink_broadcast(xfrm_nl
, skb
, 0, XFRMNLGRP_REPORT
, GFP_ATOMIC
);
2206 static struct xfrm_mgr netlink_mgr
= {
2208 .notify
= xfrm_send_state_notify
,
2209 .acquire
= xfrm_send_acquire
,
2210 .compile_policy
= xfrm_compile_policy
,
2211 .notify_policy
= xfrm_send_policy_notify
,
2212 .report
= xfrm_send_report
,
2215 static int __init
xfrm_user_init(void)
2219 printk(KERN_INFO
"Initializing XFRM netlink socket\n");
2221 nlsk
= netlink_kernel_create(NETLINK_XFRM
, XFRMNLGRP_MAX
,
2222 xfrm_netlink_rcv
, THIS_MODULE
);
2225 rcu_assign_pointer(xfrm_nl
, nlsk
);
2227 xfrm_register_km(&netlink_mgr
);
2232 static void __exit
xfrm_user_exit(void)
2234 struct sock
*nlsk
= xfrm_nl
;
2236 xfrm_unregister_km(&netlink_mgr
);
2237 rcu_assign_pointer(xfrm_nl
, NULL
);
2239 sock_release(nlsk
->sk_socket
);
2242 module_init(xfrm_user_init
);
2243 module_exit(xfrm_user_exit
);
2244 MODULE_LICENSE("GPL");
2245 MODULE_ALIAS_NET_PF_PROTO(PF_NETLINK
, NETLINK_XFRM
);