Blame view

crypto/authenc.c 19.8 KB
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
1
2
3
4
5
6
7
8
9
10
11
  /*
   * Authenc: Simple AEAD wrapper for IPsec
   *
   * Copyright (c) 2007 Herbert Xu <herbert@gondor.apana.org.au>
   *
   * 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.
   *
   */
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
12
  #include <crypto/aead.h>
5f7082ed4   Herbert Xu   crypto: hash - Ex...
13
  #include <crypto/internal/hash.h>
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
14
  #include <crypto/internal/skcipher.h>
e236d4a89   Herbert Xu   [CRYPTO] authenc:...
15
  #include <crypto/authenc.h>
42c271c6c   Herbert Xu   [CRYPTO] scatterw...
16
  #include <crypto/scatterwalk.h>
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
17
18
19
20
  #include <linux/err.h>
  #include <linux/init.h>
  #include <linux/kernel.h>
  #include <linux/module.h>
e236d4a89   Herbert Xu   [CRYPTO] authenc:...
21
  #include <linux/rtnetlink.h>
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
22
23
  #include <linux/slab.h>
  #include <linux/spinlock.h>
cbdcf80d8   Steffen Klassert   crypto: authenc -...
24
  typedef u8 *(*authenc_ahash_t)(struct aead_request *req, unsigned int flags);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
25
  struct authenc_instance_ctx {
cbdcf80d8   Steffen Klassert   crypto: authenc -...
26
  	struct crypto_ahash_spawn auth;
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
27
  	struct crypto_skcipher_spawn enc;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
28
29
30
  };
  
  struct crypto_authenc_ctx {
cbdcf80d8   Steffen Klassert   crypto: authenc -...
31
32
  	unsigned int reqoff;
  	struct crypto_ahash *auth;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
33
34
  	struct crypto_ablkcipher *enc;
  };
cbdcf80d8   Steffen Klassert   crypto: authenc -...
35
36
37
38
39
40
41
42
43
  struct authenc_request_ctx {
  	unsigned int cryptlen;
  	struct scatterlist *sg;
  	struct scatterlist asg[2];
  	struct scatterlist cipher[2];
  	crypto_completion_t complete;
  	crypto_completion_t update_complete;
  	char tail[];
  };
180ce7e81   Herbert Xu   crypto: authenc -...
44
45
46
47
48
  static void authenc_request_complete(struct aead_request *req, int err)
  {
  	if (err != -EINPROGRESS)
  		aead_request_complete(req, err);
  }
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
49
50
51
  static int crypto_authenc_setkey(struct crypto_aead *authenc, const u8 *key,
  				 unsigned int keylen)
  {
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
52
  	unsigned int authkeylen;
e236d4a89   Herbert Xu   [CRYPTO] authenc:...
53
  	unsigned int enckeylen;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
54
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
55
  	struct crypto_ahash *auth = ctx->auth;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
56
  	struct crypto_ablkcipher *enc = ctx->enc;
e236d4a89   Herbert Xu   [CRYPTO] authenc:...
57
58
  	struct rtattr *rta = (void *)key;
  	struct crypto_authenc_key_param *param;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
59
  	int err = -EINVAL;
12dc5e62b   Herbert Xu   [CRYPTO] authenc:...
60
  	if (!RTA_OK(rta, keylen))
e236d4a89   Herbert Xu   [CRYPTO] authenc:...
61
62
63
64
65
66
67
68
69
70
71
72
73
74
  		goto badkey;
  	if (rta->rta_type != CRYPTO_AUTHENC_KEYA_PARAM)
  		goto badkey;
  	if (RTA_PAYLOAD(rta) < sizeof(*param))
  		goto badkey;
  
  	param = RTA_DATA(rta);
  	enckeylen = be32_to_cpu(param->enckeylen);
  
  	key += RTA_ALIGN(rta->rta_len);
  	keylen -= RTA_ALIGN(rta->rta_len);
  
  	if (keylen < enckeylen)
  		goto badkey;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
75
  	authkeylen = keylen - enckeylen;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
76
77
  	crypto_ahash_clear_flags(auth, CRYPTO_TFM_REQ_MASK);
  	crypto_ahash_set_flags(auth, crypto_aead_get_flags(authenc) &
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
78
  				    CRYPTO_TFM_REQ_MASK);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
79
80
  	err = crypto_ahash_setkey(auth, key, authkeylen);
  	crypto_aead_set_flags(authenc, crypto_ahash_get_flags(auth) &
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
81
82
83
84
85
86
87
88
89
90
91
92
93
94
  				       CRYPTO_TFM_RES_MASK);
  
  	if (err)
  		goto out;
  
  	crypto_ablkcipher_clear_flags(enc, CRYPTO_TFM_REQ_MASK);
  	crypto_ablkcipher_set_flags(enc, crypto_aead_get_flags(authenc) &
  					 CRYPTO_TFM_REQ_MASK);
  	err = crypto_ablkcipher_setkey(enc, key + authkeylen, enckeylen);
  	crypto_aead_set_flags(authenc, crypto_ablkcipher_get_flags(enc) &
  				       CRYPTO_TFM_RES_MASK);
  
  out:
  	return err;
e236d4a89   Herbert Xu   [CRYPTO] authenc:...
95
96
97
98
  
  badkey:
  	crypto_aead_set_flags(authenc, CRYPTO_TFM_RES_BAD_KEY_LEN);
  	goto out;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
99
  }
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
100
101
102
103
104
105
106
107
108
109
110
111
112
  static void authenc_chain(struct scatterlist *head, struct scatterlist *sg,
  			  int chain)
  {
  	if (chain) {
  		head->length += sg->length;
  		sg = scatterwalk_sg_next(sg);
  	}
  
  	if (sg)
  		scatterwalk_sg_chain(head, 2, sg);
  	else
  		sg_mark_end(head);
  }
