ah6.c 18.3 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 * Copyright (C)2002 USAGI/WIDE Project
3
 *
L
Linus Torvalds 已提交
4 5 6 7
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
8
 *
L
Linus Torvalds 已提交
9 10 11 12
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
13
 *
L
Linus Torvalds 已提交
14
 * You should have received a copy of the GNU General Public License
15
 * along with this program; if not, see <http://www.gnu.org/licenses/>.
L
Linus Torvalds 已提交
16 17 18
 *
 * Authors
 *
19
 *	Mitsuru KANDA @USAGI       : IPv6 Support
20 21
 *	Kazunori MIYAZAWA @USAGI   :
 *	Kunihiro Ishiguro <kunihiro@ipinfusion.com>
22
 *
23
 *	This file is derived from net/ipv4/ah.c.
L
Linus Torvalds 已提交
24 25
 */

26 27
#define pr_fmt(fmt) "IPv6: " fmt

S
Steffen Klassert 已提交
28
#include <crypto/hash.h>
L
Linus Torvalds 已提交
29
#include <linux/module.h>
30
#include <linux/slab.h>
L
Linus Torvalds 已提交
31 32 33 34 35
#include <net/ip.h>
#include <net/ah.h>
#include <linux/crypto.h>
#include <linux/pfkeyv2.h>
#include <linux/string.h>
S
Steffen Klassert 已提交
36
#include <linux/scatterlist.h>
37
#include <net/ip6_route.h>
L
Linus Torvalds 已提交
38 39
#include <net/icmp.h>
#include <net/ipv6.h>
40
#include <net/protocol.h>
L
Linus Torvalds 已提交
41 42
#include <net/xfrm.h>

S
Steffen Klassert 已提交
43 44 45
#define IPV6HDR_BASELEN 8

struct tmp_ext {
A
Amerigo Wang 已提交
46
#if IS_ENABLED(CONFIG_IPV6_MIP6)
S
Steffen Klassert 已提交
47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115
		struct in6_addr saddr;
#endif
		struct in6_addr daddr;
		char hdrs[0];
};

struct ah_skb_cb {
	struct xfrm_skb_cb xfrm;
	void *tmp;
};

#define AH_SKB_CB(__skb) ((struct ah_skb_cb *)&((__skb)->cb[0]))

static void *ah_alloc_tmp(struct crypto_ahash *ahash, int nfrags,
			  unsigned int size)
{
	unsigned int len;

	len = size + crypto_ahash_digestsize(ahash) +
	      (crypto_ahash_alignmask(ahash) &
	       ~(crypto_tfm_ctx_alignment() - 1));

	len = ALIGN(len, crypto_tfm_ctx_alignment());

	len += sizeof(struct ahash_request) + crypto_ahash_reqsize(ahash);
	len = ALIGN(len, __alignof__(struct scatterlist));

	len += sizeof(struct scatterlist) * nfrags;

	return kmalloc(len, GFP_ATOMIC);
}

static inline struct tmp_ext *ah_tmp_ext(void *base)
{
	return base + IPV6HDR_BASELEN;
}

static inline u8 *ah_tmp_auth(u8 *tmp, unsigned int offset)
{
	return tmp + offset;
}

static inline u8 *ah_tmp_icv(struct crypto_ahash *ahash, void *tmp,
			     unsigned int offset)
{
	return PTR_ALIGN((u8 *)tmp + offset, crypto_ahash_alignmask(ahash) + 1);
}

static inline struct ahash_request *ah_tmp_req(struct crypto_ahash *ahash,
					       u8 *icv)
{
	struct ahash_request *req;

	req = (void *)PTR_ALIGN(icv + crypto_ahash_digestsize(ahash),
				crypto_tfm_ctx_alignment());

	ahash_request_set_tfm(req, ahash);

	return req;
}

static inline struct scatterlist *ah_req_sg(struct crypto_ahash *ahash,
					     struct ahash_request *req)
{
	return (void *)ALIGN((unsigned long)(req + 1) +
			     crypto_ahash_reqsize(ahash),
			     __alignof__(struct scatterlist));
}

