These changes are the raw update to linux-4.4.6-rt14. Kernel sources
[kvmfornfv.git] / kernel / net / netfilter / ipvs / ip_vs_proto_udp.c
1 /*
2  * ip_vs_proto_udp.c:   UDP load balancing support for IPVS
3  *
4  * Authors:     Wensong Zhang <wensong@linuxvirtualserver.org>
5  *              Julian Anastasov <ja@ssi.bg>
6  *
7  *              This program is free software; you can redistribute it and/or
8  *              modify it under the terms of the GNU General Public License
9  *              as published by the Free Software Foundation; either version
10  *              2 of the License, or (at your option) any later version.
11  *
12  * Changes:     Hans Schillstrom <hans.schillstrom@ericsson.com>
13  *              Network name space (netns) aware.
14  *
15  */
16
17 #define KMSG_COMPONENT "IPVS"
18 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
19
20 #include <linux/in.h>
21 #include <linux/ip.h>
22 #include <linux/kernel.h>
23 #include <linux/netfilter.h>
24 #include <linux/netfilter_ipv4.h>
25 #include <linux/udp.h>
26
27 #include <net/ip_vs.h>
28 #include <net/ip.h>
29 #include <net/ip6_checksum.h>
30
31 static int
32 udp_conn_schedule(struct netns_ipvs *ipvs, int af, struct sk_buff *skb,
33                   struct ip_vs_proto_data *pd,
34                   int *verdict, struct ip_vs_conn **cpp,
35                   struct ip_vs_iphdr *iph)
36 {
37         struct ip_vs_service *svc;
38         struct udphdr _udph, *uh;
39         __be16 _ports[2], *ports = NULL;
40
41         if (likely(!ip_vs_iph_icmp(iph))) {
42                 /* IPv6 fragments, only first fragment will hit this */
43                 uh = skb_header_pointer(skb, iph->len, sizeof(_udph), &_udph);
44                 if (uh)
45                         ports = &uh->source;
46         } else {
47                 ports = skb_header_pointer(
48                         skb, iph->len, sizeof(_ports), &_ports);
49         }
50
51         if (!ports) {
52                 *verdict = NF_DROP;
53                 return 0;
54         }
55
56         rcu_read_lock();
57         if (likely(!ip_vs_iph_inverse(iph)))
58                 svc = ip_vs_service_find(ipvs, af, skb->mark, iph->protocol,
59                                          &iph->daddr, ports[1]);
60         else
61                 svc = ip_vs_service_find(ipvs, af, skb->mark, iph->protocol,
62                                          &iph->saddr, ports[0]);
63
64         if (svc) {
65                 int ignored;
66
67                 if (ip_vs_todrop(ipvs)) {
68                         /*
69                          * It seems that we are very loaded.
70                          * We have to drop this packet :(
71                          */
72                         rcu_read_unlock();
73                         *verdict = NF_DROP;
74                         return 0;
75                 }
76
77                 /*
78                  * Let the virtual server select a real server for the
79                  * incoming connection, and create a connection entry.
80                  */
81                 *cpp = ip_vs_schedule(svc, skb, pd, &ignored, iph);
82                 if (!*cpp && ignored <= 0) {
83                         if (!ignored)
84                                 *verdict = ip_vs_leave(svc, skb, pd, iph);
85                         else
86                                 *verdict = NF_DROP;
87                         rcu_read_unlock();
88                         return 0;
89                 }
90         }
91         rcu_read_unlock();
92         /* NF_ACCEPT */
93         return 1;
94 }
95
96
97 static inline void
98 udp_fast_csum_update(int af, struct udphdr *uhdr,
99                      const union nf_inet_addr *oldip,
100                      const union nf_inet_addr *newip,
101                      __be16 oldport, __be16 newport)
102 {
103 #ifdef CONFIG_IP_VS_IPV6
104         if (af == AF_INET6)
105                 uhdr->check =
106                         csum_fold(ip_vs_check_diff16(oldip->ip6, newip->ip6,
107                                          ip_vs_check_diff2(oldport, newport,
108                                                 ~csum_unfold(uhdr->check))));
109         else
110 #endif
111                 uhdr->check =
112                         csum_fold(ip_vs_check_diff4(oldip->ip, newip->ip,
113                                          ip_vs_check_diff2(oldport, newport,
114                                                 ~csum_unfold(uhdr->check))));
115         if (!uhdr->check)
116                 uhdr->check = CSUM_MANGLED_0;
117 }
118
119 static inline void
120 udp_partial_csum_update(int af, struct udphdr *uhdr,
121                      const union nf_inet_addr *oldip,
122                      const union nf_inet_addr *newip,
123                      __be16 oldlen, __be16 newlen)
124 {
125 #ifdef CONFIG_IP_VS_IPV6
126         if (af == AF_INET6)
127                 uhdr->check =
128                         ~csum_fold(ip_vs_check_diff16(oldip->ip6, newip->ip6,
129                                          ip_vs_check_diff2(oldlen, newlen,
130                                                 csum_unfold(uhdr->check))));
131         else
132 #endif
133         uhdr->check =
134                 ~csum_fold(ip_vs_check_diff4(oldip->ip, newip->ip,
135                                 ip_vs_check_diff2(oldlen, newlen,
136                                                 csum_unfold(uhdr->check))));
137 }
138
139
140 static int
141 udp_snat_handler(struct sk_buff *skb, struct ip_vs_protocol *pp,
142                  struct ip_vs_conn *cp, struct ip_vs_iphdr *iph)
143 {
144         struct udphdr *udph;
145         unsigned int udphoff = iph->len;
146         int oldlen;
147         int payload_csum = 0;
148
149 #ifdef CONFIG_IP_VS_IPV6
150         if (cp->af == AF_INET6 && iph->fragoffs)
151                 return 1;
152 #endif
153         oldlen = skb->len - udphoff;
154
155         /* csum_check requires unshared skb */
156         if (!skb_make_writable(skb, udphoff+sizeof(*udph)))
157                 return 0;
158
159         if (unlikely(cp->app != NULL)) {
160                 int ret;
161
162                 /* Some checks before mangling */
163                 if (pp->csum_check && !pp->csum_check(cp->af, skb, pp))
164                         return 0;
165
166                 /*
167                  *      Call application helper if needed
168                  */
169                 if (!(ret = ip_vs_app_pkt_out(cp, skb)))
170                         return 0;
171                 /* ret=2: csum update is needed after payload mangling */
172                 if (ret == 1)
173                         oldlen = skb->len - udphoff;
174                 else
175                         payload_csum = 1;
176         }
177
178         udph = (void *)skb_network_header(skb) + udphoff;
179         udph->source = cp->vport;
180
181         /*
182          *      Adjust UDP checksums
183          */
184         if (skb->ip_summed == CHECKSUM_PARTIAL) {
185                 udp_partial_csum_update(cp->af, udph, &cp->daddr, &cp->vaddr,
186                                         htons(oldlen),
187                                         htons(skb->len - udphoff));
188         } else if (!payload_csum && (udph->check != 0)) {
189                 /* Only port and addr are changed, do fast csum update */
190                 udp_fast_csum_update(cp->af, udph, &cp->daddr, &cp->vaddr,
191                                      cp->dport, cp->vport);
192                 if (skb->ip_summed == CHECKSUM_COMPLETE)
193                         skb->ip_summed = (cp->app && pp->csum_check) ?
194                                          CHECKSUM_UNNECESSARY : CHECKSUM_NONE;
195         } else {
196                 /* full checksum calculation */
197                 udph->check = 0;
198                 skb->csum = skb_checksum(skb, udphoff, skb->len - udphoff, 0);
199 #ifdef CONFIG_IP_VS_IPV6
200                 if (cp->af == AF_INET6)
201                         udph->check = csum_ipv6_magic(&cp->vaddr.in6,
202                                                       &cp->caddr.in6,
203                                                       skb->len - udphoff,
204                                                       cp->protocol, skb->csum);
205                 else
206 #endif
207                         udph->check = csum_tcpudp_magic(cp->vaddr.ip,
208                                                         cp->caddr.ip,
209                                                         skb->len - udphoff,
210                                                         cp->protocol,
211                                                         skb->csum);
212                 if (udph->check == 0)
213                         udph->check = CSUM_MANGLED_0;
214                 skb->ip_summed = CHECKSUM_UNNECESSARY;
215                 IP_VS_DBG(11, "O-pkt: %s O-csum=%d (+%zd)\n",
216                           pp->name, udph->check,
217                           (char*)&(udph->check) - (char*)udph);
218         }
219         return 1;
220 }
221
222
223 static int
224 udp_dnat_handler(struct sk_buff *skb, struct ip_vs_protocol *pp,
225                  struct ip_vs_conn *cp, struct ip_vs_iphdr *iph)
226 {
227         struct udphdr *udph;
228         unsigned int udphoff = iph->len;
229         int oldlen;
230         int payload_csum = 0;
231
232 #ifdef CONFIG_IP_VS_IPV6
233         if (cp->af == AF_INET6 && iph->fragoffs)
234                 return 1;
235 #endif
236         oldlen = skb->len - udphoff;
237
238         /* csum_check requires unshared skb */
239         if (!skb_make_writable(skb, udphoff+sizeof(*udph)))
240                 return 0;
241
242         if (unlikely(cp->app != NULL)) {
243                 int ret;
244
245                 /* Some checks before mangling */
246                 if (pp->csum_check && !pp->csum_check(cp->af, skb, pp))
247                         return 0;
248
249                 /*
250                  *      Attempt ip_vs_app call.
251                  *      It will fix ip_vs_conn
252                  */
253                 if (!(ret = ip_vs_app_pkt_in(cp, skb)))
254                         return 0;
255                 /* ret=2: csum update is needed after payload mangling */
256                 if (ret == 1)
257                         oldlen = skb->len - udphoff;
258                 else
259                         payload_csum = 1;
260         }
261
262         udph = (void *)skb_network_header(skb) + udphoff;
263         udph->dest = cp->dport;
264
265         /*
266          *      Adjust UDP checksums
267          */
268         if (skb->ip_summed == CHECKSUM_PARTIAL) {
269                 udp_partial_csum_update(cp->af, udph, &cp->vaddr, &cp->daddr,
270                                         htons(oldlen),
271                                         htons(skb->len - udphoff));
272         } else if (!payload_csum && (udph->check != 0)) {
273                 /* Only port and addr are changed, do fast csum update */
274                 udp_fast_csum_update(cp->af, udph, &cp->vaddr, &cp->daddr,
275                                      cp->vport, cp->dport);
276                 if (skb->ip_summed == CHECKSUM_COMPLETE)
277                         skb->ip_summed = (cp->app && pp->csum_check) ?
278                                          CHECKSUM_UNNECESSARY : CHECKSUM_NONE;
279         } else {
280                 /* full checksum calculation */
281                 udph->check = 0;
282                 skb->csum = skb_checksum(skb, udphoff, skb->len - udphoff, 0);
283 #ifdef CONFIG_IP_VS_IPV6
284                 if (cp->af == AF_INET6)
285                         udph->check = csum_ipv6_magic(&cp->caddr.in6,
286                                                       &cp->daddr.in6,
287                                                       skb->len - udphoff,
288                                                       cp->protocol, skb->csum);
289                 else
290 #endif
291                         udph->check = csum_tcpudp_magic(cp->caddr.ip,
292                                                         cp->daddr.ip,
293                                                         skb->len - udphoff,
294                                                         cp->protocol,
295                                                         skb->csum);
296                 if (udph->check == 0)
297                         udph->check = CSUM_MANGLED_0;
298                 skb->ip_summed = CHECKSUM_UNNECESSARY;
299         }
300         return 1;
301 }
302
303
304 static int
305 udp_csum_check(int af, struct sk_buff *skb, struct ip_vs_protocol *pp)
306 {
307         struct udphdr _udph, *uh;
308         unsigned int udphoff;
309
310 #ifdef CONFIG_IP_VS_IPV6
311         if (af == AF_INET6)
312                 udphoff = sizeof(struct ipv6hdr);
313         else
314 #endif
315                 udphoff = ip_hdrlen(skb);
316
317         uh = skb_header_pointer(skb, udphoff, sizeof(_udph), &_udph);
318         if (uh == NULL)
319                 return 0;
320
321         if (uh->check != 0) {
322                 switch (skb->ip_summed) {
323                 case CHECKSUM_NONE:
324                         skb->csum = skb_checksum(skb, udphoff,
325                                                  skb->len - udphoff, 0);
326                 case CHECKSUM_COMPLETE:
327 #ifdef CONFIG_IP_VS_IPV6
328                         if (af == AF_INET6) {
329                                 if (csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
330                                                     &ipv6_hdr(skb)->daddr,
331                                                     skb->len - udphoff,
332                                                     ipv6_hdr(skb)->nexthdr,
333                                                     skb->csum)) {
334                                         IP_VS_DBG_RL_PKT(0, af, pp, skb, 0,
335                                                          "Failed checksum for");
336                                         return 0;
337                                 }
338                         } else
339 #endif
340                                 if (csum_tcpudp_magic(ip_hdr(skb)->saddr,
341                                                       ip_hdr(skb)->daddr,
342                                                       skb->len - udphoff,
343                                                       ip_hdr(skb)->protocol,
344                                                       skb->csum)) {
345                                         IP_VS_DBG_RL_PKT(0, af, pp, skb, 0,
346                                                          "Failed checksum for");
347                                         return 0;
348                                 }
349                         break;
350                 default:
351                         /* No need to checksum. */
352                         break;
353                 }
354         }
355         return 1;
356 }
357
358 static inline __u16 udp_app_hashkey(__be16 port)
359 {
360         return (((__force u16)port >> UDP_APP_TAB_BITS) ^ (__force u16)port)
361                 & UDP_APP_TAB_MASK;
362 }
363
364
365 static int udp_register_app(struct netns_ipvs *ipvs, struct ip_vs_app *inc)
366 {
367         struct ip_vs_app *i;
368         __u16 hash;
369         __be16 port = inc->port;
370         int ret = 0;
371         struct ip_vs_proto_data *pd = ip_vs_proto_data_get(ipvs, IPPROTO_UDP);
372
373         hash = udp_app_hashkey(port);
374
375         list_for_each_entry(i, &ipvs->udp_apps[hash], p_list) {
376                 if (i->port == port) {
377                         ret = -EEXIST;
378                         goto out;
379                 }
380         }
381         list_add_rcu(&inc->p_list, &ipvs->udp_apps[hash]);
382         atomic_inc(&pd->appcnt);
383
384   out:
385         return ret;
386 }
387
388
389 static void
390 udp_unregister_app(struct netns_ipvs *ipvs, struct ip_vs_app *inc)
391 {
392         struct ip_vs_proto_data *pd = ip_vs_proto_data_get(ipvs, IPPROTO_UDP);
393
394         atomic_dec(&pd->appcnt);
395         list_del_rcu(&inc->p_list);
396 }
397
398
399 static int udp_app_conn_bind(struct ip_vs_conn *cp)
400 {
401         struct netns_ipvs *ipvs = cp->ipvs;
402         int hash;
403         struct ip_vs_app *inc;
404         int result = 0;
405
406         /* Default binding: bind app only for NAT */
407         if (IP_VS_FWD_METHOD(cp) != IP_VS_CONN_F_MASQ)
408                 return 0;
409
410         /* Lookup application incarnations and bind the right one */
411         hash = udp_app_hashkey(cp->vport);
412
413         rcu_read_lock();
414         list_for_each_entry_rcu(inc, &ipvs->udp_apps[hash], p_list) {
415                 if (inc->port == cp->vport) {
416                         if (unlikely(!ip_vs_app_inc_get(inc)))
417                                 break;
418                         rcu_read_unlock();
419
420                         IP_VS_DBG_BUF(9, "%s(): Binding conn %s:%u->"
421                                       "%s:%u to app %s on port %u\n",
422                                       __func__,
423                                       IP_VS_DBG_ADDR(cp->af, &cp->caddr),
424                                       ntohs(cp->cport),
425                                       IP_VS_DBG_ADDR(cp->af, &cp->vaddr),
426                                       ntohs(cp->vport),
427                                       inc->name, ntohs(inc->port));
428
429                         cp->app = inc;
430                         if (inc->init_conn)
431                                 result = inc->init_conn(inc, cp);
432                         goto out;
433                 }
434         }
435         rcu_read_unlock();
436
437   out:
438         return result;
439 }
440
441
442 static const int udp_timeouts[IP_VS_UDP_S_LAST+1] = {
443         [IP_VS_UDP_S_NORMAL]            =       5*60*HZ,
444         [IP_VS_UDP_S_LAST]              =       2*HZ,
445 };
446
447 static const char *const udp_state_name_table[IP_VS_UDP_S_LAST+1] = {
448         [IP_VS_UDP_S_NORMAL]            =       "UDP",
449         [IP_VS_UDP_S_LAST]              =       "BUG!",
450 };
451
452 static const char * udp_state_name(int state)
453 {
454         if (state >= IP_VS_UDP_S_LAST)
455                 return "ERR!";
456         return udp_state_name_table[state] ? udp_state_name_table[state] : "?";
457 }
458
459 static void
460 udp_state_transition(struct ip_vs_conn *cp, int direction,
461                      const struct sk_buff *skb,
462                      struct ip_vs_proto_data *pd)
463 {
464         if (unlikely(!pd)) {
465                 pr_err("UDP no ns data\n");
466                 return;
467         }
468
469         cp->timeout = pd->timeout_table[IP_VS_UDP_S_NORMAL];
470 }
471
472 static int __udp_init(struct netns_ipvs *ipvs, struct ip_vs_proto_data *pd)
473 {
474         ip_vs_init_hash_table(ipvs->udp_apps, UDP_APP_TAB_SIZE);
475         pd->timeout_table = ip_vs_create_timeout_table((int *)udp_timeouts,
476                                                         sizeof(udp_timeouts));
477         if (!pd->timeout_table)
478                 return -ENOMEM;
479         return 0;
480 }
481
482 static void __udp_exit(struct netns_ipvs *ipvs, struct ip_vs_proto_data *pd)
483 {
484         kfree(pd->timeout_table);
485 }
486
487
488 struct ip_vs_protocol ip_vs_protocol_udp = {
489         .name =                 "UDP",
490         .protocol =             IPPROTO_UDP,
491         .num_states =           IP_VS_UDP_S_LAST,
492         .dont_defrag =          0,
493         .init =                 NULL,
494         .exit =                 NULL,
495         .init_netns =           __udp_init,
496         .exit_netns =           __udp_exit,
497         .conn_schedule =        udp_conn_schedule,
498         .conn_in_get =          ip_vs_conn_in_get_proto,
499         .conn_out_get =         ip_vs_conn_out_get_proto,
500         .snat_handler =         udp_snat_handler,
501         .dnat_handler =         udp_dnat_handler,
502         .csum_check =           udp_csum_check,
503         .state_transition =     udp_state_transition,
504         .state_name =           udp_state_name,
505         .register_app =         udp_register_app,
506         .unregister_app =       udp_unregister_app,
507         .app_conn_bind =        udp_app_conn_bind,
508         .debug_packet =         ip_vs_tcpudp_debug_packet,
509         .timeout_change =       NULL,
510 };