cbdcf80d8   Steffen Klassert   crypto: authenc -...
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
  static void authenc_geniv_ahash_update_done(struct crypto_async_request *areq,
  					    int err)
  {
  	struct aead_request *req = areq->data;
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
  	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);
  
  	if (err)
  		goto out;
  
  	ahash_request_set_crypt(ahreq, areq_ctx->sg, ahreq->result,
  				areq_ctx->cryptlen);
  	ahash_request_set_callback(ahreq, aead_request_flags(req) &
  					  CRYPTO_TFM_REQ_MAY_SLEEP,
  				   areq_ctx->complete, req);
  
  	err = crypto_ahash_finup(ahreq);
  	if (err)
  		goto out;
  
  	scatterwalk_map_and_copy(ahreq->result, areq_ctx->sg,
  				 areq_ctx->cryptlen,
  				 crypto_aead_authsize(authenc), 1);
  
  out:
180ce7e81   Herbert Xu   crypto: authenc -...
140
  	authenc_request_complete(req, err);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
  }
  
  static void authenc_geniv_ahash_done(struct crypto_async_request *areq, int err)
  {
  	struct aead_request *req = areq->data;
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
  	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);
  
  	if (err)
  		goto out;
  
  	scatterwalk_map_and_copy(ahreq->result, areq_ctx->sg,
  				 areq_ctx->cryptlen,
  				 crypto_aead_authsize(authenc), 1);
  
  out:
  	aead_request_complete(req, err);
  }
  
  static void authenc_verify_ahash_update_done(struct crypto_async_request *areq,
  					     int err)
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
164
  {
cbdcf80d8   Steffen Klassert   crypto: authenc -...
165
166
167
168
  	u8 *ihash;
  	unsigned int authsize;
  	struct ablkcipher_request *abreq;
  	struct aead_request *req = areq->data;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
169
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
170
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
171
172
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
  	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);
921bae546   Shikhar Khattar   crypto: authenc -...
173
  	unsigned int cryptlen = req->cryptlen;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
  
  	if (err)
  		goto out;
  
  	ahash_request_set_crypt(ahreq, areq_ctx->sg, ahreq->result,
  				areq_ctx->cryptlen);
  	ahash_request_set_callback(ahreq, aead_request_flags(req) &
  					  CRYPTO_TFM_REQ_MAY_SLEEP,
  				   areq_ctx->complete, req);
  
  	err = crypto_ahash_finup(ahreq);
  	if (err)
  		goto out;
  
  	authsize = crypto_aead_authsize(authenc);
921bae546   Shikhar Khattar   crypto: authenc -...
189
  	cryptlen -= authsize;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
190
191
192
  	ihash = ahreq->result + authsize;
  	scatterwalk_map_and_copy(ihash, areq_ctx->sg, areq_ctx->cryptlen,
  				 authsize, 0);
f3542e6d7   Richard Hartmann   crypto: authenc -...
193
  	err = memcmp(ihash, ahreq->result, authsize) ? -EBADMSG : 0;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