116
static bool zero_out_mutable_opts(struct ipv6_opt_hdr *opthdr)
L
Linus Torvalds 已提交
117 118 119 120 121 122 123 124 125 126 127 128 129
{
	u8 *opt = (u8 *)opthdr;
	int len = ipv6_optlen(opthdr);
	int off = 0;
	int optlen = 0;

	off += 2;
	len -= 2;

	while (len > 0) {

		switch (opt[off]) {

130
		case IPV6_TLV_PAD1:
L
Linus Torvalds 已提交
131 132 133
			optlen = 1;
			break;
		default:
134
			if (len < 2)
L
Linus Torvalds 已提交
135 136 137 138 139 140 141 142 143 144 145 146 147
				goto bad;
			optlen = opt[off+1]+2;
			if (len < optlen)
				goto bad;
			if (opt[off] & 0x20)
				memset(&opt[off+2], 0, opt[off+1]);
			break;
		}

		off += optlen;
		len -= optlen;
	}
	if (len == 0)
148
		return true;
L
Linus Torvalds 已提交
149 150

bad:
151
	return false;
L
Linus Torvalds 已提交
152 153
}

A
Amerigo Wang 已提交
154
#if IS_ENABLED(CONFIG_IPV6_MIP6)
155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173
/**
 *	ipv6_rearrange_destopt - rearrange IPv6 destination options header
 *	@iph: IPv6 header
 *	@destopt: destionation options header
 */
static void ipv6_rearrange_destopt(struct ipv6hdr *iph, struct ipv6_opt_hdr *destopt)
{
	u8 *opt = (u8 *)destopt;
	int len = ipv6_optlen(destopt);
	int off = 0;
	int optlen = 0;

	off += 2;
	len -= 2;

	while (len > 0) {

		switch (opt[off]) {

174
		case IPV6_TLV_PAD1:
175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193
			optlen = 1;
			break;
		default:
			if (len < 2)
				goto bad;
			optlen = opt[off+1]+2;
			if (len < optlen)
				goto bad;

			/* Rearrange the source address in @iph and the
			 * addresses in home address option for final source.
			 * See 11.3.2 of RFC 3775 for details.
			 */
			if (opt[off] == IPV6_TLV_HAO) {
				struct in6_addr final_addr;
				struct ipv6_destopt_hao *hao;

				hao = (struct ipv6_destopt_hao *)&opt[off];
				if (hao->length != sizeof(hao->addr)) {
194 195
					net_warn_ratelimited("destopt hao: invalid header length: %u\n",
							     hao->length);
196 197
					goto bad;
				}
A
Alexey Dobriyan 已提交
198 199 200
				final_addr = hao->addr;
				hao->addr = iph->saddr;
				iph->saddr = final_addr;
201 202 203 204 205 206 207
			}
			break;
		}

		off += optlen;
		len -= optlen;
	}
208
	/* Note: ok if len == 0 */
209 210 211
bad:
	return;
}
212 213
#else
static void ipv6_rearrange_destopt(struct ipv6hdr *iph, struct ipv6_opt_hdr *destopt) {}
214 215
#endif

L
Linus Torvalds 已提交
216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233
/**
 *	ipv6_rearrange_rthdr - rearrange IPv6 routing header
 *	@iph: IPv6 header
 *	@rthdr: routing header
 *
 *	Rearrange the destination address in @iph and the addresses in @rthdr
 *	so that they appear in the order they will at the final destination.
 *	See Appendix A2 of RFC 2402 for details.
 */
static void ipv6_rearrange_rthdr(struct ipv6hdr *iph, struct ipv6_rt_hdr *rthdr)
{
	int segments, segments_left;
	struct in6_addr *addrs;
	struct in6_addr final_addr;

	segments_left = rthdr->segments_left;
	if (segments_left == 0)
		return;
234
	rthdr->segments_left = 0;
L
Linus Torvalds 已提交
235 236 237 238 239 240 241 242 243 244 245

	/* The value of rthdr->hdrlen has been verified either by the system
	 * call if it is locally generated, or by ipv6_rthdr_rcv() for incoming
	 * packets.  So we can assume that it is even and that segments is
	 * greater than or equal to segments_left.
	 *
	 * For the same reason we can assume that this option is of type 0.
	 */
	segments = rthdr->hdrlen >> 1;

	addrs = ((struct rt0_hdr *)rthdr)->addr;
A
Alexey Dobriyan 已提交
246
	final_addr = addrs[segments - 1];
L
Linus Torvalds 已提交
247 248 249 250

	addrs += segments - segments_left;
	memmove(addrs + 1, addrs, (segments_left - 1) * sizeof(*addrs));

A
Alexey Dobriyan 已提交
251 252
	addrs[0] = iph->daddr;
	iph->daddr = final_addr;
L
Linus Torvalds 已提交
253 254
}

