[XFRM] STATE: Search by address using source address list.
[safe/jmp/linux-2.6] / net / ipv6 / xfrm6_state.c
1 /*
2  * xfrm6_state.c: based on xfrm4_state.c
3  *
4  * Authors:
5  *      Mitsuru KANDA @USAGI
6  *      Kazunori MIYAZAWA @USAGI
7  *      Kunihiro Ishiguro <kunihiro@ipinfusion.com>
8  *              IPv6 support
9  *      YOSHIFUJI Hideaki @USAGI
10  *              Split up af-specific portion
11  *      
12  */
13
14 #include <net/xfrm.h>
15 #include <linux/pfkeyv2.h>
16 #include <linux/ipsec.h>
17 #include <net/ipv6.h>
18 #include <net/addrconf.h>
19
20 static struct xfrm_state_afinfo xfrm6_state_afinfo;
21
22 static void
23 __xfrm6_init_tempsel(struct xfrm_state *x, struct flowi *fl,
24                      struct xfrm_tmpl *tmpl,
25                      xfrm_address_t *daddr, xfrm_address_t *saddr)
26 {
27         /* Initialize temporary selector matching only
28          * to current session. */
29         ipv6_addr_copy((struct in6_addr *)&x->sel.daddr, &fl->fl6_dst);
30         ipv6_addr_copy((struct in6_addr *)&x->sel.saddr, &fl->fl6_src);
31         x->sel.dport = xfrm_flowi_dport(fl);
32         x->sel.dport_mask = ~0;
33         x->sel.sport = xfrm_flowi_sport(fl);
34         x->sel.sport_mask = ~0;
35         x->sel.prefixlen_d = 128;
36         x->sel.prefixlen_s = 128;
37         x->sel.proto = fl->proto;
38         x->sel.ifindex = fl->oif;
39         x->id = tmpl->id;
40         if (ipv6_addr_any((struct in6_addr*)&x->id.daddr))
41                 memcpy(&x->id.daddr, daddr, sizeof(x->sel.daddr));
42         memcpy(&x->props.saddr, &tmpl->saddr, sizeof(x->props.saddr));
43         if (ipv6_addr_any((struct in6_addr*)&x->props.saddr))
44                 memcpy(&x->props.saddr, saddr, sizeof(x->props.saddr));
45         if (tmpl->mode == XFRM_MODE_TUNNEL && ipv6_addr_any((struct in6_addr*)&x->props.saddr)) {
46                 struct rt6_info *rt;
47                 struct flowi fl_tunnel = {
48                         .nl_u = {
49                                 .ip6_u = {
50                                         .daddr = *(struct in6_addr *)daddr,
51                                 }
52                         }
53                 };
54                 if (!xfrm_dst_lookup((struct xfrm_dst **)&rt,
55                                      &fl_tunnel, AF_INET6)) {
56                         ipv6_get_saddr(&rt->u.dst, (struct in6_addr *)daddr,
57                                        (struct in6_addr *)&x->props.saddr);
58                         dst_release(&rt->u.dst);
59                 }
60         }
61         x->props.mode = tmpl->mode;
62         x->props.reqid = tmpl->reqid;
63         x->props.family = AF_INET6;
64 }
65
66 static struct xfrm_state *
67 __xfrm6_state_lookup_byaddr(xfrm_address_t *daddr, xfrm_address_t *saddr,
68                             u8 proto)
69 {
70         struct xfrm_state *x = NULL;
71         unsigned h;
72
73         h = __xfrm6_src_hash(saddr);
74         list_for_each_entry(x, xfrm6_state_afinfo.state_bysrc+h, bysrc) {
75                 if (x->props.family == AF_INET6 &&
76                     ipv6_addr_equal((struct in6_addr *)daddr, (struct in6_addr *)x->id.daddr.a6) &&
77                     ipv6_addr_equal((struct in6_addr *)saddr, (struct in6_addr *)x->props.saddr.a6) &&
78                     proto == x->id.proto) {
79                         xfrm_state_hold(x);
80                         return x;
81                 }
82         }
83         return NULL;
84 }
85
86 static struct xfrm_state *
87 __xfrm6_state_lookup(xfrm_address_t *daddr, u32 spi, u8 proto)
88 {
89         unsigned h = __xfrm6_spi_hash(daddr, spi, proto);
90         struct xfrm_state *x;
91
92         list_for_each_entry(x, xfrm6_state_afinfo.state_byspi+h, byspi) {
93                 if (x->props.family == AF_INET6 &&
94                     spi == x->id.spi &&
95                     ipv6_addr_equal((struct in6_addr *)daddr, (struct in6_addr *)x->id.daddr.a6) &&
96                     proto == x->id.proto) {
97                         xfrm_state_hold(x);
98                         return x;
99                 }
100         }
101         return NULL;
102 }
103
104 static struct xfrm_state *
105 __xfrm6_find_acq(u8 mode, u32 reqid, u8 proto, 
106                  xfrm_address_t *daddr, xfrm_address_t *saddr, 
107                  int create)
108 {
109         struct xfrm_state *x, *x0;
110         unsigned h = __xfrm6_dst_hash(daddr);
111
112         x0 = NULL;
113
114         list_for_each_entry(x, xfrm6_state_afinfo.state_bydst+h, bydst) {
115                 if (x->props.family == AF_INET6 &&
116                     ipv6_addr_equal((struct in6_addr *)daddr, (struct in6_addr *)x->id.daddr.a6) &&
117                     mode == x->props.mode &&
118                     proto == x->id.proto &&
119                     ipv6_addr_equal((struct in6_addr *)saddr, (struct in6_addr *)x->props.saddr.a6) &&
120                     reqid == x->props.reqid &&
121                     x->km.state == XFRM_STATE_ACQ &&
122                     !x->id.spi) {
123                             x0 = x;
124                             break;
125                     }
126         }
127         if (!x0 && create && (x0 = xfrm_state_alloc()) != NULL) {
128                 ipv6_addr_copy((struct in6_addr *)x0->sel.daddr.a6,
129                                (struct in6_addr *)daddr);
130                 ipv6_addr_copy((struct in6_addr *)x0->sel.saddr.a6,
131                                (struct in6_addr *)saddr);
132                 x0->sel.prefixlen_d = 128;
133                 x0->sel.prefixlen_s = 128;
134                 ipv6_addr_copy((struct in6_addr *)x0->props.saddr.a6,
135                                (struct in6_addr *)saddr);
136                 x0->km.state = XFRM_STATE_ACQ;
137                 ipv6_addr_copy((struct in6_addr *)x0->id.daddr.a6,
138                                (struct in6_addr *)daddr);
139                 x0->id.proto = proto;
140                 x0->props.family = AF_INET6;
141                 x0->props.mode = mode;
142                 x0->props.reqid = reqid;
143                 x0->lft.hard_add_expires_seconds = XFRM_ACQ_EXPIRES;
144                 xfrm_state_hold(x0);
145                 x0->timer.expires = jiffies + XFRM_ACQ_EXPIRES*HZ;
146                 add_timer(&x0->timer);
147                 xfrm_state_hold(x0);
148                 list_add_tail(&x0->bydst, xfrm6_state_afinfo.state_bydst+h);
149                 h = __xfrm6_src_hash(saddr);
150                 xfrm_state_hold(x0);
151                 list_add_tail(&x0->bysrc, xfrm6_state_afinfo.state_bysrc+h);
152                 wake_up(&km_waitq);
153         }
154         if (x0)
155                 xfrm_state_hold(x0);
156         return x0;
157 }
158
159 static struct xfrm_state_afinfo xfrm6_state_afinfo = {
160         .family                 = AF_INET6,
161         .init_tempsel           = __xfrm6_init_tempsel,
162         .state_lookup           = __xfrm6_state_lookup,
163         .state_lookup_byaddr    = __xfrm6_state_lookup_byaddr,
164         .find_acq               = __xfrm6_find_acq,
165 };
166
167 void __init xfrm6_state_init(void)
168 {
169         xfrm_state_register_afinfo(&xfrm6_state_afinfo);
170 }
171
172 void xfrm6_state_fini(void)
173 {
174         xfrm_state_unregister_afinfo(&xfrm6_state_afinfo);
175 }
176