194
195
196
197
198
199
200
201
  	if (err)
  		goto out;
  
  	abreq = aead_request_ctx(req);
  	ablkcipher_request_set_tfm(abreq, ctx->enc);
  	ablkcipher_request_set_callback(abreq, aead_request_flags(req),
  					req->base.complete, req->base.data);
  	ablkcipher_request_set_crypt(abreq, req->src, req->dst,
921bae546   Shikhar Khattar   crypto: authenc -...
202
  				     cryptlen, req->iv);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
203
204
205
206
  
  	err = crypto_ablkcipher_decrypt(abreq);
  
  out:
180ce7e81   Herbert Xu   crypto: authenc -...
207
  	authenc_request_complete(req, err);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
208
209
210
211
212
213
214
215
216
217
218
219
220
  }
  
  static void authenc_verify_ahash_done(struct crypto_async_request *areq,
  				      int err)
  {
  	u8 *ihash;
  	unsigned int authsize;
  	struct ablkcipher_request *abreq;
  	struct aead_request *req = areq->data;
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
  	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);
921bae546   Shikhar Khattar   crypto: authenc -...
221
  	unsigned int cryptlen = req->cryptlen;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
222
223
224
225
226
  
  	if (err)
  		goto out;
  
  	authsize = crypto_aead_authsize(authenc);
921bae546   Shikhar Khattar   crypto: authenc -...
227
  	cryptlen -= authsize;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
228
229
230
  	ihash = ahreq->result + authsize;
  	scatterwalk_map_and_copy(ihash, areq_ctx->sg, areq_ctx->cryptlen,
  				 authsize, 0);
f3542e6d7   Richard Hartmann   crypto: authenc -...
231
  	err = memcmp(ihash, ahreq->result, authsize) ? -EBADMSG : 0;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
232
233
234
235
236
237
238
239
  	if (err)
  		goto out;
  
  	abreq = aead_request_ctx(req);
  	ablkcipher_request_set_tfm(abreq, ctx->enc);
  	ablkcipher_request_set_callback(abreq, aead_request_flags(req),
  					req->base.complete, req->base.data);
  	ablkcipher_request_set_crypt(abreq, req->src, req->dst,
921bae546   Shikhar Khattar   crypto: authenc -...
240
  				     cryptlen, req->iv);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
241
242
243
244
  
  	err = crypto_ablkcipher_decrypt(abreq);
  
  out:
180ce7e81   Herbert Xu   crypto: authenc -...
245
  	authenc_request_complete(req, err);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
246
247
248
249
250
251
252
253
254
255
  }
  
  static u8 *crypto_authenc_ahash_fb(struct aead_request *req, unsigned int flags)
  {
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
  	struct crypto_ahash *auth = ctx->auth;
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
  	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);
  	u8 *hash = areq_ctx->tail;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
256
  	int err;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
257
258
259
260
  	hash = (u8 *)ALIGN((unsigned long)hash + crypto_ahash_alignmask(auth),
  			    crypto_ahash_alignmask(auth) + 1);
  
  	ahash_request_set_tfm(ahreq, auth);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
261

cbdcf80d8   Steffen Klassert   crypto: authenc -...
262
  	err = crypto_ahash_init(ahreq);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
263
  	if (err)
cbdcf80d8   Steffen Klassert   crypto: authenc -...
264
265
266
267
268
  		return ERR_PTR(err);
  
  	ahash_request_set_crypt(ahreq, req->assoc, hash, req->assoclen);
  	ahash_request_set_callback(ahreq, aead_request_flags(req) & flags,
  				   areq_ctx->update_complete, req);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
269

cbdcf80d8   Steffen Klassert   crypto: authenc -...
270
  	err = crypto_ahash_update(ahreq);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
271
  	if (err)
cbdcf80d8   Steffen Klassert   crypto: authenc -...
272
273
274
275
276
277
  		return ERR_PTR(err);
  
  	ahash_request_set_crypt(ahreq, areq_ctx->sg, hash,
  				areq_ctx->cryptlen);
  	ahash_request_set_callback(ahreq, aead_request_flags(req) & flags,
  				   areq_ctx->complete, req);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
278

cbdcf80d8   Steffen Klassert   crypto: authenc -...
279
  	err = crypto_ahash_finup(ahreq);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
280
  	if (err)
cbdcf80d8   Steffen Klassert   crypto: authenc -...
281
  		return ERR_PTR(err);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
282