255
static int ipv6_clear_mutable_options(struct ipv6hdr *iph, int len, int dir)
L
Linus Torvalds 已提交
256 257 258 259 260 261 262 263 264 265 266 267 268 269
{
	union {
		struct ipv6hdr *iph;
		struct ipv6_opt_hdr *opth;
		struct ipv6_rt_hdr *rth;
		char *raw;
	} exthdr = { .iph = iph };
	char *end = exthdr.raw + len;
	int nexthdr = iph->nexthdr;

	exthdr.iph++;

	while (exthdr.raw < end) {
		switch (nexthdr) {
270 271 272
		case NEXTHDR_DEST:
			if (dir == XFRM_POLICY_OUT)
				ipv6_rearrange_destopt(iph, exthdr.opth);
L
Linus Torvalds 已提交
273 274
		case NEXTHDR_HOP:
			if (!zero_out_mutable_opts(exthdr.opth)) {
275
				LIMIT_NETDEBUG(
L
Linus Torvalds 已提交
276 277
					KERN_WARNING "overrun %sopts\n",
					nexthdr == NEXTHDR_HOP ?
278
						"hop" : "dest");
L
Linus Torvalds 已提交
279 280 281 282 283 284 285 286
				return -EINVAL;
			}
			break;

		case NEXTHDR_ROUTING:
			ipv6_rearrange_rthdr(iph, exthdr.rth);
			break;

287
		default:
L
Linus Torvalds 已提交
288 289 290 291 292 293 294 295 296 297
			return 0;
		}

		nexthdr = exthdr.opth->nexthdr;
		exthdr.raw += ipv6_optlen(exthdr.opth);
	}

	return 0;
}

S
Steffen Klassert 已提交
298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321
static void ah6_output_done(struct crypto_async_request *base, int err)
{
	int extlen;
	u8 *iph_base;
	u8 *icv;
	struct sk_buff *skb = base->data;
	struct xfrm_state *x = skb_dst(skb)->xfrm;
	struct ah_data *ahp = x->data;
	struct ipv6hdr *top_iph = ipv6_hdr(skb);
	struct ip_auth_hdr *ah = ip_auth_hdr(skb);
	struct tmp_ext *iph_ext;

	extlen = skb_network_header_len(skb) - sizeof(struct ipv6hdr);
	if (extlen)
		extlen += sizeof(*iph_ext);

	iph_base = AH_SKB_CB(skb)->tmp;
	iph_ext = ah_tmp_ext(iph_base);
	icv = ah_tmp_icv(ahp->ahash, iph_ext, extlen);

	memcpy(ah->auth_data, icv, ahp->icv_trunc_len);
	memcpy(top_iph, iph_base, IPV6HDR_BASELEN);

	if (extlen) {
A
Amerigo Wang 已提交
322
#if IS_ENABLED(CONFIG_IPV6_MIP6)
S
Steffen Klassert 已提交
323 324 325 326 327 328 329 330 331 332
		memcpy(&top_iph->saddr, iph_ext, extlen);
#else
		memcpy(&top_iph->daddr, iph_ext, extlen);
#endif
	}

	kfree(AH_SKB_CB(skb)->tmp);
	xfrm_output_resume(skb, err);
}

