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