cbdcf80d8   Steffen Klassert   crypto: authenc -...
283
284
285
286
287
288
289
290
291
292
293
294
  	return hash;
  }
  
  static u8 *crypto_authenc_ahash(struct aead_request *req, unsigned int flags)
  {
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
  	struct crypto_ahash *auth = ctx->auth;
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
  	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);
  	u8 *hash = areq_ctx->tail;
  	int err;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
295

cbdcf80d8   Steffen Klassert   crypto: authenc -...
296
297
298
299
300
301
302
303
304
305
  	hash = (u8 *)ALIGN((unsigned long)hash + crypto_ahash_alignmask(auth),
  			   crypto_ahash_alignmask(auth) + 1);
  
  	ahash_request_set_tfm(ahreq, auth);
  	ahash_request_set_crypt(ahreq, areq_ctx->sg, hash,
  				areq_ctx->cryptlen);
  	ahash_request_set_callback(ahreq, aead_request_flags(req) & flags,
  				   areq_ctx->complete, req);
  
  	err = crypto_ahash_digest(ahreq);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
306
  	if (err)
7c3d703fa   Herbert Xu   [CRYPTO] authenc:...
307
308
309
310
  		return ERR_PTR(err);
  
  	return hash;
  }
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
311
312
  static int crypto_authenc_genicv(struct aead_request *req, u8 *iv,
  				 unsigned int flags)