L
Linus Torvalds 已提交
333 334 335
static int ah6_output(struct xfrm_state *x, struct sk_buff *skb)
{
	int err;
S
Steffen Klassert 已提交
336
	int nfrags;
L
Linus Torvalds 已提交
337
	int extlen;
S
Steffen Klassert 已提交
338 339 340 341 342 343 344
	u8 *iph_base;
	u8 *icv;
	u8 nexthdr;
	struct sk_buff *trailer;
	struct crypto_ahash *ahash;
	struct ahash_request *req;
	struct scatterlist *sg;
L
Linus Torvalds 已提交
345 346 347
	struct ipv6hdr *top_iph;
	struct ip_auth_hdr *ah;
	struct ah_data *ahp;
S
Steffen Klassert 已提交
348
	struct tmp_ext *iph_ext;
349 350 351 352
	int seqhi_len = 0;
	__be32 *seqhi;
	int sglists = 0;
	struct scatterlist *seqhisg;
S
Steffen Klassert 已提交
353 354 355 356 357 358 359

	ahp = x->data;
	ahash = ahp->ahash;

	if ((err = skb_cow_data(skb, 0, &trailer)) < 0)
		goto out;
	nfrags = err;
L
Linus Torvalds 已提交
360

361
	skb_push(skb, -skb_network_offset(skb));
S
Steffen Klassert 已提交
362 363 364 365
	extlen = skb_network_header_len(skb) - sizeof(struct ipv6hdr);
	if (extlen)
		extlen += sizeof(*iph_ext);

366 367 368 369
	if (x->props.flags & XFRM_STATE_ESN) {
		sglists = 1;
		seqhi_len = sizeof(*seqhi);
	}
S
Steffen Klassert 已提交
370
	err = -ENOMEM;
371 372
	iph_base = ah_alloc_tmp(ahash, nfrags + sglists, IPV6HDR_BASELEN +
				extlen + seqhi_len);
S
Steffen Klassert 已提交
373 374 375 376
	if (!iph_base)
		goto out;

	iph_ext = ah_tmp_ext(iph_base);
377 378
	seqhi = (__be32 *)((char *)iph_ext + extlen);
	icv = ah_tmp_icv(ahash, seqhi, seqhi_len);
S
Steffen Klassert 已提交
379 380
	req = ah_tmp_req(ahash, icv);
	sg = ah_req_sg(ahash, req);
381
	seqhisg = sg + nfrags;
S
Steffen Klassert 已提交
382 383 384 385

	ah = ip_auth_hdr(skb);
	memset(ah->auth_data, 0, ahp->icv_trunc_len);

386
	top_iph = ipv6_hdr(skb);
L
Linus Torvalds 已提交
387 388
	top_iph->payload_len = htons(skb->len - sizeof(*top_iph));

389 390
	nexthdr = *skb_mac_header(skb);
	*skb_mac_header(skb) = IPPROTO_AH;
L
Linus Torvalds 已提交
391 392 393 394

	/* When there are no extension headers, we only need to save the first
	 * 8 bytes of the base IP header.
	 */
S
Steffen Klassert 已提交
395
	memcpy(iph_base, top_iph, IPV6HDR_BASELEN);
L
Linus Torvalds 已提交
396 397

	if (extlen) {
A
Amerigo Wang 已提交
398
#if IS_ENABLED(CONFIG_IPV6_MIP6)
S
Steffen Klassert 已提交
399
		memcpy(iph_ext, &top_iph->saddr, extlen);
400
#else
S
Steffen Klassert 已提交
401
		memcpy(iph_ext, &top_iph->daddr, extlen);
402
#endif
L
Linus Torvalds 已提交
403
		err = ipv6_clear_mutable_options(top_iph,
S
Steffen Klassert 已提交
404
						 extlen - sizeof(*iph_ext) +
405 406
						 sizeof(*top_iph),
						 XFRM_POLICY_OUT);
L
Linus Torvalds 已提交
407
		if (err)
S
Steffen Klassert 已提交
408
			goto out_free;
L
Linus Torvalds 已提交
409 410 411 412 413 414 415 416 417 418
	}

	ah->nexthdr = nexthdr;

	top_iph->priority    = 0;
	top_iph->flow_lbl[0] = 0;
	top_iph->flow_lbl[1] = 0;
	top_iph->flow_lbl[2] = 0;
	top_iph->hop_limit   = 0;

419
	ah->hdrlen  = (XFRM_ALIGN8(sizeof(*ah) + ahp->icv_trunc_len) >> 2) - 2;
L
Linus Torvalds 已提交
420 421 422

	ah->reserved = 0;
	ah->spi = x->id.spi;
423
	ah->seq_no = htonl(XFRM_SKB_CB(skb)->seq.output.low);
424

425 426
	sg_init_table(sg, nfrags + sglists);
	skb_to_sgvec_nomark(skb, sg, 0, skb->len);
L
Linus Torvalds 已提交
427

428 429 430 431 432 433
	if (x->props.flags & XFRM_STATE_ESN) {
		/* Attach seqhi sg right after packet payload */
		*seqhi = htonl(XFRM_SKB_CB(skb)->seq.output.hi);
		sg_set_buf(seqhisg, seqhi, seqhi_len);
	}
	ahash_request_set_crypt(req, sg, icv, skb->len + seqhi_len);
S
Steffen Klassert 已提交
434 435 436
	ahash_request_set_callback(req, 0, ah6_output_done, skb);

	AH_SKB_CB(skb)->tmp = iph_base;
L
Linus Torvalds 已提交
437

S
Steffen Klassert 已提交
438 439 440 441 442 443 444 445 446 447 448 449 450 451
	err = crypto_ahash_digest(req);
	if (err) {
		if (err == -EINPROGRESS)
			goto out;

		if (err == -EBUSY)
			err = NET_XMIT_DROP;
		goto out_free;
	}

	memcpy(ah->auth_data, icv, ahp->icv_trunc_len);
	memcpy(top_iph, iph_base, IPV6HDR_BASELEN);

	if (extlen) {
A
Amerigo Wang 已提交
452
#if IS_ENABLED(CONFIG_IPV6_MIP6)
S
Steffen Klassert 已提交
453
		memcpy(&top_iph->saddr, iph_ext, extlen);
454
#else
S
Steffen Klassert 已提交
455
		memcpy(&top_iph->daddr, iph_ext, extlen);
456
#endif
L
Linus Torvalds 已提交
457 458
	}

S
Steffen Klassert 已提交
459 460 461
out_free:
	kfree(iph_base);
out:
L
Linus Torvalds 已提交
462 463 464
	return err;
}

