ipv6: xfrm: Handle errors reported by xfrm6_find_1stfragopt()
[pandora-kernel.git] / net / ipv6 / inet6_connection_sock.c
1 /*
2  * INET        An implementation of the TCP/IP protocol suite for the LINUX
3  *             operating system.  INET is implemented using the  BSD Socket
4  *             interface as the means of communication with the user level.
5  *
6  *             Support for INET6 connection oriented protocols.
7  *
8  * Authors:    See the TCPv6 sources
9  *
10  *             This program is free software; you can redistribute it and/or
11  *             modify it under the terms of the GNU General Public License
12  *             as published by the Free Software Foundation; either version
13  *             2 of the License, or(at your option) any later version.
14  */
15
16 #include <linux/module.h>
17 #include <linux/in6.h>
18 #include <linux/ipv6.h>
19 #include <linux/jhash.h>
20 #include <linux/slab.h>
21
22 #include <net/addrconf.h>
23 #include <net/inet_connection_sock.h>
24 #include <net/inet_ecn.h>
25 #include <net/inet_hashtables.h>
26 #include <net/ip6_route.h>
27 #include <net/sock.h>
28 #include <net/inet6_connection_sock.h>
29
30 int inet6_csk_bind_conflict(const struct sock *sk,
31                             const struct inet_bind_bucket *tb)
32 {
33         const struct sock *sk2;
34         const struct hlist_node *node;
35
36         /* We must walk the whole port owner list in this case. -DaveM */
37         /*
38          * See comment in inet_csk_bind_conflict about sock lookup
39          * vs net namespaces issues.
40          */
41         sk_for_each_bound(sk2, node, &tb->owners) {
42                 if (sk != sk2 &&
43                     (!sk->sk_bound_dev_if ||
44                      !sk2->sk_bound_dev_if ||
45                      sk->sk_bound_dev_if == sk2->sk_bound_dev_if) &&
46                     (!sk->sk_reuse || !sk2->sk_reuse ||
47                      sk2->sk_state == TCP_LISTEN) &&
48                      ipv6_rcv_saddr_equal(sk, sk2))
49                         break;
50         }
51
52         return node != NULL;
53 }
54
55 EXPORT_SYMBOL_GPL(inet6_csk_bind_conflict);
56
57 struct dst_entry *inet6_csk_route_req(struct sock *sk,
58                                       const struct request_sock *req)
59 {
60         struct inet6_request_sock *treq = inet6_rsk(req);
61         struct ipv6_pinfo *np = inet6_sk(sk);
62         struct in6_addr *final_p, final;
63         struct dst_entry *dst;
64         struct flowi6 fl6;
65
66         memset(&fl6, 0, sizeof(fl6));
67         fl6.flowi6_proto = IPPROTO_TCP;
68         ipv6_addr_copy(&fl6.daddr, &treq->rmt_addr);
69         rcu_read_lock();
70         final_p = fl6_update_dst(&fl6, rcu_dereference(np->opt), &final);
71         rcu_read_unlock();
72         ipv6_addr_copy(&fl6.saddr, &treq->loc_addr);
73         fl6.flowi6_oif = sk->sk_bound_dev_if;
74         fl6.flowi6_mark = sk->sk_mark;
75         fl6.fl6_dport = inet_rsk(req)->rmt_port;
76         fl6.fl6_sport = inet_rsk(req)->loc_port;
77         security_req_classify_flow(req, flowi6_to_flowi(&fl6));
78
79         dst = ip6_dst_lookup_flow(sk, &fl6, final_p, false);
80         if (IS_ERR(dst))
81                 return NULL;
82
83         return dst;
84 }
85
86 /*
87  * request_sock (formerly open request) hash tables.
88  */
89 static u32 inet6_synq_hash(const struct in6_addr *raddr, const __be16 rport,
90                            const u32 rnd, const u32 synq_hsize)
91 {
92         u32 c;
93
94         c = jhash_3words((__force u32)raddr->s6_addr32[0],
95                          (__force u32)raddr->s6_addr32[1],
96                          (__force u32)raddr->s6_addr32[2],
97                          rnd);
98
99         c = jhash_2words((__force u32)raddr->s6_addr32[3],
100                          (__force u32)rport,
101                          c);
102
103         return c & (synq_hsize - 1);
104 }
105
106 struct request_sock *inet6_csk_search_req(const struct sock *sk,
107                                           struct request_sock ***prevp,
108                                           const __be16 rport,
109                                           const struct in6_addr *raddr,
110                                           const struct in6_addr *laddr,
111                                           const int iif)
112 {
113         const struct inet_connection_sock *icsk = inet_csk(sk);
114         struct listen_sock *lopt = icsk->icsk_accept_queue.listen_opt;
115         struct request_sock *req, **prev;
116
117         for (prev = &lopt->syn_table[inet6_synq_hash(raddr, rport,
118                                                      lopt->hash_rnd,
119                                                      lopt->nr_table_entries)];
120              (req = *prev) != NULL;
121              prev = &req->dl_next) {
122                 const struct inet6_request_sock *treq = inet6_rsk(req);
123
124                 if (inet_rsk(req)->rmt_port == rport &&
125                     req->rsk_ops->family == AF_INET6 &&
126                     ipv6_addr_equal(&treq->rmt_addr, raddr) &&
127                     ipv6_addr_equal(&treq->loc_addr, laddr) &&
128                     (!treq->iif || treq->iif == iif)) {
129                         WARN_ON(req->sk != NULL);
130                         *prevp = prev;
131                         return req;
132                 }
133         }
134
135         return NULL;
136 }
137
138 EXPORT_SYMBOL_GPL(inet6_csk_search_req);
139
140 void inet6_csk_reqsk_queue_hash_add(struct sock *sk,
141                                     struct request_sock *req,
142                                     const unsigned long timeout)
143 {
144         struct inet_connection_sock *icsk = inet_csk(sk);
145         struct listen_sock *lopt = icsk->icsk_accept_queue.listen_opt;
146         const u32 h = inet6_synq_hash(&inet6_rsk(req)->rmt_addr,
147                                       inet_rsk(req)->rmt_port,
148                                       lopt->hash_rnd, lopt->nr_table_entries);
149
150         reqsk_queue_hash_req(&icsk->icsk_accept_queue, h, req, timeout);
151         inet_csk_reqsk_queue_added(sk, timeout);
152 }
153
154 EXPORT_SYMBOL_GPL(inet6_csk_reqsk_queue_hash_add);
155
156 void inet6_csk_addr2sockaddr(struct sock *sk, struct sockaddr * uaddr)
157 {
158         struct ipv6_pinfo *np = inet6_sk(sk);
159         struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *) uaddr;
160
161         sin6->sin6_family = AF_INET6;
162         ipv6_addr_copy(&sin6->sin6_addr, &np->daddr);
163         sin6->sin6_port = inet_sk(sk)->inet_dport;
164         /* We do not store received flowlabel for TCP */
165         sin6->sin6_flowinfo = 0;
166         sin6->sin6_scope_id = 0;
167         if (sk->sk_bound_dev_if &&
168             ipv6_addr_type(&sin6->sin6_addr) & IPV6_ADDR_LINKLOCAL)
169                 sin6->sin6_scope_id = sk->sk_bound_dev_if;
170 }
171
172 EXPORT_SYMBOL_GPL(inet6_csk_addr2sockaddr);
173
174 static inline
175 void __inet6_csk_dst_store(struct sock *sk, struct dst_entry *dst,
176                            struct in6_addr *daddr, struct in6_addr *saddr)
177 {
178         __ip6_dst_store(sk, dst, daddr, saddr);
179
180 #ifdef CONFIG_XFRM
181         {
182                 struct rt6_info *rt = (struct rt6_info  *)dst;
183                 rt->rt6i_flow_cache_genid = atomic_read(&flow_cache_genid);
184         }
185 #endif
186 }
187
188 static inline
189 struct dst_entry *__inet6_csk_dst_check(struct sock *sk, u32 cookie)
190 {
191         struct dst_entry *dst;
192
193         dst = __sk_dst_check(sk, cookie);
194
195 #ifdef CONFIG_XFRM
196         if (dst) {
197                 struct rt6_info *rt = (struct rt6_info *)dst;
198                 if (rt->rt6i_flow_cache_genid != atomic_read(&flow_cache_genid)) {
199                         __sk_dst_reset(sk);
200                         dst = NULL;
201                 }
202         }
203 #endif
204
205         return dst;
206 }
207
208 int inet6_csk_xmit(struct sk_buff *skb, struct flowi *fl_unused)
209 {
210         struct sock *sk = skb->sk;
211         struct inet_sock *inet = inet_sk(sk);
212         struct ipv6_pinfo *np = inet6_sk(sk);
213         struct flowi6 fl6;
214         struct dst_entry *dst;
215         struct in6_addr *final_p, final;
216         int res;
217
218         memset(&fl6, 0, sizeof(fl6));
219         fl6.flowi6_proto = sk->sk_protocol;
220         ipv6_addr_copy(&fl6.daddr, &np->daddr);
221         ipv6_addr_copy(&fl6.saddr, &np->saddr);
222         fl6.flowlabel = np->flow_label;
223         IP6_ECN_flow_xmit(sk, fl6.flowlabel);
224         fl6.flowi6_oif = sk->sk_bound_dev_if;
225         fl6.flowi6_mark = sk->sk_mark;
226         fl6.fl6_sport = inet->inet_sport;
227         fl6.fl6_dport = inet->inet_dport;
228         security_sk_classify_flow(sk, flowi6_to_flowi(&fl6));
229
230         rcu_read_lock();
231         final_p = fl6_update_dst(&fl6, rcu_dereference(np->opt), &final);
232         rcu_read_unlock();
233
234         dst = __inet6_csk_dst_check(sk, np->dst_cookie);
235
236         if (dst == NULL) {
237                 dst = ip6_dst_lookup_flow(sk, &fl6, final_p, false);
238
239                 if (IS_ERR(dst)) {
240                         sk->sk_err_soft = -PTR_ERR(dst);
241                         sk->sk_route_caps = 0;
242                         kfree_skb(skb);
243                         return PTR_ERR(dst);
244                 }
245
246                 __inet6_csk_dst_store(sk, dst, NULL, NULL);
247         }
248
249         rcu_read_lock();
250         skb_dst_set_noref(skb, dst);
251
252         /* Restore final destination back after routing done */
253         ipv6_addr_copy(&fl6.daddr, &np->daddr);
254
255         res = ip6_xmit(sk, skb, &fl6, rcu_dereference(np->opt),
256                        np->tclass);
257         rcu_read_unlock();
258         return res;
259 }
260 EXPORT_SYMBOL_GPL(inet6_csk_xmit);