7c3d703fa   Herbert Xu   [CRYPTO] authenc:...
313
314
  {
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
315
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
7c3d703fa   Herbert Xu   [CRYPTO] authenc:...
316
  	struct scatterlist *dst = req->dst;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
317
318
319
  	struct scatterlist *assoc = req->assoc;
  	struct scatterlist *cipher = areq_ctx->cipher;
  	struct scatterlist *asg = areq_ctx->asg;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
320
  	unsigned int ivsize = crypto_aead_ivsize(authenc);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
321
322
323
  	unsigned int cryptlen = req->cryptlen;
  	authenc_ahash_t authenc_ahash_fn = crypto_authenc_ahash_fb;
  	struct page *dstp;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
324
  	u8 *vdst;
7c3d703fa   Herbert Xu   [CRYPTO] authenc:...
325
  	u8 *hash;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
326
327
  	dstp = sg_page(dst);
  	vdst = PageHighMem(dstp) ? NULL : page_address(dstp) + dst->offset;
29b37f421   Herbert Xu   crypto: authenc -...
328
329
330
331
332
  	if (ivsize) {
  		sg_init_table(cipher, 2);
  		sg_set_buf(cipher, iv, ivsize);
  		authenc_chain(cipher, dst, vdst == iv + ivsize);
  		dst = cipher;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
333
  		cryptlen += ivsize;
29b37f421   Herbert Xu   crypto: authenc -...
334
  	}
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
335

cbdcf80d8   Steffen Klassert   crypto: authenc -...
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
  	if (sg_is_last(assoc)) {
  		authenc_ahash_fn = crypto_authenc_ahash;
  		sg_init_table(asg, 2);
  		sg_set_page(asg, sg_page(assoc), assoc->length, assoc->offset);
  		authenc_chain(asg, dst, 0);
  		dst = asg;
  		cryptlen += req->assoclen;
  	}
  
  	areq_ctx->cryptlen = cryptlen;
  	areq_ctx->sg = dst;
  
  	areq_ctx->complete = authenc_geniv_ahash_done;
  	areq_ctx->update_complete = authenc_geniv_ahash_update_done;
  
  	hash = authenc_ahash_fn(req, flags);
7c3d703fa   Herbert Xu   [CRYPTO] authenc:...
352
353
  	if (IS_ERR(hash))
  		return PTR_ERR(hash);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
354

29b37f421   Herbert Xu   crypto: authenc -...
355
  	scatterwalk_map_and_copy(hash, dst, cryptlen,
7ba683a6d   Herbert Xu   [CRYPTO] aead: Ma...
356
  				 crypto_aead_authsize(authenc), 1);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
357
358
359
360
361
362
  	return 0;
  }
  
  static void crypto_authenc_encrypt_done(struct crypto_async_request *req,
  					int err)
  {
a697690be   Herbert Xu   crypto: authenc -...
363
  	struct aead_request *areq = req->data;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
364
  	if (!err) {
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
365
366
367
368
369
370
371
372
  		struct crypto_aead *authenc = crypto_aead_reqtfm(areq);
  		struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
  		struct ablkcipher_request *abreq = aead_request_ctx(areq);
  		u8 *iv = (u8 *)(abreq + 1) +
  			 crypto_ablkcipher_reqsize(ctx->enc);
  
  		err = crypto_authenc_genicv(areq, iv, 0);
  	}
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
373

180ce7e81   Herbert Xu   crypto: authenc -...
374
  	authenc_request_complete(areq, err);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
375
376
377
378
379
380
  }
  
  static int crypto_authenc_encrypt(struct aead_request *req)
  {
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
50beceba7   Steffen Klassert   crypto: authenc -...
381
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
382
383
384
  	struct crypto_ablkcipher *enc = ctx->enc;
  	struct scatterlist *dst = req->dst;
  	unsigned int cryptlen = req->cryptlen;
50beceba7   Steffen Klassert   crypto: authenc -...
385
386
387
  	struct ablkcipher_request *abreq = (void *)(areq_ctx->tail
  						    + ctx->reqoff);
  	u8 *iv = (u8 *)abreq - crypto_ablkcipher_ivsize(enc);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
388
  	int err;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
389
  	ablkcipher_request_set_tfm(abreq, enc);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
390
391
  	ablkcipher_request_set_callback(abreq, aead_request_flags(req),
  					crypto_authenc_encrypt_done, req);
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
392
393
394
  	ablkcipher_request_set_crypt(abreq, req->src, dst, cryptlen, req->iv);
  
  	memcpy(iv, req->iv, crypto_aead_ivsize(authenc));
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
395
396
397
398
  
  	err = crypto_ablkcipher_encrypt(abreq);
  	if (err)
  		return err;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
399
400
401
402
403
404
  	return crypto_authenc_genicv(req, iv, CRYPTO_TFM_REQ_MAY_SLEEP);
  }
  
  static void crypto_authenc_givencrypt_done(struct crypto_async_request *req,
  					   int err)
  {
a697690be   Herbert Xu   crypto: authenc -...
405
  	struct aead_request *areq = req->data;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
406
  	if (!err) {
161613293   Patrick McHardy   [CRYPTO] authenc:...
407
  		struct skcipher_givcrypt_request *greq = aead_request_ctx(areq);
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
408

161613293   Patrick McHardy   [CRYPTO] authenc:...
409
  		err = crypto_authenc_genicv(areq, greq->giv, 0);
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
410
  	}
180ce7e81   Herbert Xu   crypto: authenc -...
411
  	authenc_request_complete(areq, err);
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
  }
  
  static int crypto_authenc_givencrypt(struct aead_givcrypt_request *req)
  {
  	struct crypto_aead *authenc = aead_givcrypt_reqtfm(req);
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
  	struct aead_request *areq = &req->areq;
  	struct skcipher_givcrypt_request *greq = aead_request_ctx(areq);
  	u8 *iv = req->giv;
  	int err;
  
  	skcipher_givcrypt_set_tfm(greq, ctx->enc);
  	skcipher_givcrypt_set_callback(greq, aead_request_flags(areq),
  				       crypto_authenc_givencrypt_done, areq);
  	skcipher_givcrypt_set_crypt(greq, areq->src, areq->dst, areq->cryptlen,
  				    areq->iv);
  	skcipher_givcrypt_set_giv(greq, iv, req->seq);
  
  	err = crypto_skcipher_givencrypt(greq);
  	if (err)
  		return err;
  
  	return crypto_authenc_genicv(areq, iv, CRYPTO_TFM_REQ_MAY_SLEEP);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
435
  }