S
Steffen Klassert 已提交
465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480
static void ah6_input_done(struct crypto_async_request *base, int err)
{
	u8 *auth_data;
	u8 *icv;
	u8 *work_iph;
	struct sk_buff *skb = base->data;
	struct xfrm_state *x = xfrm_input_state(skb);
	struct ah_data *ahp = x->data;
	struct ip_auth_hdr *ah = ip_auth_hdr(skb);
	int hdr_len = skb_network_header_len(skb);
	int ah_hlen = (ah->hdrlen + 2) << 2;

	work_iph = AH_SKB_CB(skb)->tmp;
	auth_data = ah_tmp_auth(work_iph, hdr_len);
	icv = ah_tmp_icv(ahp->ahash, auth_data, ahp->icv_trunc_len);

481
	err = memcmp(icv, auth_data, ahp->icv_trunc_len) ? -EBADMSG : 0;
S
Steffen Klassert 已提交
482 483 484
	if (err)
		goto out;

485 486
	err = ah->nexthdr;

S
Steffen Klassert 已提交
487 488 489
	skb->network_header += ah_hlen;
	memcpy(skb_network_header(skb), work_iph, hdr_len);
	__skb_pull(skb, ah_hlen + hdr_len);
490 491 492 493
	if (x->props.mode == XFRM_MODE_TUNNEL)
		skb_reset_transport_header(skb);
	else
		skb_set_transport_header(skb, -hdr_len);
S
Steffen Klassert 已提交
494 495 496 497 498 499 500
out:
	kfree(AH_SKB_CB(skb)->tmp);
	xfrm_input_resume(skb, err);
}



