1 /* SIP extension for IP connection tracking.
2  *
3  * (C) 2005 by Christian Hentschel <chentschel@arnet.com.ar>
4  * based on RR's ip_conntrack_ftp.c and other modules.
5  * (C) 2007 United Security Providers
6  * (C) 2007, 2008 Patrick McHardy <kaber@trash.net>
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  */
12 
13 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
14 
15 #include <linux/module.h>
16 #include <linux/ctype.h>
17 #include <linux/skbuff.h>
18 #include <linux/inet.h>
19 #include <linux/in.h>
20 #include <linux/udp.h>
21 #include <linux/tcp.h>
22 #include <linux/netfilter.h>
23 
24 #include <net/netfilter/nf_conntrack.h>
25 #include <net/netfilter/nf_conntrack_core.h>
26 #include <net/netfilter/nf_conntrack_expect.h>
27 #include <net/netfilter/nf_conntrack_helper.h>
28 #include <net/netfilter/nf_conntrack_zones.h>
29 #include <linux/netfilter/nf_conntrack_sip.h>
30 
31 MODULE_LICENSE("GPL");
32 MODULE_AUTHOR("Christian Hentschel <chentschel@arnet.com.ar>");
33 MODULE_DESCRIPTION("SIP connection tracking helper");
34 MODULE_ALIAS("ip_conntrack_sip");
35 MODULE_ALIAS_NFCT_HELPER("sip");
36 
37 #define MAX_PORTS	8
38 static unsigned short ports[MAX_PORTS];
39 static unsigned int ports_c;
40 module_param_array(ports, ushort, &ports_c, 0400);
41 MODULE_PARM_DESC(ports, "port numbers of SIP servers");
42 
43 static unsigned int sip_timeout __read_mostly = SIP_TIMEOUT;
44 module_param(sip_timeout, uint, 0600);
45 MODULE_PARM_DESC(sip_timeout, "timeout for the master SIP session");
46 
47 static int sip_direct_signalling __read_mostly = 1;
48 module_param(sip_direct_signalling, int, 0600);
49 MODULE_PARM_DESC(sip_direct_signalling, "expect incoming calls from registrar "
50 					"only (default 1)");
51 
52 static int sip_direct_media __read_mostly = 1;
53 module_param(sip_direct_media, int, 0600);
54 MODULE_PARM_DESC(sip_direct_media, "Expect Media streams between signalling "
55 				   "endpoints only (default 1)");
56 
57 const struct nf_nat_sip_hooks *nf_nat_sip_hooks;
58 EXPORT_SYMBOL_GPL(nf_nat_sip_hooks);
59 
60 static int string_len(const struct nf_conn *ct, const char *dptr,
61 		      const char *limit, int *shift)
62 {
63 	int len = 0;
64 
65 	while (dptr < limit && isalpha(*dptr)) {
66 		dptr++;
67 		len++;
68 	}
69 	return len;
70 }
71 
72 static int digits_len(const struct nf_conn *ct, const char *dptr,
73 		      const char *limit, int *shift)
74 {
75 	int len = 0;
76 	while (dptr < limit && isdigit(*dptr)) {
77 		dptr++;
78 		len++;
79 	}
80 	return len;
81 }
82 
83 static int iswordc(const char c)
84 {
85 	if (isalnum(c) || c == '!' || c == '"' || c == '%' ||
86 	    (c >= '(' && c <= '/') || c == ':' || c == '<' || c == '>' ||
87 	    c == '?' || (c >= '[' && c <= ']') || c == '_' || c == '`' ||
88 	    c == '{' || c == '}' || c == '~')
89 		return 1;
90 	return 0;
91 }
92 
93 static int word_len(const char *dptr, const char *limit)
94 {
95 	int len = 0;
96 	while (dptr < limit && iswordc(*dptr)) {
97 		dptr++;
98 		len++;
99 	}
100 	return len;
101 }
102 
103 static int callid_len(const struct nf_conn *ct, const char *dptr,
104 		      const char *limit, int *shift)
105 {
106 	int len, domain_len;
107 
108 	len = word_len(dptr, limit);
109 	dptr += len;
110 	if (!len || dptr == limit || *dptr != '@')
111 		return len;
112 	dptr++;
113 	len++;
114 
115 	domain_len = word_len(dptr, limit);
116 	if (!domain_len)
117 		return 0;
118 	return len + domain_len;
119 }
120 
121 /* get media type + port length */
122 static int media_len(const struct nf_conn *ct, const char *dptr,
123 		     const char *limit, int *shift)
124 {
125 	int len = string_len(ct, dptr, limit, shift);
126 
127 	dptr += len;
128 	if (dptr >= limit || *dptr != ' ')
129 		return 0;
130 	len++;
131 	dptr++;
132 
133 	return len + digits_len(ct, dptr, limit, shift);
134 }
135 
136 static int sip_parse_addr(const struct nf_conn *ct, const char *cp,
137 			  const char **endp, union nf_inet_addr *addr,
138 			  const char *limit, bool delim)
139 {
140 	const char *end;
141 	int ret;
142 
143 	if (!ct)
144 		return 0;
145 
146 	memset(addr, 0, sizeof(*addr));
147 	switch (nf_ct_l3num(ct)) {
148 	case AF_INET:
149 		ret = in4_pton(cp, limit - cp, (u8 *)&addr->ip, -1, &end);
150 		if (ret == 0)
151 			return 0;
152 		break;
153 	case AF_INET6:
154 		if (cp < limit && *cp == '[')
155 			cp++;
156 		else if (delim)
157 			return 0;
158 
159 		ret = in6_pton(cp, limit - cp, (u8 *)&addr->ip6, -1, &end);
160 		if (ret == 0)
161 			return 0;
162 
163 		if (end < limit && *end == ']')
164 			end++;
165 		else if (delim)
166 			return 0;
167 		break;
168 	default:
169 		BUG();
170 	}
171 
172 	if (endp)
173 		*endp = end;
174 	return 1;
175 }
176 
177 /* skip ip address. returns its length. */
178 static int epaddr_len(const struct nf_conn *ct, const char *dptr,
179 		      const char *limit, int *shift)
180 {
181 	union nf_inet_addr addr;
182 	const char *aux = dptr;
183 
184 	if (!sip_parse_addr(ct, dptr, &dptr, &addr, limit, true)) {
185 		pr_debug("ip: %s parse failed.!\n", dptr);
186 		return 0;
187 	}
188 
189 	/* Port number */
190 	if (*dptr == ':') {
191 		dptr++;
192 		dptr += digits_len(ct, dptr, limit, shift);
193 	}
194 	return dptr - aux;
195 }
196 
197 /* get address length, skiping user info. */
198 static int skp_epaddr_len(const struct nf_conn *ct, const char *dptr,
199 			  const char *limit, int *shift)
200 {
201 	const char *start = dptr;
202 	int s = *shift;
203 
204 	/* Search for @, but stop at the end of the line.
205 	 * We are inside a sip: URI, so we don't need to worry about
206 	 * continuation lines. */
207 	while (dptr < limit &&
208 	       *dptr != '@' && *dptr != '\r' && *dptr != '\n') {
209 		(*shift)++;
210 		dptr++;
211 	}
212 
213 	if (dptr < limit && *dptr == '@') {
214 		dptr++;
215 		(*shift)++;
216 	} else {
217 		dptr = start;
218 		*shift = s;
219 	}
220 
221 	return epaddr_len(ct, dptr, limit, shift);
222 }
223 
224 /* Parse a SIP request line of the form:
225  *
226  * Request-Line = Method SP Request-URI SP SIP-Version CRLF
227  *
228  * and return the offset and length of the address contained in the Request-URI.
229  */
230 int ct_sip_parse_request(const struct nf_conn *ct,
231 			 const char *dptr, unsigned int datalen,
232 			 unsigned int *matchoff, unsigned int *matchlen,
233 			 union nf_inet_addr *addr, __be16 *port)
234 {
235 	const char *start = dptr, *limit = dptr + datalen, *end;
236 	unsigned int mlen;
237 	unsigned int p;
238 	int shift = 0;
239 
240 	/* Skip method and following whitespace */
241 	mlen = string_len(ct, dptr, limit, NULL);
242 	if (!mlen)
243 		return 0;
244 	dptr += mlen;
245 	if (++dptr >= limit)
246 		return 0;
247 
248 	/* Find SIP URI */
249 	for (; dptr < limit - strlen("sip:"); dptr++) {
250 		if (*dptr == '\r' || *dptr == '\n')
251 			return -1;
252 		if (strncasecmp(dptr, "sip:", strlen("sip:")) == 0) {
253 			dptr += strlen("sip:");
254 			break;
255 		}
256 	}
257 	if (!skp_epaddr_len(ct, dptr, limit, &shift))
258 		return 0;
259 	dptr += shift;
260 
261 	if (!sip_parse_addr(ct, dptr, &end, addr, limit, true))
262 		return -1;
263 	if (end < limit && *end == ':') {
264 		end++;
265 		p = simple_strtoul(end, (char **)&end, 10);
266 		if (p < 1024 || p > 65535)
267 			return -1;
268 		*port = htons(p);
269 	} else
270 		*port = htons(SIP_PORT);
271 
272 	if (end == dptr)
273 		return 0;
274 	*matchoff = dptr - start;
275 	*matchlen = end - dptr;
276 	return 1;
277 }
278 EXPORT_SYMBOL_GPL(ct_sip_parse_request);
279 
280 /* SIP header parsing: SIP headers are located at the beginning of a line, but
281  * may span several lines, in which case the continuation lines begin with a
282  * whitespace character. RFC 2543 allows lines to be terminated with CR, LF or
283  * CRLF, RFC 3261 allows only CRLF, we support both.
284  *
285  * Headers are followed by (optionally) whitespace, a colon, again (optionally)
286  * whitespace and the values. Whitespace in this context means any amount of
287  * tabs, spaces and continuation lines, which are treated as a single whitespace
288  * character.
289  *
290  * Some headers may appear multiple times. A comma separated list of values is
291  * equivalent to multiple headers.
292  */
293 static const struct sip_header ct_sip_hdrs[] = {
294 	[SIP_HDR_CSEQ]			= SIP_HDR("CSeq", NULL, NULL, digits_len),
295 	[SIP_HDR_FROM]			= SIP_HDR("From", "f", "sip:", skp_epaddr_len),
296 	[SIP_HDR_TO]			= SIP_HDR("To", "t", "sip:", skp_epaddr_len),
297 	[SIP_HDR_CONTACT]		= SIP_HDR("Contact", "m", "sip:", skp_epaddr_len),
298 	[SIP_HDR_VIA_UDP]		= SIP_HDR("Via", "v", "UDP ", epaddr_len),
299 	[SIP_HDR_VIA_TCP]		= SIP_HDR("Via", "v", "TCP ", epaddr_len),
300 	[SIP_HDR_EXPIRES]		= SIP_HDR("Expires", NULL, NULL, digits_len),
301 	[SIP_HDR_CONTENT_LENGTH]	= SIP_HDR("Content-Length", "l", NULL, digits_len),
302 	[SIP_HDR_CALL_ID]		= SIP_HDR("Call-Id", "i", NULL, callid_len),
303 };
304 
305 static const char *sip_follow_continuation(const char *dptr, const char *limit)
306 {
307 	/* Walk past newline */
308 	if (++dptr >= limit)
309 		return NULL;
310 
311 	/* Skip '\n' in CR LF */
312 	if (*(dptr - 1) == '\r' && *dptr == '\n') {
313 		if (++dptr >= limit)
314 			return NULL;
315 	}
316 
317 	/* Continuation line? */
318 	if (*dptr != ' ' && *dptr != '\t')
319 		return NULL;
320 
321 	/* skip leading whitespace */
322 	for (; dptr < limit; dptr++) {
323 		if (*dptr != ' ' && *dptr != '\t')
324 			break;
325 	}
326 	return dptr;
327 }
328 
329 static const char *sip_skip_whitespace(const char *dptr, const char *limit)
330 {
331 	for (; dptr < limit; dptr++) {
332 		if (*dptr == ' ')
333 			continue;
334 		if (*dptr != '\r' && *dptr != '\n')
335 			break;
336 		dptr = sip_follow_continuation(dptr, limit);
337 		if (dptr == NULL)
338 			return NULL;
339 	}
340 	return dptr;
341 }
342 
343 /* Search within a SIP header value, dealing with continuation lines */
344 static const char *ct_sip_header_search(const char *dptr, const char *limit,
345 					const char *needle, unsigned int len)
346 {
347 	for (limit -= len; dptr < limit; dptr++) {
348 		if (*dptr == '\r' || *dptr == '\n') {
349 			dptr = sip_follow_continuation(dptr, limit);
350 			if (dptr == NULL)
351 				break;
352 			continue;
353 		}
354 
355 		if (strncasecmp(dptr, needle, len) == 0)
356 			return dptr;
357 	}
358 	return NULL;
359 }
360 
361 int ct_sip_get_header(const struct nf_conn *ct, const char *dptr,
362 		      unsigned int dataoff, unsigned int datalen,
363 		      enum sip_header_types type,
364 		      unsigned int *matchoff, unsigned int *matchlen)
365 {
366 	const struct sip_header *hdr = &ct_sip_hdrs[type];
367 	const char *start = dptr, *limit = dptr + datalen;
368 	int shift = 0;
369 
370 	for (dptr += dataoff; dptr < limit; dptr++) {
371 		/* Find beginning of line */
372 		if (*dptr != '\r' && *dptr != '\n')
373 			continue;
374 		if (++dptr >= limit)
375 			break;
376 		if (*(dptr - 1) == '\r' && *dptr == '\n') {
377 			if (++dptr >= limit)
378 				break;
379 		}
380 
381 		/* Skip continuation lines */
382 		if (*dptr == ' ' || *dptr == '\t')
383 			continue;
384 
385 		/* Find header. Compact headers must be followed by a
386 		 * non-alphabetic character to avoid mismatches. */
387 		if (limit - dptr >= hdr->len &&
388 		    strncasecmp(dptr, hdr->name, hdr->len) == 0)
389 			dptr += hdr->len;
390 		else if (hdr->cname && limit - dptr >= hdr->clen + 1 &&
391 			 strncasecmp(dptr, hdr->cname, hdr->clen) == 0 &&
392 			 !isalpha(*(dptr + hdr->clen)))
393 			dptr += hdr->clen;
394 		else
395 			continue;
396 
397 		/* Find and skip colon */
398 		dptr = sip_skip_whitespace(dptr, limit);
399 		if (dptr == NULL)
400 			break;
401 		if (*dptr != ':' || ++dptr >= limit)
402 			break;
403 
404 		/* Skip whitespace after colon */
405 		dptr = sip_skip_whitespace(dptr, limit);
406 		if (dptr == NULL)
407 			break;
408 
409 		*matchoff = dptr - start;
410 		if (hdr->search) {
411 			dptr = ct_sip_header_search(dptr, limit, hdr->search,
412 						    hdr->slen);
413 			if (!dptr)
414 				return -1;
415 			dptr += hdr->slen;
416 		}
417 
418 		*matchlen = hdr->match_len(ct, dptr, limit, &shift);
419 		if (!*matchlen)
420 			return -1;
421 		*matchoff = dptr - start + shift;
422 		return 1;
423 	}
424 	return 0;
425 }
426 EXPORT_SYMBOL_GPL(ct_sip_get_header);
427 
428 /* Get next header field in a list of comma separated values */
429 static int ct_sip_next_header(const struct nf_conn *ct, const char *dptr,
430 			      unsigned int dataoff, unsigned int datalen,
431 			      enum sip_header_types type,
432 			      unsigned int *matchoff, unsigned int *matchlen)
433 {
434 	const struct sip_header *hdr = &ct_sip_hdrs[type];
435 	const char *start = dptr, *limit = dptr + datalen;
436 	int shift = 0;
437 
438 	dptr += dataoff;
439 
440 	dptr = ct_sip_header_search(dptr, limit, ",", strlen(","));
441 	if (!dptr)
442 		return 0;
443 
444 	dptr = ct_sip_header_search(dptr, limit, hdr->search, hdr->slen);
445 	if (!dptr)
446 		return 0;
447 	dptr += hdr->slen;
448 
449 	*matchoff = dptr - start;
450 	*matchlen = hdr->match_len(ct, dptr, limit, &shift);
451 	if (!*matchlen)
452 		return -1;
453 	*matchoff += shift;
454 	return 1;
455 }
456 
457 /* Walk through headers until a parsable one is found or no header of the
458  * given type is left. */
459 static int ct_sip_walk_headers(const struct nf_conn *ct, const char *dptr,
460 			       unsigned int dataoff, unsigned int datalen,
461 			       enum sip_header_types type, int *in_header,
462 			       unsigned int *matchoff, unsigned int *matchlen)
463 {
464 	int ret;
465 
466 	if (in_header && *in_header) {
467 		while (1) {
468 			ret = ct_sip_next_header(ct, dptr, dataoff, datalen,
469 						 type, matchoff, matchlen);
470 			if (ret > 0)
471 				return ret;
472 			if (ret == 0)
473 				break;
474 			dataoff += *matchoff;
475 		}
476 		*in_header = 0;
477 	}
478 
479 	while (1) {
480 		ret = ct_sip_get_header(ct, dptr, dataoff, datalen,
481 					type, matchoff, matchlen);
482 		if (ret > 0)
483 			break;
484 		if (ret == 0)
485 			return ret;
486 		dataoff += *matchoff;
487 	}
488 
489 	if (in_header)
490 		*in_header = 1;
491 	return 1;
492 }
493 
494 /* Locate a SIP header, parse the URI and return the offset and length of
495  * the address as well as the address and port themselves. A stream of
496  * headers can be parsed by handing in a non-NULL datalen and in_header
497  * pointer.
498  */
499 int ct_sip_parse_header_uri(const struct nf_conn *ct, const char *dptr,
500 			    unsigned int *dataoff, unsigned int datalen,
501 			    enum sip_header_types type, int *in_header,
502 			    unsigned int *matchoff, unsigned int *matchlen,
503 			    union nf_inet_addr *addr, __be16 *port)
504 {
505 	const char *c, *limit = dptr + datalen;
506 	unsigned int p;
507 	int ret;
508 
509 	ret = ct_sip_walk_headers(ct, dptr, dataoff ? *dataoff : 0, datalen,
510 				  type, in_header, matchoff, matchlen);
511 	WARN_ON(ret < 0);
512 	if (ret == 0)
513 		return ret;
514 
515 	if (!sip_parse_addr(ct, dptr + *matchoff, &c, addr, limit, true))
516 		return -1;
517 	if (*c == ':') {
518 		c++;
519 		p = simple_strtoul(c, (char **)&c, 10);
520 		if (p < 1024 || p > 65535)
521 			return -1;
522 		*port = htons(p);
523 	} else
524 		*port = htons(SIP_PORT);
525 
526 	if (dataoff)
527 		*dataoff = c - dptr;
528 	return 1;
529 }
530 EXPORT_SYMBOL_GPL(ct_sip_parse_header_uri);
531 
532 static int ct_sip_parse_param(const struct nf_conn *ct, const char *dptr,
533 			      unsigned int dataoff, unsigned int datalen,
534 			      const char *name,
535 			      unsigned int *matchoff, unsigned int *matchlen)
536 {
537 	const char *limit = dptr + datalen;
538 	const char *start;
539 	const char *end;
540 
541 	limit = ct_sip_header_search(dptr + dataoff, limit, ",", strlen(","));
542 	if (!limit)
543 		limit = dptr + datalen;
544 
545 	start = ct_sip_header_search(dptr + dataoff, limit, name, strlen(name));
546 	if (!start)
547 		return 0;
548 	start += strlen(name);
549 
550 	end = ct_sip_header_search(start, limit, ";", strlen(";"));
551 	if (!end)
552 		end = limit;
553 
554 	*matchoff = start - dptr;
555 	*matchlen = end - start;
556 	return 1;
557 }
558 
559 /* Parse address from header parameter and return address, offset and length */
560 int ct_sip_parse_address_param(const struct nf_conn *ct, const char *dptr,
561 			       unsigned int dataoff, unsigned int datalen,
562 			       const char *name,
563 			       unsigned int *matchoff, unsigned int *matchlen,
564 			       union nf_inet_addr *addr, bool delim)
565 {
566 	const char *limit = dptr + datalen;
567 	const char *start, *end;
568 
569 	limit = ct_sip_header_search(dptr + dataoff, limit, ",", strlen(","));
570 	if (!limit)
571 		limit = dptr + datalen;
572 
573 	start = ct_sip_header_search(dptr + dataoff, limit, name, strlen(name));
574 	if (!start)
575 		return 0;
576 
577 	start += strlen(name);
578 	if (!sip_parse_addr(ct, start, &end, addr, limit, delim))
579 		return 0;
580 	*matchoff = start - dptr;
581 	*matchlen = end - start;
582 	return 1;
583 }
584 EXPORT_SYMBOL_GPL(ct_sip_parse_address_param);
585 
586 /* Parse numerical header parameter and return value, offset and length */
587 int ct_sip_parse_numerical_param(const struct nf_conn *ct, const char *dptr,
588 				 unsigned int dataoff, unsigned int datalen,
589 				 const char *name,
590 				 unsigned int *matchoff, unsigned int *matchlen,
591 				 unsigned int *val)
592 {
593 	const char *limit = dptr + datalen;
594 	const char *start;
595 	char *end;
596 
597 	limit = ct_sip_header_search(dptr + dataoff, limit, ",", strlen(","));
598 	if (!limit)
599 		limit = dptr + datalen;
600 
601 	start = ct_sip_header_search(dptr + dataoff, limit, name, strlen(name));
602 	if (!start)
603 		return 0;
604 
605 	start += strlen(name);
606 	*val = simple_strtoul(start, &end, 0);
607 	if (start == end)
608 		return 0;
609 	if (matchoff && matchlen) {
610 		*matchoff = start - dptr;
611 		*matchlen = end - start;
612 	}
613 	return 1;
614 }
615 EXPORT_SYMBOL_GPL(ct_sip_parse_numerical_param);
616 
617 static int ct_sip_parse_transport(struct nf_conn *ct, const char *dptr,
618 				  unsigned int dataoff, unsigned int datalen,
619 				  u8 *proto)
620 {
621 	unsigned int matchoff, matchlen;
622 
623 	if (ct_sip_parse_param(ct, dptr, dataoff, datalen, "transport=",
624 			       &matchoff, &matchlen)) {
625 		if (!strncasecmp(dptr + matchoff, "TCP", strlen("TCP")))
626 			*proto = IPPROTO_TCP;
627 		else if (!strncasecmp(dptr + matchoff, "UDP", strlen("UDP")))
628 			*proto = IPPROTO_UDP;
629 		else
630 			return 0;
631 
632 		if (*proto != nf_ct_protonum(ct))
633 			return 0;
634 	} else
635 		*proto = nf_ct_protonum(ct);
636 
637 	return 1;
638 }
639 
640 static int sdp_parse_addr(const struct nf_conn *ct, const char *cp,
641 			  const char **endp, union nf_inet_addr *addr,
642 			  const char *limit)
643 {
644 	const char *end;
645 	int ret;
646 
647 	memset(addr, 0, sizeof(*addr));
648 	switch (nf_ct_l3num(ct)) {
649 	case AF_INET:
650 		ret = in4_pton(cp, limit - cp, (u8 *)&addr->ip, -1, &end);
651 		break;
652 	case AF_INET6:
653 		ret = in6_pton(cp, limit - cp, (u8 *)&addr->ip6, -1, &end);
654 		break;
655 	default:
656 		BUG();
657 	}
658 
659 	if (ret == 0)
660 		return 0;
661 	if (endp)
662 		*endp = end;
663 	return 1;
664 }
665 
666 /* skip ip address. returns its length. */
667 static int sdp_addr_len(const struct nf_conn *ct, const char *dptr,
668 			const char *limit, int *shift)
669 {
670 	union nf_inet_addr addr;
671 	const char *aux = dptr;
672 
673 	if (!sdp_parse_addr(ct, dptr, &dptr, &addr, limit)) {
674 		pr_debug("ip: %s parse failed.!\n", dptr);
675 		return 0;
676 	}
677 
678 	return dptr - aux;
679 }
680 
681 /* SDP header parsing: a SDP session description contains an ordered set of
682  * headers, starting with a section containing general session parameters,
683  * optionally followed by multiple media descriptions.
684  *
685  * SDP headers always start at the beginning of a line. According to RFC 2327:
686  * "The sequence CRLF (0x0d0a) is used to end a record, although parsers should
687  * be tolerant and also accept records terminated with a single newline
688  * character". We handle both cases.
689  */
690 static const struct sip_header ct_sdp_hdrs_v4[] = {
691 	[SDP_HDR_VERSION]	= SDP_HDR("v=", NULL, digits_len),
692 	[SDP_HDR_OWNER]		= SDP_HDR("o=", "IN IP4 ", sdp_addr_len),
693 	[SDP_HDR_CONNECTION]	= SDP_HDR("c=", "IN IP4 ", sdp_addr_len),
694 	[SDP_HDR_MEDIA]		= SDP_HDR("m=", NULL, media_len),
695 };
696 
697 static const struct sip_header ct_sdp_hdrs_v6[] = {
698 	[SDP_HDR_VERSION]	= SDP_HDR("v=", NULL, digits_len),
699 	[SDP_HDR_OWNER]		= SDP_HDR("o=", "IN IP6 ", sdp_addr_len),
700 	[SDP_HDR_CONNECTION]	= SDP_HDR("c=", "IN IP6 ", sdp_addr_len),
701 	[SDP_HDR_MEDIA]		= SDP_HDR("m=", NULL, media_len),
702 };
703 
704 /* Linear string search within SDP header values */
705 static const char *ct_sdp_header_search(const char *dptr, const char *limit,
706 					const char *needle, unsigned int len)
707 {
708 	for (limit -= len; dptr < limit; dptr++) {
709 		if (*dptr == '\r' || *dptr == '\n')
710 			break;
711 		if (strncmp(dptr, needle, len) == 0)
712 			return dptr;
713 	}
714 	return NULL;
715 }
716 
717 /* Locate a SDP header (optionally a substring within the header value),
718  * optionally stopping at the first occurrence of the term header, parse
719  * it and return the offset and length of the data we're interested in.
720  */
721 int ct_sip_get_sdp_header(const struct nf_conn *ct, const char *dptr,
722 			  unsigned int dataoff, unsigned int datalen,
723 			  enum sdp_header_types type,
724 			  enum sdp_header_types term,
725 			  unsigned int *matchoff, unsigned int *matchlen)
726 {
727 	const struct sip_header *hdrs, *hdr, *thdr;
728 	const char *start = dptr, *limit = dptr + datalen;
729 	int shift = 0;
730 
731 	hdrs = nf_ct_l3num(ct) == NFPROTO_IPV4 ? ct_sdp_hdrs_v4 : ct_sdp_hdrs_v6;
732 	hdr = &hdrs[type];
733 	thdr = &hdrs[term];
734 
735 	for (dptr += dataoff; dptr < limit; dptr++) {
736 		/* Find beginning of line */
737 		if (*dptr != '\r' && *dptr != '\n')
738 			continue;
739 		if (++dptr >= limit)
740 			break;
741 		if (*(dptr - 1) == '\r' && *dptr == '\n') {
742 			if (++dptr >= limit)
743 				break;
744 		}
745 
746 		if (term != SDP_HDR_UNSPEC &&
747 		    limit - dptr >= thdr->len &&
748 		    strncasecmp(dptr, thdr->name, thdr->len) == 0)
749 			break;
750 		else if (limit - dptr >= hdr->len &&
751 			 strncasecmp(dptr, hdr->name, hdr->len) == 0)
752 			dptr += hdr->len;
753 		else
754 			continue;
755 
756 		*matchoff = dptr - start;
757 		if (hdr->search) {
758 			dptr = ct_sdp_header_search(dptr, limit, hdr->search,
759 						    hdr->slen);
760 			if (!dptr)
761 				return -1;
762 			dptr += hdr->slen;
763 		}
764 
765 		*matchlen = hdr->match_len(ct, dptr, limit, &shift);
766 		if (!*matchlen)
767 			return -1;
768 		*matchoff = dptr - start + shift;
769 		return 1;
770 	}
771 	return 0;
772 }
773 EXPORT_SYMBOL_GPL(ct_sip_get_sdp_header);
774 
775 static int ct_sip_parse_sdp_addr(const struct nf_conn *ct, const char *dptr,
776 				 unsigned int dataoff, unsigned int datalen,
777 				 enum sdp_header_types type,
778 				 enum sdp_header_types term,
779 				 unsigned int *matchoff, unsigned int *matchlen,
780 				 union nf_inet_addr *addr)
781 {
782 	int ret;
783 
784 	ret = ct_sip_get_sdp_header(ct, dptr, dataoff, datalen, type, term,
785 				    matchoff, matchlen);
786 	if (ret <= 0)
787 		return ret;
788 
789 	if (!sdp_parse_addr(ct, dptr + *matchoff, NULL, addr,
790 			    dptr + *matchoff + *matchlen))
791 		return -1;
792 	return 1;
793 }
794 
795 static int refresh_signalling_expectation(struct nf_conn *ct,
796 					  union nf_inet_addr *addr,
797 					  u8 proto, __be16 port,
798 					  unsigned int expires)
799 {
800 	struct nf_conn_help *help = nfct_help(ct);
801 	struct nf_conntrack_expect *exp;
802 	struct hlist_node *next;
803 	int found = 0;
804 
805 	spin_lock_bh(&nf_conntrack_expect_lock);
806 	hlist_for_each_entry_safe(exp, next, &help->expectations, lnode) {
807 		if (exp->class != SIP_EXPECT_SIGNALLING ||
808 		    !nf_inet_addr_cmp(&exp->tuple.dst.u3, addr) ||
809 		    exp->tuple.dst.protonum != proto ||
810 		    exp->tuple.dst.u.udp.port != port)
811 			continue;
812 		if (!del_timer(&exp->timeout))
813 			continue;
814 		exp->flags &= ~NF_CT_EXPECT_INACTIVE;
815 		exp->timeout.expires = jiffies + expires * HZ;
816 		add_timer(&exp->timeout);
817 		found = 1;
818 		break;
819 	}
820 	spin_unlock_bh(&nf_conntrack_expect_lock);
821 	return found;
822 }
823 
824 static void flush_expectations(struct nf_conn *ct, bool media)
825 {
826 	struct nf_conn_help *help = nfct_help(ct);
827 	struct nf_conntrack_expect *exp;
828 	struct hlist_node *next;
829 
830 	spin_lock_bh(&nf_conntrack_expect_lock);
831 	hlist_for_each_entry_safe(exp, next, &help->expectations, lnode) {
832 		if ((exp->class != SIP_EXPECT_SIGNALLING) ^ media)
833 			continue;
834 		if (!del_timer(&exp->timeout))
835 			continue;
836 		nf_ct_unlink_expect(exp);
837 		nf_ct_expect_put(exp);
838 		if (!media)
839 			break;
840 	}
841 	spin_unlock_bh(&nf_conntrack_expect_lock);
842 }
843 
844 static int set_expected_rtp_rtcp(struct sk_buff *skb, unsigned int protoff,
845 				 unsigned int dataoff,
846 				 const char **dptr, unsigned int *datalen,
847 				 union nf_inet_addr *daddr, __be16 port,
848 				 enum sip_expectation_classes class,
849 				 unsigned int mediaoff, unsigned int medialen)
850 {
851 	struct nf_conntrack_expect *exp, *rtp_exp, *rtcp_exp;
852 	enum ip_conntrack_info ctinfo;
853 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
854 	struct net *net = nf_ct_net(ct);
855 	enum ip_conntrack_dir dir = CTINFO2DIR(ctinfo);
856 	union nf_inet_addr *saddr;
857 	struct nf_conntrack_tuple tuple;
858 	int direct_rtp = 0, skip_expect = 0, ret = NF_DROP;
859 	u_int16_t base_port;
860 	__be16 rtp_port, rtcp_port;
861 	const struct nf_nat_sip_hooks *hooks;
862 
863 	saddr = NULL;
864 	if (sip_direct_media) {
865 		if (!nf_inet_addr_cmp(daddr, &ct->tuplehash[dir].tuple.src.u3))
866 			return NF_ACCEPT;
867 		saddr = &ct->tuplehash[!dir].tuple.src.u3;
868 	}
869 
870 	/* We need to check whether the registration exists before attempting
871 	 * to register it since we can see the same media description multiple
872 	 * times on different connections in case multiple endpoints receive
873 	 * the same call.
874 	 *
875 	 * RTP optimization: if we find a matching media channel expectation
876 	 * and both the expectation and this connection are SNATed, we assume
877 	 * both sides can reach each other directly and use the final
878 	 * destination address from the expectation. We still need to keep
879 	 * the NATed expectations for media that might arrive from the
880 	 * outside, and additionally need to expect the direct RTP stream
881 	 * in case it passes through us even without NAT.
882 	 */
883 	memset(&tuple, 0, sizeof(tuple));
884 	if (saddr)
885 		tuple.src.u3 = *saddr;
886 	tuple.src.l3num		= nf_ct_l3num(ct);
887 	tuple.dst.protonum	= IPPROTO_UDP;
888 	tuple.dst.u3		= *daddr;
889 	tuple.dst.u.udp.port	= port;
890 
891 	rcu_read_lock();
892 	do {
893 		exp = __nf_ct_expect_find(net, nf_ct_zone(ct), &tuple);
894 
895 		if (!exp || exp->master == ct ||
896 		    nfct_help(exp->master)->helper != nfct_help(ct)->helper ||
897 		    exp->class != class)
898 			break;
899 #ifdef CONFIG_NF_NAT_NEEDED
900 		if (!direct_rtp &&
901 		    (!nf_inet_addr_cmp(&exp->saved_addr, &exp->tuple.dst.u3) ||
902 		     exp->saved_proto.udp.port != exp->tuple.dst.u.udp.port) &&
903 		    ct->status & IPS_NAT_MASK) {
904 			*daddr			= exp->saved_addr;
905 			tuple.dst.u3		= exp->saved_addr;
906 			tuple.dst.u.udp.port	= exp->saved_proto.udp.port;
907 			direct_rtp = 1;
908 		} else
909 #endif
910 			skip_expect = 1;
911 	} while (!skip_expect);
912 
913 	base_port = ntohs(tuple.dst.u.udp.port) & ~1;
914 	rtp_port = htons(base_port);
915 	rtcp_port = htons(base_port + 1);
916 
917 	if (direct_rtp) {
918 		hooks = rcu_dereference(nf_nat_sip_hooks);
919 		if (hooks &&
920 		    !hooks->sdp_port(skb, protoff, dataoff, dptr, datalen,
921 				     mediaoff, medialen, ntohs(rtp_port)))
922 			goto err1;
923 	}
924 
925 	if (skip_expect) {
926 		rcu_read_unlock();
927 		return NF_ACCEPT;
928 	}
929 
930 	rtp_exp = nf_ct_expect_alloc(ct);
931 	if (rtp_exp == NULL)
932 		goto err1;
933 	nf_ct_expect_init(rtp_exp, class, nf_ct_l3num(ct), saddr, daddr,
934 			  IPPROTO_UDP, NULL, &rtp_port);
935 
936 	rtcp_exp = nf_ct_expect_alloc(ct);
937 	if (rtcp_exp == NULL)
938 		goto err2;
939 	nf_ct_expect_init(rtcp_exp, class, nf_ct_l3num(ct), saddr, daddr,
940 			  IPPROTO_UDP, NULL, &rtcp_port);
941 
942 	hooks = rcu_dereference(nf_nat_sip_hooks);
943 	if (hooks && ct->status & IPS_NAT_MASK && !direct_rtp)
944 		ret = hooks->sdp_media(skb, protoff, dataoff, dptr,
945 				       datalen, rtp_exp, rtcp_exp,
946 				       mediaoff, medialen, daddr);
947 	else {
948 		if (nf_ct_expect_related(rtp_exp) == 0) {
949 			if (nf_ct_expect_related(rtcp_exp) != 0)
950 				nf_ct_unexpect_related(rtp_exp);
951 			else
952 				ret = NF_ACCEPT;
953 		}
954 	}
955 	nf_ct_expect_put(rtcp_exp);
956 err2:
957 	nf_ct_expect_put(rtp_exp);
958 err1:
959 	rcu_read_unlock();
960 	return ret;
961 }
962 
963 static const struct sdp_media_type sdp_media_types[] = {
964 	SDP_MEDIA_TYPE("audio ", SIP_EXPECT_AUDIO),
965 	SDP_MEDIA_TYPE("video ", SIP_EXPECT_VIDEO),
966 	SDP_MEDIA_TYPE("image ", SIP_EXPECT_IMAGE),
967 };
968 
969 static const struct sdp_media_type *sdp_media_type(const char *dptr,
970 						   unsigned int matchoff,
971 						   unsigned int matchlen)
972 {
973 	const struct sdp_media_type *t;
974 	unsigned int i;
975 
976 	for (i = 0; i < ARRAY_SIZE(sdp_media_types); i++) {
977 		t = &sdp_media_types[i];
978 		if (matchlen < t->len ||
979 		    strncmp(dptr + matchoff, t->name, t->len))
980 			continue;
981 		return t;
982 	}
983 	return NULL;
984 }
985 
986 static int process_sdp(struct sk_buff *skb, unsigned int protoff,
987 		       unsigned int dataoff,
988 		       const char **dptr, unsigned int *datalen,
989 		       unsigned int cseq)
990 {
991 	enum ip_conntrack_info ctinfo;
992 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
993 	unsigned int matchoff, matchlen;
994 	unsigned int mediaoff, medialen;
995 	unsigned int sdpoff;
996 	unsigned int caddr_len, maddr_len;
997 	unsigned int i;
998 	union nf_inet_addr caddr, maddr, rtp_addr;
999 	const struct nf_nat_sip_hooks *hooks;
1000 	unsigned int port;
1001 	const struct sdp_media_type *t;
1002 	int ret = NF_ACCEPT;
1003 
1004 	hooks = rcu_dereference(nf_nat_sip_hooks);
1005 
1006 	/* Find beginning of session description */
1007 	if (ct_sip_get_sdp_header(ct, *dptr, 0, *datalen,
1008 				  SDP_HDR_VERSION, SDP_HDR_UNSPEC,
1009 				  &matchoff, &matchlen) <= 0)
1010 		return NF_ACCEPT;
1011 	sdpoff = matchoff;
1012 
1013 	/* The connection information is contained in the session description
1014 	 * and/or once per media description. The first media description marks
1015 	 * the end of the session description. */
1016 	caddr_len = 0;
1017 	if (ct_sip_parse_sdp_addr(ct, *dptr, sdpoff, *datalen,
1018 				  SDP_HDR_CONNECTION, SDP_HDR_MEDIA,
1019 				  &matchoff, &matchlen, &caddr) > 0)
1020 		caddr_len = matchlen;
1021 
1022 	mediaoff = sdpoff;
1023 	for (i = 0; i < ARRAY_SIZE(sdp_media_types); ) {
1024 		if (ct_sip_get_sdp_header(ct, *dptr, mediaoff, *datalen,
1025 					  SDP_HDR_MEDIA, SDP_HDR_UNSPEC,
1026 					  &mediaoff, &medialen) <= 0)
1027 			break;
1028 
1029 		/* Get media type and port number. A media port value of zero
1030 		 * indicates an inactive stream. */
1031 		t = sdp_media_type(*dptr, mediaoff, medialen);
1032 		if (!t) {
1033 			mediaoff += medialen;
1034 			continue;
1035 		}
1036 		mediaoff += t->len;
1037 		medialen -= t->len;
1038 
1039 		port = simple_strtoul(*dptr + mediaoff, NULL, 10);
1040 		if (port == 0)
1041 			continue;
1042 		if (port < 1024 || port > 65535) {
1043 			nf_ct_helper_log(skb, ct, "wrong port %u", port);
1044 			return NF_DROP;
1045 		}
1046 
1047 		/* The media description overrides the session description. */
1048 		maddr_len = 0;
1049 		if (ct_sip_parse_sdp_addr(ct, *dptr, mediaoff, *datalen,
1050 					  SDP_HDR_CONNECTION, SDP_HDR_MEDIA,
1051 					  &matchoff, &matchlen, &maddr) > 0) {
1052 			maddr_len = matchlen;
1053 			memcpy(&rtp_addr, &maddr, sizeof(rtp_addr));
1054 		} else if (caddr_len)
1055 			memcpy(&rtp_addr, &caddr, sizeof(rtp_addr));
1056 		else {
1057 			nf_ct_helper_log(skb, ct, "cannot parse SDP message");
1058 			return NF_DROP;
1059 		}
1060 
1061 		ret = set_expected_rtp_rtcp(skb, protoff, dataoff,
1062 					    dptr, datalen,
1063 					    &rtp_addr, htons(port), t->class,
1064 					    mediaoff, medialen);
1065 		if (ret != NF_ACCEPT) {
1066 			nf_ct_helper_log(skb, ct,
1067 					 "cannot add expectation for voice");
1068 			return ret;
1069 		}
1070 
1071 		/* Update media connection address if present */
1072 		if (maddr_len && hooks && ct->status & IPS_NAT_MASK) {
1073 			ret = hooks->sdp_addr(skb, protoff, dataoff,
1074 					      dptr, datalen, mediaoff,
1075 					      SDP_HDR_CONNECTION,
1076 					      SDP_HDR_MEDIA,
1077 					      &rtp_addr);
1078 			if (ret != NF_ACCEPT) {
1079 				nf_ct_helper_log(skb, ct, "cannot mangle SDP");
1080 				return ret;
1081 			}
1082 		}
1083 		i++;
1084 	}
1085 
1086 	/* Update session connection and owner addresses */
1087 	hooks = rcu_dereference(nf_nat_sip_hooks);
1088 	if (hooks && ct->status & IPS_NAT_MASK)
1089 		ret = hooks->sdp_session(skb, protoff, dataoff,
1090 					 dptr, datalen, sdpoff,
1091 					 &rtp_addr);
1092 
1093 	return ret;
1094 }
1095 static int process_invite_response(struct sk_buff *skb, unsigned int protoff,
1096 				   unsigned int dataoff,
1097 				   const char **dptr, unsigned int *datalen,
1098 				   unsigned int cseq, unsigned int code)
1099 {
1100 	enum ip_conntrack_info ctinfo;
1101 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
1102 	struct nf_ct_sip_master *ct_sip_info = nfct_help_data(ct);
1103 
1104 	if ((code >= 100 && code <= 199) ||
1105 	    (code >= 200 && code <= 299))
1106 		return process_sdp(skb, protoff, dataoff, dptr, datalen, cseq);
1107 	else if (ct_sip_info->invite_cseq == cseq)
1108 		flush_expectations(ct, true);
1109 	return NF_ACCEPT;
1110 }
1111 
1112 static int process_update_response(struct sk_buff *skb, unsigned int protoff,
1113 				   unsigned int dataoff,
1114 				   const char **dptr, unsigned int *datalen,
1115 				   unsigned int cseq, unsigned int code)
1116 {
1117 	enum ip_conntrack_info ctinfo;
1118 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
1119 	struct nf_ct_sip_master *ct_sip_info = nfct_help_data(ct);
1120 
1121 	if ((code >= 100 && code <= 199) ||
1122 	    (code >= 200 && code <= 299))
1123 		return process_sdp(skb, protoff, dataoff, dptr, datalen, cseq);
1124 	else if (ct_sip_info->invite_cseq == cseq)
1125 		flush_expectations(ct, true);
1126 	return NF_ACCEPT;
1127 }
1128 
1129 static int process_prack_response(struct sk_buff *skb, unsigned int protoff,
1130 				  unsigned int dataoff,
1131 				  const char **dptr, unsigned int *datalen,
1132 				  unsigned int cseq, unsigned int code)
1133 {
1134 	enum ip_conntrack_info ctinfo;
1135 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
1136 	struct nf_ct_sip_master *ct_sip_info = nfct_help_data(ct);
1137 
1138 	if ((code >= 100 && code <= 199) ||
1139 	    (code >= 200 && code <= 299))
1140 		return process_sdp(skb, protoff, dataoff, dptr, datalen, cseq);
1141 	else if (ct_sip_info->invite_cseq == cseq)
1142 		flush_expectations(ct, true);
1143 	return NF_ACCEPT;
1144 }
1145 
1146 static int process_invite_request(struct sk_buff *skb, unsigned int protoff,
1147 				  unsigned int dataoff,
1148 				  const char **dptr, unsigned int *datalen,
1149 				  unsigned int cseq)
1150 {
1151 	enum ip_conntrack_info ctinfo;
1152 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
1153 	struct nf_ct_sip_master *ct_sip_info = nfct_help_data(ct);
1154 	unsigned int ret;
1155 
1156 	flush_expectations(ct, true);
1157 	ret = process_sdp(skb, protoff, dataoff, dptr, datalen, cseq);
1158 	if (ret == NF_ACCEPT)
1159 		ct_sip_info->invite_cseq = cseq;
1160 	return ret;
1161 }
1162 
1163 static int process_bye_request(struct sk_buff *skb, unsigned int protoff,
1164 			       unsigned int dataoff,
1165 			       const char **dptr, unsigned int *datalen,
1166 			       unsigned int cseq)
1167 {
1168 	enum ip_conntrack_info ctinfo;
1169 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
1170 
1171 	flush_expectations(ct, true);
1172 	return NF_ACCEPT;
1173 }
1174 
1175 /* Parse a REGISTER request and create a permanent expectation for incoming
1176  * signalling connections. The expectation is marked inactive and is activated
1177  * when receiving a response indicating success from the registrar.
1178  */
1179 static int process_register_request(struct sk_buff *skb, unsigned int protoff,
1180 				    unsigned int dataoff,
1181 				    const char **dptr, unsigned int *datalen,
1182 				    unsigned int cseq)
1183 {
1184 	enum ip_conntrack_info ctinfo;
1185 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
1186 	struct nf_ct_sip_master *ct_sip_info = nfct_help_data(ct);
1187 	enum ip_conntrack_dir dir = CTINFO2DIR(ctinfo);
1188 	unsigned int matchoff, matchlen;
1189 	struct nf_conntrack_expect *exp;
1190 	union nf_inet_addr *saddr, daddr;
1191 	const struct nf_nat_sip_hooks *hooks;
1192 	__be16 port;
1193 	u8 proto;
1194 	unsigned int expires = 0;
1195 	int ret;
1196 
1197 	/* Expected connections can not register again. */
1198 	if (ct->status & IPS_EXPECTED)
1199 		return NF_ACCEPT;
1200 
1201 	/* We must check the expiration time: a value of zero signals the
1202 	 * registrar to release the binding. We'll remove our expectation
1203 	 * when receiving the new bindings in the response, but we don't
1204 	 * want to create new ones.
1205 	 *
1206 	 * The expiration time may be contained in Expires: header, the
1207 	 * Contact: header parameters or the URI parameters.
1208 	 */
1209 	if (ct_sip_get_header(ct, *dptr, 0, *datalen, SIP_HDR_EXPIRES,
1210 			      &matchoff, &matchlen) > 0)
1211 		expires = simple_strtoul(*dptr + matchoff, NULL, 10);
1212 
1213 	ret = ct_sip_parse_header_uri(ct, *dptr, NULL, *datalen,
1214 				      SIP_HDR_CONTACT, NULL,
1215 				      &matchoff, &matchlen, &daddr, &port);
1216 	if (ret < 0) {
1217 		nf_ct_helper_log(skb, ct, "cannot parse contact");
1218 		return NF_DROP;
1219 	} else if (ret == 0)
1220 		return NF_ACCEPT;
1221 
1222 	/* We don't support third-party registrations */
1223 	if (!nf_inet_addr_cmp(&ct->tuplehash[dir].tuple.src.u3, &daddr))
1224 		return NF_ACCEPT;
1225 
1226 	if (ct_sip_parse_transport(ct, *dptr, matchoff + matchlen, *datalen,
1227 				   &proto) == 0)
1228 		return NF_ACCEPT;
1229 
1230 	if (ct_sip_parse_numerical_param(ct, *dptr,
1231 					 matchoff + matchlen, *datalen,
1232 					 "expires=", NULL, NULL, &expires) < 0) {
1233 		nf_ct_helper_log(skb, ct, "cannot parse expires");
1234 		return NF_DROP;
1235 	}
1236 
1237 	if (expires == 0) {
1238 		ret = NF_ACCEPT;
1239 		goto store_cseq;
1240 	}
1241 
1242 	exp = nf_ct_expect_alloc(ct);
1243 	if (!exp) {
1244 		nf_ct_helper_log(skb, ct, "cannot alloc expectation");
1245 		return NF_DROP;
1246 	}
1247 
1248 	saddr = NULL;
1249 	if (sip_direct_signalling)
1250 		saddr = &ct->tuplehash[!dir].tuple.src.u3;
1251 
1252 	nf_ct_expect_init(exp, SIP_EXPECT_SIGNALLING, nf_ct_l3num(ct),
1253 			  saddr, &daddr, proto, NULL, &port);
1254 	exp->timeout.expires = sip_timeout * HZ;
1255 	exp->helper = nfct_help(ct)->helper;
1256 	exp->flags = NF_CT_EXPECT_PERMANENT | NF_CT_EXPECT_INACTIVE;
1257 
1258 	hooks = rcu_dereference(nf_nat_sip_hooks);
1259 	if (hooks && ct->status & IPS_NAT_MASK)
1260 		ret = hooks->expect(skb, protoff, dataoff, dptr, datalen,
1261 				    exp, matchoff, matchlen);
1262 	else {
1263 		if (nf_ct_expect_related(exp) != 0) {
1264 			nf_ct_helper_log(skb, ct, "cannot add expectation");
1265 			ret = NF_DROP;
1266 		} else
1267 			ret = NF_ACCEPT;
1268 	}
1269 	nf_ct_expect_put(exp);
1270 
1271 store_cseq:
1272 	if (ret == NF_ACCEPT)
1273 		ct_sip_info->register_cseq = cseq;
1274 	return ret;
1275 }
1276 
1277 static int process_register_response(struct sk_buff *skb, unsigned int protoff,
1278 				     unsigned int dataoff,
1279 				     const char **dptr, unsigned int *datalen,
1280 				     unsigned int cseq, unsigned int code)
1281 {
1282 	enum ip_conntrack_info ctinfo;
1283 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
1284 	struct nf_ct_sip_master *ct_sip_info = nfct_help_data(ct);
1285 	enum ip_conntrack_dir dir = CTINFO2DIR(ctinfo);
1286 	union nf_inet_addr addr;
1287 	__be16 port;
1288 	u8 proto;
1289 	unsigned int matchoff, matchlen, coff = 0;
1290 	unsigned int expires = 0;
1291 	int in_contact = 0, ret;
1292 
1293 	/* According to RFC 3261, "UAs MUST NOT send a new registration until
1294 	 * they have received a final response from the registrar for the
1295 	 * previous one or the previous REGISTER request has timed out".
1296 	 *
1297 	 * However, some servers fail to detect retransmissions and send late
1298 	 * responses, so we store the sequence number of the last valid
1299 	 * request and compare it here.
1300 	 */
1301 	if (ct_sip_info->register_cseq != cseq)
1302 		return NF_ACCEPT;
1303 
1304 	if (code >= 100 && code <= 199)
1305 		return NF_ACCEPT;
1306 	if (code < 200 || code > 299)
1307 		goto flush;
1308 
1309 	if (ct_sip_get_header(ct, *dptr, 0, *datalen, SIP_HDR_EXPIRES,
1310 			      &matchoff, &matchlen) > 0)
1311 		expires = simple_strtoul(*dptr + matchoff, NULL, 10);
1312 
1313 	while (1) {
1314 		unsigned int c_expires = expires;
1315 
1316 		ret = ct_sip_parse_header_uri(ct, *dptr, &coff, *datalen,
1317 					      SIP_HDR_CONTACT, &in_contact,
1318 					      &matchoff, &matchlen,
1319 					      &addr, &port);
1320 		if (ret < 0) {
1321 			nf_ct_helper_log(skb, ct, "cannot parse contact");
1322 			return NF_DROP;
1323 		} else if (ret == 0)
1324 			break;
1325 
1326 		/* We don't support third-party registrations */
1327 		if (!nf_inet_addr_cmp(&ct->tuplehash[dir].tuple.dst.u3, &addr))
1328 			continue;
1329 
1330 		if (ct_sip_parse_transport(ct, *dptr, matchoff + matchlen,
1331 					   *datalen, &proto) == 0)
1332 			continue;
1333 
1334 		ret = ct_sip_parse_numerical_param(ct, *dptr,
1335 						   matchoff + matchlen,
1336 						   *datalen, "expires=",
1337 						   NULL, NULL, &c_expires);
1338 		if (ret < 0) {
1339 			nf_ct_helper_log(skb, ct, "cannot parse expires");
1340 			return NF_DROP;
1341 		}
1342 		if (c_expires == 0)
1343 			break;
1344 		if (refresh_signalling_expectation(ct, &addr, proto, port,
1345 						   c_expires))
1346 			return NF_ACCEPT;
1347 	}
1348 
1349 flush:
1350 	flush_expectations(ct, false);
1351 	return NF_ACCEPT;
1352 }
1353 
1354 static const struct sip_handler sip_handlers[] = {
1355 	SIP_HANDLER("INVITE", process_invite_request, process_invite_response),
1356 	SIP_HANDLER("UPDATE", process_sdp, process_update_response),
1357 	SIP_HANDLER("ACK", process_sdp, NULL),
1358 	SIP_HANDLER("PRACK", process_sdp, process_prack_response),
1359 	SIP_HANDLER("BYE", process_bye_request, NULL),
1360 	SIP_HANDLER("REGISTER", process_register_request, process_register_response),
1361 };
1362 
1363 static int process_sip_response(struct sk_buff *skb, unsigned int protoff,
1364 				unsigned int dataoff,
1365 				const char **dptr, unsigned int *datalen)
1366 {
1367 	enum ip_conntrack_info ctinfo;
1368 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
1369 	unsigned int matchoff, matchlen, matchend;
1370 	unsigned int code, cseq, i;
1371 
1372 	if (*datalen < strlen("SIP/2.0 200"))
1373 		return NF_ACCEPT;
1374 	code = simple_strtoul(*dptr + strlen("SIP/2.0 "), NULL, 10);
1375 	if (!code) {
1376 		nf_ct_helper_log(skb, ct, "cannot get code");
1377 		return NF_DROP;
1378 	}
1379 
1380 	if (ct_sip_get_header(ct, *dptr, 0, *datalen, SIP_HDR_CSEQ,
1381 			      &matchoff, &matchlen) <= 0) {
1382 		nf_ct_helper_log(skb, ct, "cannot parse cseq");
1383 		return NF_DROP;
1384 	}
1385 	cseq = simple_strtoul(*dptr + matchoff, NULL, 10);
1386 	if (!cseq) {
1387 		nf_ct_helper_log(skb, ct, "cannot get cseq");
1388 		return NF_DROP;
1389 	}
1390 	matchend = matchoff + matchlen + 1;
1391 
1392 	for (i = 0; i < ARRAY_SIZE(sip_handlers); i++) {
1393 		const struct sip_handler *handler;
1394 
1395 		handler = &sip_handlers[i];
1396 		if (handler->response == NULL)
1397 			continue;
1398 		if (*datalen < matchend + handler->len ||
1399 		    strncasecmp(*dptr + matchend, handler->method, handler->len))
1400 			continue;
1401 		return handler->response(skb, protoff, dataoff, dptr, datalen,
1402 					 cseq, code);
1403 	}
1404 	return NF_ACCEPT;
1405 }
1406 
1407 static int process_sip_request(struct sk_buff *skb, unsigned int protoff,
1408 			       unsigned int dataoff,
1409 			       const char **dptr, unsigned int *datalen)
1410 {
1411 	enum ip_conntrack_info ctinfo;
1412 	struct nf_conn *ct = nf_ct_get(skb, &ctinfo);
1413 	struct nf_ct_sip_master *ct_sip_info = nfct_help_data(ct);
1414 	enum ip_conntrack_dir dir = CTINFO2DIR(ctinfo);
1415 	unsigned int matchoff, matchlen;
1416 	unsigned int cseq, i;
1417 	union nf_inet_addr addr;
1418 	__be16 port;
1419 
1420 	/* Many Cisco IP phones use a high source port for SIP requests, but
1421 	 * listen for the response on port 5060.  If we are the local
1422 	 * router for one of these phones, save the port number from the
1423 	 * Via: header so that nf_nat_sip can redirect the responses to
1424 	 * the correct port.
1425 	 */
1426 	if (ct_sip_parse_header_uri(ct, *dptr, NULL, *datalen,
1427 				    SIP_HDR_VIA_UDP, NULL, &matchoff,
1428 				    &matchlen, &addr, &port) > 0 &&
1429 	    port != ct->tuplehash[dir].tuple.src.u.udp.port &&
1430 	    nf_inet_addr_cmp(&addr, &ct->tuplehash[dir].tuple.src.u3))
1431 		ct_sip_info->forced_dport = port;
1432 
1433 	for (i = 0; i < ARRAY_SIZE(sip_handlers); i++) {
1434 		const struct sip_handler *handler;
1435 
1436 		handler = &sip_handlers[i];
1437 		if (handler->request == NULL)
1438 			continue;
1439 		if (*datalen < handler->len ||
1440 		    strncasecmp(*dptr, handler->method, handler->len))
1441 			continue;
1442 
1443 		if (ct_sip_get_header(ct, *dptr, 0, *datalen, SIP_HDR_CSEQ,
1444 				      &matchoff, &matchlen) <= 0) {
1445 			nf_ct_helper_log(skb, ct, "cannot parse cseq");
1446 			return NF_DROP;
1447 		}
1448 		cseq = simple_strtoul(*dptr + matchoff, NULL, 10);
1449 		if (!cseq) {
1450 			nf_ct_helper_log(skb, ct, "cannot get cseq");
1451 			return NF_DROP;
1452 		}
1453 
1454 		return handler->request(skb, protoff, dataoff, dptr, datalen,
1455 					cseq);
1456 	}
1457 	return NF_ACCEPT;
1458 }
1459 
1460 static int process_sip_msg(struct sk_buff *skb, struct nf_conn *ct,
1461 			   unsigned int protoff, unsigned int dataoff,
1462 			   const char **dptr, unsigned int *datalen)
1463 {
1464 	const struct nf_nat_sip_hooks *hooks;
1465 	int ret;
1466 
1467 	if (strncasecmp(*dptr, "SIP/2.0 ", strlen("SIP/2.0 ")) != 0)
1468 		ret = process_sip_request(skb, protoff, dataoff, dptr, datalen);
1469 	else
1470 		ret = process_sip_response(skb, protoff, dataoff, dptr, datalen);
1471 
1472 	if (ret == NF_ACCEPT && ct->status & IPS_NAT_MASK) {
1473 		hooks = rcu_dereference(nf_nat_sip_hooks);
1474 		if (hooks && !hooks->msg(skb, protoff, dataoff,
1475 					 dptr, datalen)) {
1476 			nf_ct_helper_log(skb, ct, "cannot NAT SIP message");
1477 			ret = NF_DROP;
1478 		}
1479 	}
1480 
1481 	return ret;
1482 }
1483 
1484 static int sip_help_tcp(struct sk_buff *skb, unsigned int protoff,
1485 			struct nf_conn *ct, enum ip_conntrack_info ctinfo)
1486 {
1487 	struct tcphdr *th, _tcph;
1488 	unsigned int dataoff, datalen;
1489 	unsigned int matchoff, matchlen, clen;
1490 	unsigned int msglen, origlen;
1491 	const char *dptr, *end;
1492 	s16 diff, tdiff = 0;
1493 	int ret = NF_ACCEPT;
1494 	bool term;
1495 
1496 	if (ctinfo != IP_CT_ESTABLISHED &&
1497 	    ctinfo != IP_CT_ESTABLISHED_REPLY)
1498 		return NF_ACCEPT;
1499 
1500 	/* No Data ? */
1501 	th = skb_header_pointer(skb, protoff, sizeof(_tcph), &_tcph);
1502 	if (th == NULL)
1503 		return NF_ACCEPT;
1504 	dataoff = protoff + th->doff * 4;
1505 	if (dataoff >= skb->len)
1506 		return NF_ACCEPT;
1507 
1508 	nf_ct_refresh(ct, skb, sip_timeout * HZ);
1509 
1510 	if (unlikely(skb_linearize(skb)))
1511 		return NF_DROP;
1512 
1513 	dptr = skb->data + dataoff;
1514 	datalen = skb->len - dataoff;
1515 	if (datalen < strlen("SIP/2.0 200"))
1516 		return NF_ACCEPT;
1517 
1518 	while (1) {
1519 		if (ct_sip_get_header(ct, dptr, 0, datalen,
1520 				      SIP_HDR_CONTENT_LENGTH,
1521 				      &matchoff, &matchlen) <= 0)
1522 			break;
1523 
1524 		clen = simple_strtoul(dptr + matchoff, (char **)&end, 10);
1525 		if (dptr + matchoff == end)
1526 			break;
1527 
1528 		term = false;
1529 		for (; end + strlen("\r\n\r\n") <= dptr + datalen; end++) {
1530 			if (end[0] == '\r' && end[1] == '\n' &&
1531 			    end[2] == '\r' && end[3] == '\n') {
1532 				term = true;
1533 				break;
1534 			}
1535 		}
1536 		if (!term)
1537 			break;
1538 		end += strlen("\r\n\r\n") + clen;
1539 
1540 		msglen = origlen = end - dptr;
1541 		if (msglen > datalen)
1542 			return NF_ACCEPT;
1543 
1544 		ret = process_sip_msg(skb, ct, protoff, dataoff,
1545 				      &dptr, &msglen);
1546 		/* process_sip_* functions report why this packet is dropped */
1547 		if (ret != NF_ACCEPT)
1548 			break;
1549 		diff     = msglen - origlen;
1550 		tdiff   += diff;
1551 
1552 		dataoff += msglen;
1553 		dptr    += msglen;
1554 		datalen  = datalen + diff - msglen;
1555 	}
1556 
1557 	if (ret == NF_ACCEPT && ct->status & IPS_NAT_MASK) {
1558 		const struct nf_nat_sip_hooks *hooks;
1559 
1560 		hooks = rcu_dereference(nf_nat_sip_hooks);
1561 		if (hooks)
1562 			hooks->seq_adjust(skb, protoff, tdiff);
1563 	}
1564 
1565 	return ret;
1566 }
1567 
1568 static int sip_help_udp(struct sk_buff *skb, unsigned int protoff,
1569 			struct nf_conn *ct, enum ip_conntrack_info ctinfo)
1570 {
1571 	unsigned int dataoff, datalen;
1572 	const char *dptr;
1573 
1574 	/* No Data ? */
1575 	dataoff = protoff + sizeof(struct udphdr);
1576 	if (dataoff >= skb->len)
1577 		return NF_ACCEPT;
1578 
1579 	nf_ct_refresh(ct, skb, sip_timeout * HZ);
1580 
1581 	if (unlikely(skb_linearize(skb)))
1582 		return NF_DROP;
1583 
1584 	dptr = skb->data + dataoff;
1585 	datalen = skb->len - dataoff;
1586 	if (datalen < strlen("SIP/2.0 200"))
1587 		return NF_ACCEPT;
1588 
1589 	return process_sip_msg(skb, ct, protoff, dataoff, &dptr, &datalen);
1590 }
1591 
1592 static struct nf_conntrack_helper sip[MAX_PORTS][4] __read_mostly;
1593 
1594 static const struct nf_conntrack_expect_policy sip_exp_policy[SIP_EXPECT_MAX + 1] = {
1595 	[SIP_EXPECT_SIGNALLING] = {
1596 		.name		= "signalling",
1597 		.max_expected	= 1,
1598 		.timeout	= 3 * 60,
1599 	},
1600 	[SIP_EXPECT_AUDIO] = {
1601 		.name		= "audio",
1602 		.max_expected	= 2 * IP_CT_DIR_MAX,
1603 		.timeout	= 3 * 60,
1604 	},
1605 	[SIP_EXPECT_VIDEO] = {
1606 		.name		= "video",
1607 		.max_expected	= 2 * IP_CT_DIR_MAX,
1608 		.timeout	= 3 * 60,
1609 	},
1610 	[SIP_EXPECT_IMAGE] = {
1611 		.name		= "image",
1612 		.max_expected	= IP_CT_DIR_MAX,
1613 		.timeout	= 3 * 60,
1614 	},
1615 };
1616 
1617 static void nf_conntrack_sip_fini(void)
1618 {
1619 	int i, j;
1620 
1621 	for (i = 0; i < ports_c; i++) {
1622 		for (j = 0; j < ARRAY_SIZE(sip[i]); j++) {
1623 			if (sip[i][j].me == NULL)
1624 				continue;
1625 			nf_conntrack_helper_unregister(&sip[i][j]);
1626 		}
1627 	}
1628 }
1629 
1630 static int __init nf_conntrack_sip_init(void)
1631 {
1632 	int i, j, ret;
1633 
1634 	if (ports_c == 0)
1635 		ports[ports_c++] = SIP_PORT;
1636 
1637 	for (i = 0; i < ports_c; i++) {
1638 		memset(&sip[i], 0, sizeof(sip[i]));
1639 
1640 		sip[i][0].tuple.src.l3num = AF_INET;
1641 		sip[i][0].tuple.dst.protonum = IPPROTO_UDP;
1642 		sip[i][0].help = sip_help_udp;
1643 		sip[i][1].tuple.src.l3num = AF_INET;
1644 		sip[i][1].tuple.dst.protonum = IPPROTO_TCP;
1645 		sip[i][1].help = sip_help_tcp;
1646 
1647 		sip[i][2].tuple.src.l3num = AF_INET6;
1648 		sip[i][2].tuple.dst.protonum = IPPROTO_UDP;
1649 		sip[i][2].help = sip_help_udp;
1650 		sip[i][3].tuple.src.l3num = AF_INET6;
1651 		sip[i][3].tuple.dst.protonum = IPPROTO_TCP;
1652 		sip[i][3].help = sip_help_tcp;
1653 
1654 		for (j = 0; j < ARRAY_SIZE(sip[i]); j++) {
1655 			sip[i][j].data_len = sizeof(struct nf_ct_sip_master);
1656 			sip[i][j].tuple.src.u.udp.port = htons(ports[i]);
1657 			sip[i][j].expect_policy = sip_exp_policy;
1658 			sip[i][j].expect_class_max = SIP_EXPECT_MAX;
1659 			sip[i][j].me = THIS_MODULE;
1660 
1661 			if (ports[i] == SIP_PORT)
1662 				sprintf(sip[i][j].name, "sip");
1663 			else
1664 				sprintf(sip[i][j].name, "sip-%u", i);
1665 
1666 			pr_debug("port #%u: %u\n", i, ports[i]);
1667 
1668 			ret = nf_conntrack_helper_register(&sip[i][j]);
1669 			if (ret) {
1670 				pr_err("failed to register helper for pf: %u port: %u\n",
1671 				       sip[i][j].tuple.src.l3num, ports[i]);
1672 				nf_conntrack_sip_fini();
1673 				return ret;
1674 			}
1675 		}
1676 	}
1677 	return 0;
1678 }
1679 
1680 module_init(nf_conntrack_sip_init);
1681 module_exit(nf_conntrack_sip_fini);
1682