481f34ae7   Herbert Xu   [CRYPTO] authenc:...
436
  static int crypto_authenc_verify(struct aead_request *req,
cbdcf80d8   Steffen Klassert   crypto: authenc -...
437
  				 authenc_ahash_t authenc_ahash_fn)
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
438
439
  {
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
440
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
7c3d703fa   Herbert Xu   [CRYPTO] authenc:...
441
  	u8 *ohash;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
442
  	u8 *ihash;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
443
  	unsigned int authsize;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
444

cbdcf80d8   Steffen Klassert   crypto: authenc -...
445
  	areq_ctx->complete = authenc_verify_ahash_done;
77ba115c4   Steffen Klassert   crypto: authenc -...
446
  	areq_ctx->update_complete = authenc_verify_ahash_update_done;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
447
448
  
  	ohash = authenc_ahash_fn(req, CRYPTO_TFM_REQ_MAY_SLEEP);
7c3d703fa   Herbert Xu   [CRYPTO] authenc:...
449
450
  	if (IS_ERR(ohash))
  		return PTR_ERR(ohash);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
451

7ba683a6d   Herbert Xu   [CRYPTO] aead: Ma...
452
  	authsize = crypto_aead_authsize(authenc);
7c3d703fa   Herbert Xu   [CRYPTO] authenc:...
453
  	ihash = ohash + authsize;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
454
455
  	scatterwalk_map_and_copy(ihash, areq_ctx->sg, areq_ctx->cryptlen,
  				 authsize, 0);
f3542e6d7   Richard Hartmann   crypto: authenc -...
456
  	return memcmp(ihash, ohash, authsize) ? -EBADMSG : 0;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
457
  }
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
458
459
  static int crypto_authenc_iverify(struct aead_request *req, u8 *iv,
  				  unsigned int cryptlen)
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
460
  {
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
461
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
462
  	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
463
  	struct scatterlist *src = req->src;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
464
465
466
  	struct scatterlist *assoc = req->assoc;
  	struct scatterlist *cipher = areq_ctx->cipher;
  	struct scatterlist *asg = areq_ctx->asg;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
467
  	unsigned int ivsize = crypto_aead_ivsize(authenc);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
468
469
  	authenc_ahash_t authenc_ahash_fn = crypto_authenc_ahash_fb;
  	struct page *srcp;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
470
471
472
473
  	u8 *vsrc;
  
  	srcp = sg_page(src);
  	vsrc = PageHighMem(srcp) ? NULL : page_address(srcp) + src->offset;
29b37f421   Herbert Xu   crypto: authenc -...
474
475
476
477
478
  	if (ivsize) {
  		sg_init_table(cipher, 2);
  		sg_set_buf(cipher, iv, ivsize);
  		authenc_chain(cipher, src, vsrc == iv + ivsize);
  		src = cipher;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
479
480
481
482
483
484
485
486
487
488
  		cryptlen += ivsize;
  	}
  
  	if (sg_is_last(assoc)) {
  		authenc_ahash_fn = crypto_authenc_ahash;
  		sg_init_table(asg, 2);
  		sg_set_page(asg, sg_page(assoc), assoc->length, assoc->offset);
  		authenc_chain(asg, src, 0);
  		src = asg;
  		cryptlen += req->assoclen;
29b37f421   Herbert Xu   crypto: authenc -...
489
  	}
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
490

cbdcf80d8   Steffen Klassert   crypto: authenc -...
491
492
493
494
  	areq_ctx->cryptlen = cryptlen;
  	areq_ctx->sg = src;
  
  	return crypto_authenc_verify(req, authenc_ahash_fn);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
495
496
497
498
499
500
501
  }
  
  static int crypto_authenc_decrypt(struct aead_request *req)
  {
  	struct crypto_aead *authenc = crypto_aead_reqtfm(req);
  	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
  	struct ablkcipher_request *abreq = aead_request_ctx(req);
481f34ae7   Herbert Xu   [CRYPTO] authenc:...
502
503
  	unsigned int cryptlen = req->cryptlen;
  	unsigned int authsize = crypto_aead_authsize(authenc);
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
504
  	u8 *iv = req->iv;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
505
  	int err;
481f34ae7   Herbert Xu   [CRYPTO] authenc:...
506
507
508
  	if (cryptlen < authsize)
  		return -EINVAL;
  	cryptlen -= authsize;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
509
  	err = crypto_authenc_iverify(req, iv, cryptlen);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
510
511
512
513
514
  	if (err)
  		return err;
  
  	ablkcipher_request_set_tfm(abreq, ctx->enc);
  	ablkcipher_request_set_callback(abreq, aead_request_flags(req),
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
515
516
  					req->base.complete, req->base.data);
  	ablkcipher_request_set_crypt(abreq, req->src, req->dst, cryptlen, iv);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
517
518
519
520
521
522
  
  	return crypto_ablkcipher_decrypt(abreq);
  }
  
  static int crypto_authenc_init_tfm(struct crypto_tfm *tfm)
  {
cbdcf80d8   Steffen Klassert   crypto: authenc -...
523
  	struct crypto_instance *inst = crypto_tfm_alg_instance(tfm);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
524
525
  	struct authenc_instance_ctx *ictx = crypto_instance_ctx(inst);
  	struct crypto_authenc_ctx *ctx = crypto_tfm_ctx(tfm);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
526
  	struct crypto_ahash *auth;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
527
  	struct crypto_ablkcipher *enc;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
528
  	int err;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
529
  	auth = crypto_spawn_ahash(&ictx->auth);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
530
531
  	if (IS_ERR(auth))
  		return PTR_ERR(auth);
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
532
  	enc = crypto_spawn_skcipher(&ictx->enc);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
533
534
  	err = PTR_ERR(enc);
  	if (IS_ERR(enc))
cbdcf80d8   Steffen Klassert   crypto: authenc -...
535
  		goto err_free_ahash;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
536
537
538
  
  	ctx->auth = auth;
  	ctx->enc = enc;
f3542e6d7   Richard Hartmann   crypto: authenc -...
539

50beceba7   Steffen Klassert   crypto: authenc -...
540
541
542
543
544
545
546
547
548
  	ctx->reqoff = ALIGN(2 * crypto_ahash_digestsize(auth) +
  			    crypto_ahash_alignmask(auth),
  			    crypto_ahash_alignmask(auth) + 1) +
  		      crypto_ablkcipher_ivsize(enc);
  
  	tfm->crt_aead.reqsize = sizeof(struct authenc_request_ctx) +
  				ctx->reqoff +
  				max_t(unsigned int,
  				crypto_ahash_reqsize(auth) +
f3542e6d7   Richard Hartmann   crypto: authenc -...
549
  				sizeof(struct ahash_request),
cbdcf80d8   Steffen Klassert   crypto: authenc -...
550
  				sizeof(struct skcipher_givcrypt_request) +
50beceba7   Steffen Klassert   crypto: authenc -...
551
  				crypto_ablkcipher_reqsize(enc));
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
552
553
  
  	return 0;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
554
555
  err_free_ahash:
  	crypto_free_ahash(auth);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
556
557
558
559
560
561
  	return err;
  }
  
  static void crypto_authenc_exit_tfm(struct crypto_tfm *tfm)
  {
  	struct crypto_authenc_ctx *ctx = crypto_tfm_ctx(tfm);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
562
  	crypto_free_ahash(ctx->auth);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
563
564
565
566
567
  	crypto_free_ablkcipher(ctx->enc);
  }
  
  static struct crypto_instance *crypto_authenc_alloc(struct rtattr **tb)
  {
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
568
  	struct crypto_attr_type *algt;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
569
  	struct crypto_instance *inst;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
570
571
  	struct hash_alg_common *auth;
  	struct crypto_alg *auth_base;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
572
573
  	struct crypto_alg *enc;
  	struct authenc_instance_ctx *ctx;
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
574
  	const char *enc_name;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
575
  	int err;
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
576
577
578
  	algt = crypto_get_attr_type(tb);
  	err = PTR_ERR(algt);
  	if (IS_ERR(algt))
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
579
  		return ERR_PTR(err);
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
580
581
  	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
  		return ERR_PTR(-EINVAL);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
582
583
  	auth = ahash_attr_alg(tb[1], CRYPTO_ALG_TYPE_HASH,
  			       CRYPTO_ALG_TYPE_AHASH_MASK);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
584
  	if (IS_ERR(auth))
8db050786   Julia Lawall   crypto: Use ERR_CAST
585
  		return ERR_CAST(auth);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
586

cbdcf80d8   Steffen Klassert   crypto: authenc -...
587
  	auth_base = &auth->base;
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
588
589
590
  	enc_name = crypto_attr_alg_name(tb[2]);
  	err = PTR_ERR(enc_name);
  	if (IS_ERR(enc_name))
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
591
  		goto out_put_auth;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
592
593
594
  	inst = kzalloc(sizeof(*inst) + sizeof(*ctx), GFP_KERNEL);
  	err = -ENOMEM;
  	if (!inst)
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
595
  		goto out_put_auth;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
596
597
  
  	ctx = crypto_instance_ctx(inst);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
598

cbdcf80d8   Steffen Klassert   crypto: authenc -...
599
  	err = crypto_init_ahash_spawn(&ctx->auth, auth, inst);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
600
601
  	if (err)
  		goto err_free_inst;
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
602
603
604
605
  	crypto_set_skcipher_spawn(&ctx->enc, inst);
  	err = crypto_grab_skcipher(&ctx->enc, enc_name, 0,
  				   crypto_requires_sync(algt->type,
  							algt->mask));
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
606
607
  	if (err)
  		goto err_drop_auth;
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
608
609
610
611
  	enc = crypto_skcipher_spawn_alg(&ctx->enc);
  
  	err = -ENAMETOOLONG;
  	if (snprintf(inst->alg.cra_name, CRYPTO_MAX_ALG_NAME,
cbdcf80d8   Steffen Klassert   crypto: authenc -...
612
  		     "authenc(%s,%s)", auth_base->cra_name, enc->cra_name) >=
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
613
614
615
616
  	    CRYPTO_MAX_ALG_NAME)
  		goto err_drop_enc;
  
  	if (snprintf(inst->alg.cra_driver_name, CRYPTO_MAX_ALG_NAME,
cbdcf80d8   Steffen Klassert   crypto: authenc -...
617
  		     "authenc(%s,%s)", auth_base->cra_driver_name,
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
618
619
620
621
622
  		     enc->cra_driver_name) >= CRYPTO_MAX_ALG_NAME)
  		goto err_drop_enc;
  
  	inst->alg.cra_flags = CRYPTO_ALG_TYPE_AEAD;
  	inst->alg.cra_flags |= enc->cra_flags & CRYPTO_ALG_ASYNC;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
623
624
  	inst->alg.cra_priority = enc->cra_priority *
  				 10 + auth_base->cra_priority;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
625
  	inst->alg.cra_blocksize = enc->cra_blocksize;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
626
  	inst->alg.cra_alignmask = auth_base->cra_alignmask | enc->cra_alignmask;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
627
  	inst->alg.cra_type = &crypto_aead_type;
c2c61f513   Herbert Xu   [CRYPTO] authenc:...
628
  	inst->alg.cra_aead.ivsize = enc->cra_ablkcipher.ivsize;
cbdcf80d8   Steffen Klassert   crypto: authenc -...
629
  	inst->alg.cra_aead.maxauthsize = auth->digestsize;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
630
631
632
633
634
635
636
637
638
  
  	inst->alg.cra_ctxsize = sizeof(struct crypto_authenc_ctx);
  
  	inst->alg.cra_init = crypto_authenc_init_tfm;
  	inst->alg.cra_exit = crypto_authenc_exit_tfm;
  
  	inst->alg.cra_aead.setkey = crypto_authenc_setkey;
  	inst->alg.cra_aead.encrypt = crypto_authenc_encrypt;
  	inst->alg.cra_aead.decrypt = crypto_authenc_decrypt;
e56dd5641   Herbert Xu   [CRYPTO] authenc:...
639
  	inst->alg.cra_aead.givencrypt = crypto_authenc_givencrypt;
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
640
641
  
  out:
cbdcf80d8   Steffen Klassert   crypto: authenc -...
642
  	crypto_mod_put(auth_base);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
643
  	return inst;
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
644
645
  err_drop_enc:
  	crypto_drop_skcipher(&ctx->enc);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
646
  err_drop_auth:
cbdcf80d8   Steffen Klassert   crypto: authenc -...
647
  	crypto_drop_ahash(&ctx->auth);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
648
649
  err_free_inst:
  	kfree(inst);
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
650
  out_put_auth:
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
651
652
653
654
655
656
657
  	inst = ERR_PTR(err);
  	goto out;
  }
  
  static void crypto_authenc_free(struct crypto_instance *inst)
  {
  	struct authenc_instance_ctx *ctx = crypto_instance_ctx(inst);
9ffde35a8   Herbert Xu   [CRYPTO] authenc:...
658
  	crypto_drop_skcipher(&ctx->enc);
cbdcf80d8   Steffen Klassert   crypto: authenc -...
659
  	crypto_drop_ahash(&ctx->auth);
3c09f17c3   Herbert Xu   [CRYPTO] aead: Ad...
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
  	kfree(inst);
  }
  
  static struct crypto_template crypto_authenc_tmpl = {
  	.name = "authenc",
  	.alloc = crypto_authenc_alloc,
  	.free = crypto_authenc_free,
  	.module = THIS_MODULE,
  };
  
  static int __init crypto_authenc_module_init(void)
  {
  	return crypto_register_template(&crypto_authenc_tmpl);
  }
  
  static void __exit crypto_authenc_module_exit(void)
  {
  	crypto_unregister_template(&crypto_authenc_tmpl);
  }
  
  module_init(crypto_authenc_module_init);
  module_exit(crypto_authenc_module_exit);
  
  MODULE_LICENSE("GPL");
  MODULE_DESCRIPTION("Simple AEAD wrapper for IPsec");