501
static int ah6_input(struct xfrm_state *x, struct sk_buff *skb)
L
Linus Torvalds 已提交
502 503 504 505 506 507 508 509
{
	/*
	 * Before process AH
	 * [IPv6][Ext1][Ext2][AH][Dest][Payload]
	 * |<-------------->| hdr_len
	 *
	 * To erase AH:
	 * Keeping copy of cleared headers. After AH processing,
510 511
	 * Moving the pointer of skb->network_header by using skb_pull as long
	 * as AH header length. Then copy back the copy as long as hdr_len
L
Linus Torvalds 已提交
512
	 * If destination header following AH exists, copy it into after [Ext2].
513
	 *
L
Linus Torvalds 已提交
514 515 516 517
	 * |<>|[IPv6][Ext1][Ext2][Dest][Payload]
	 * There is offset of AH before IPv6 header after the process.
	 */

S
Steffen Klassert 已提交
518 519 520 521 522 523 524
	u8 *auth_data;
	u8 *icv;
	u8 *work_iph;
	struct sk_buff *trailer;
	struct crypto_ahash *ahash;
	struct ahash_request *req;
	struct scatterlist *sg;
525
	struct ip_auth_hdr *ah;
526
	struct ipv6hdr *ip6h;
L
Linus Torvalds 已提交
527 528 529 530
	struct ah_data *ahp;
	u16 hdr_len;
	u16 ah_hlen;
	int nexthdr;
S
Steffen Klassert 已提交
531 532
	int nfrags;
	int err = -ENOMEM;
533 534 535 536
	int seqhi_len = 0;
	__be32 *seqhi;
	int sglists = 0;
	struct scatterlist *seqhisg;
L
Linus Torvalds 已提交
537 538 539 540 541 542

	if (!pskb_may_pull(skb, sizeof(struct ip_auth_hdr)))
		goto out;

	/* We are going to _remove_ AH header to keep sockets happy,
	 * so... Later this can change. */
543
	if (skb_unclone(skb, GFP_ATOMIC))
L
Linus Torvalds 已提交
544 545
		goto out;

546 547
	skb->ip_summed = CHECKSUM_NONE;

S
Steffen Klassert 已提交
548
	hdr_len = skb_network_header_len(skb);
549
	ah = (struct ip_auth_hdr *)skb->data;
L
Linus Torvalds 已提交
550
	ahp = x->data;
S
Steffen Klassert 已提交
551 552
	ahash = ahp->ahash;

L
Linus Torvalds 已提交
553 554 555
	nexthdr = ah->nexthdr;
	ah_hlen = (ah->hdrlen + 2) << 2;

556 557
	if (ah_hlen != XFRM_ALIGN8(sizeof(*ah) + ahp->icv_full_len) &&
	    ah_hlen != XFRM_ALIGN8(sizeof(*ah) + ahp->icv_trunc_len))
558
		goto out;
L
Linus Torvalds 已提交
559 560 561 562

	if (!pskb_may_pull(skb, ah_hlen))
		goto out;

S
Steffen Klassert 已提交
563 564 565 566 567

	if ((err = skb_cow_data(skb, 0, &trailer)) < 0)
		goto out;
	nfrags = err;

568 569 570 571 572
	ah = (struct ip_auth_hdr *)skb->data;
	ip6h = ipv6_hdr(skb);

	skb_push(skb, hdr_len);

573 574 575 576 577 578 579
	if (x->props.flags & XFRM_STATE_ESN) {
		sglists = 1;
		seqhi_len = sizeof(*seqhi);
	}

	work_iph = ah_alloc_tmp(ahash, nfrags + sglists, hdr_len +
				ahp->icv_trunc_len + seqhi_len);
S
Steffen Klassert 已提交
580 581 582
	if (!work_iph)
		goto out;

583 584 585
	auth_data = ah_tmp_auth((u8 *)work_iph, hdr_len);
	seqhi = (__be32 *)(auth_data + ahp->icv_trunc_len);
	icv = ah_tmp_icv(ahash, seqhi, seqhi_len);
S
Steffen Klassert 已提交
586 587
	req = ah_tmp_req(ahash, icv);
	sg = ah_req_sg(ahash, req);
588
	seqhisg = sg + nfrags;
S
Steffen Klassert 已提交
589 590 591 592 593

	memcpy(work_iph, ip6h, hdr_len);
	memcpy(auth_data, ah->auth_data, ahp->icv_trunc_len);
	memset(ah->auth_data, 0, ahp->icv_trunc_len);

594
	if (ipv6_clear_mutable_options(ip6h, hdr_len, XFRM_POLICY_IN))
S
Steffen Klassert 已提交
595 596
		goto out_free;

597 598 599 600 601
	ip6h->priority    = 0;
	ip6h->flow_lbl[0] = 0;
	ip6h->flow_lbl[1] = 0;
	ip6h->flow_lbl[2] = 0;
	ip6h->hop_limit   = 0;
L
Linus Torvalds 已提交
602

603 604 605 606 607 608 609 610
	sg_init_table(sg, nfrags + sglists);
	skb_to_sgvec_nomark(skb, sg, 0, skb->len);

	if (x->props.flags & XFRM_STATE_ESN) {
		/* Attach seqhi sg right after packet payload */
		*seqhi = XFRM_SKB_CB(skb)->seq.input.hi;
		sg_set_buf(seqhisg, seqhi, seqhi_len);
	}
L
Linus Torvalds 已提交
611

612
	ahash_request_set_crypt(req, sg, icv, skb->len + seqhi_len);
S
Steffen Klassert 已提交
613 614 615 616 617 618 619 620 621 622
	ahash_request_set_callback(req, 0, ah6_input_done, skb);

	AH_SKB_CB(skb)->tmp = work_iph;

	err = crypto_ahash_digest(req);
	if (err) {
		if (err == -EINPROGRESS)
			goto out;

		goto out_free;
L
Linus Torvalds 已提交
623
	}
624

625
	err = memcmp(icv, auth_data, ahp->icv_trunc_len) ? -EBADMSG : 0;
626
	if (err)
S
Steffen Klassert 已提交
627
		goto out_free;
L
Linus Torvalds 已提交
628

629
	skb->network_header += ah_hlen;
S
Steffen Klassert 已提交
630
	memcpy(skb_network_header(skb), work_iph, hdr_len);
631
	__skb_pull(skb, ah_hlen + hdr_len);
L
Linus Torvalds 已提交
632

633 634 635 636 637
	if (x->props.mode == XFRM_MODE_TUNNEL)
		skb_reset_transport_header(skb);
	else
		skb_set_transport_header(skb, -hdr_len);

S
Steffen Klassert 已提交
638
	err = nexthdr;
L
Linus Torvalds 已提交
639

S
Steffen Klassert 已提交
640 641
out_free:
	kfree(work_iph);
L
Linus Torvalds 已提交
642
out:
643
	return err;
L
Linus Torvalds 已提交
644 645
}

646 647
static int ah6_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
		   u8 type, u8 code, int offset, __be32 info)
L
Linus Torvalds 已提交
648
{
A
Alexey Dobriyan 已提交
649
	struct net *net = dev_net(skb->dev);
650 651
	struct ipv6hdr *iph = (struct ipv6hdr *)skb->data;
	struct ip_auth_hdr *ah = (struct ip_auth_hdr *)(skb->data+offset);
L
Linus Torvalds 已提交
652 653
	struct xfrm_state *x;

654
	if (type != ICMPV6_PKT_TOOBIG &&
655
	    type != NDISC_REDIRECT)
656
		return 0;
L
Linus Torvalds 已提交
657

658
	x = xfrm_state_lookup(net, skb->mark, (xfrm_address_t *)&iph->daddr, ah->spi, IPPROTO_AH, AF_INET6);
L
Linus Torvalds 已提交
659
	if (!x)
660
		return 0;
L
Linus Torvalds 已提交
661

662
	if (type == NDISC_REDIRECT)
663
		ip6_redirect(skb, net, skb->dev->ifindex, 0);
664 665
	else
		ip6_update_pmtu(skb, net, info, 0, 0);
L
Linus Torvalds 已提交
666
	xfrm_state_put(x);
667 668

	return 0;
L
Linus Torvalds 已提交
669 670
}

H
Herbert Xu 已提交
671
static int ah6_init_state(struct xfrm_state *x)
L
Linus Torvalds 已提交
672 673 674
{
	struct ah_data *ahp = NULL;
	struct xfrm_algo_desc *aalg_desc;
S
Steffen Klassert 已提交
675
	struct crypto_ahash *ahash;
L
Linus Torvalds 已提交
676 677 678 679 680 681 682

	if (!x->aalg)
		goto error;

	if (x->encap)
		goto error;

683
	ahp = kzalloc(sizeof(*ahp), GFP_KERNEL);
L
Linus Torvalds 已提交
684 685 686
	if (ahp == NULL)
		return -ENOMEM;

S
Steffen Klassert 已提交
687 688
	ahash = crypto_alloc_ahash(x->aalg->alg_name, 0, 0);
	if (IS_ERR(ahash))
689 690
		goto error;

S
Steffen Klassert 已提交
691 692
	ahp->ahash = ahash;
	if (crypto_ahash_setkey(ahash, x->aalg->alg_key,
693
			       (x->aalg->alg_key_len + 7) / 8))
L
Linus Torvalds 已提交
694
		goto error;
695

L
Linus Torvalds 已提交
696 697 698 699
	/*
	 * Lookup the algorithm description maintained by xfrm_algo,
	 * verify crypto transform properties, and store information
	 * we need for AH processing.  This lookup cannot fail here
700
	 * after a successful crypto_alloc_hash().
L
Linus Torvalds 已提交
701 702 703 704 705
	 */
	aalg_desc = xfrm_aalg_get_byname(x->aalg->alg_name, 0);
	BUG_ON(!aalg_desc);

	if (aalg_desc->uinfo.auth.icv_fullbits/8 !=
S
Steffen Klassert 已提交
706
	    crypto_ahash_digestsize(ahash)) {
707 708 709
		pr_info("AH: %s digestsize %u != %hu\n",
			x->aalg->alg_name, crypto_ahash_digestsize(ahash),
			aalg_desc->uinfo.auth.icv_fullbits/8);
L
Linus Torvalds 已提交
710 711
		goto error;
	}
712

L
Linus Torvalds 已提交
713
	ahp->icv_full_len = aalg_desc->uinfo.auth.icv_fullbits/8;
714
	ahp->icv_trunc_len = x->aalg->alg_trunc_len/8;
715

L
Linus Torvalds 已提交
716
	BUG_ON(ahp->icv_trunc_len > MAX_AH_AUTH_LEN);
717

718 719
	x->props.header_len = XFRM_ALIGN8(sizeof(struct ip_auth_hdr) +
					  ahp->icv_trunc_len);
720 721 722 723 724
	switch (x->props.mode) {
	case XFRM_MODE_BEET:
	case XFRM_MODE_TRANSPORT:
		break;
	case XFRM_MODE_TUNNEL:
L
Linus Torvalds 已提交
725
		x->props.header_len += sizeof(struct ipv6hdr);
726
		break;
727 728 729
	default:
		goto error;
	}
L
Linus Torvalds 已提交
730 731 732 733 734 735
	x->data = ahp;

	return 0;

error:
	if (ahp) {
S
Steffen Klassert 已提交
736
		crypto_free_ahash(ahp->ahash);
L
Linus Torvalds 已提交
737 738 739 740 741 742 743 744 745 746 747 748
		kfree(ahp);
	}
	return -EINVAL;
}

static void ah6_destroy(struct xfrm_state *x)
{
	struct ah_data *ahp = x->data;

	if (!ahp)
		return;

S
Steffen Klassert 已提交
749
	crypto_free_ahash(ahp->ahash);
L
Linus Torvalds 已提交
750 751 752
	kfree(ahp);
}

753 754 755 756 757
static int ah6_rcv_cb(struct sk_buff *skb, int err)
{
	return 0;
}

758
static const struct xfrm_type ah6_type =
L
Linus Torvalds 已提交
759 760 761 762
{
	.description	= "AH6",
	.owner		= THIS_MODULE,
	.proto	     	= IPPROTO_AH,
763
	.flags		= XFRM_TYPE_REPLAY_PROT,
L
Linus Torvalds 已提交
764 765 766
	.init_state	= ah6_init_state,
	.destructor	= ah6_destroy,
	.input		= ah6_input,
767 768
	.output		= ah6_output,
	.hdr_offset	= xfrm6_find_1stfragopt,
L
Linus Torvalds 已提交
769 770
};

771
static struct xfrm6_protocol ah6_protocol = {
L
Linus Torvalds 已提交
772
	.handler	=	xfrm6_rcv,
773
	.cb_handler	=	ah6_rcv_cb,
L
Linus Torvalds 已提交
774
	.err_handler	=	ah6_err,
775
	.priority	=	0,
L
Linus Torvalds 已提交
776 777 778 779 780
};

static int __init ah6_init(void)
{
	if (xfrm_register_type(&ah6_type, AF_INET6) < 0) {
781
		pr_info("%s: can't add xfrm type\n", __func__);
L
Linus Torvalds 已提交
782 783 784
		return -EAGAIN;
	}

785
	if (xfrm6_protocol_register(&ah6_protocol, IPPROTO_AH) < 0) {
786
		pr_info("%s: can't add protocol\n", __func__);
L
Linus Torvalds 已提交
787 788 789 790 791 792 793 794 795
		xfrm_unregister_type(&ah6_type, AF_INET6);
		return -EAGAIN;
	}

	return 0;
}

static void __exit ah6_fini(void)
{
796
	if (xfrm6_protocol_deregister(&ah6_protocol, IPPROTO_AH) < 0)
797
		pr_info("%s: can't remove protocol\n", __func__);
L
Linus Torvalds 已提交
798 799

	if (xfrm_unregister_type(&ah6_type, AF_INET6) < 0)
800
		pr_info("%s: can't remove xfrm type\n", __func__);
L
Linus Torvalds 已提交
801 802 803 804 805 806 807

}

module_init(ah6_init);
module_exit(ah6_fini);

MODULE_LICENSE("GPL");
808
MODULE_ALIAS_XFRM_TYPE(AF_INET6, XFRM_PROTO_AH);