algif_aead.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968
  1. /*
  2. * algif_aead: User-space interface for AEAD algorithms
  3. *
  4. * Copyright (C) 2014, Stephan Mueller <smueller@chronox.de>
  5. *
  6. * This file provides the user-space API for AEAD ciphers.
  7. *
  8. * This file is derived from algif_skcipher.c.
  9. *
  10. * This program is free software; you can redistribute it and/or modify it
  11. * under the terms of the GNU General Public License as published by the Free
  12. * Software Foundation; either version 2 of the License, or (at your option)
  13. * any later version.
  14. */
  15. #include <crypto/internal/aead.h>
  16. #include <crypto/scatterwalk.h>
  17. #include <crypto/if_alg.h>
  18. #include <linux/init.h>
  19. #include <linux/list.h>
  20. #include <linux/kernel.h>
  21. #include <linux/sched/signal.h>
  22. #include <linux/mm.h>
  23. #include <linux/module.h>
  24. #include <linux/net.h>
  25. #include <net/sock.h>
  26. struct aead_sg_list {
  27. unsigned int cur;
  28. struct scatterlist sg[ALG_MAX_PAGES];
  29. };
  30. struct aead_async_rsgl {
  31. struct af_alg_sgl sgl;
  32. struct list_head list;
  33. };
  34. struct aead_async_req {
  35. struct scatterlist *tsgl;
  36. struct aead_async_rsgl first_rsgl;
  37. struct list_head list;
  38. struct kiocb *iocb;
  39. struct sock *sk;
  40. unsigned int tsgls;
  41. char iv[];
  42. };
  43. struct aead_tfm {
  44. struct crypto_aead *aead;
  45. bool has_key;
  46. };
  47. struct aead_ctx {
  48. struct aead_sg_list tsgl;
  49. struct aead_async_rsgl first_rsgl;
  50. struct list_head list;
  51. void *iv;
  52. struct af_alg_completion completion;
  53. unsigned long used;
  54. unsigned int len;
  55. bool more;
  56. bool merge;
  57. bool enc;
  58. size_t aead_assoclen;
  59. struct aead_request aead_req;
  60. };
  61. static inline int aead_sndbuf(struct sock *sk)
  62. {
  63. struct alg_sock *ask = alg_sk(sk);
  64. struct aead_ctx *ctx = ask->private;
  65. return max_t(int, max_t(int, sk->sk_sndbuf & PAGE_MASK, PAGE_SIZE) -
  66. ctx->used, 0);
  67. }
  68. static inline bool aead_writable(struct sock *sk)
  69. {
  70. return PAGE_SIZE <= aead_sndbuf(sk);
  71. }
  72. static inline bool aead_sufficient_data(struct aead_ctx *ctx)
  73. {
  74. unsigned as = crypto_aead_authsize(crypto_aead_reqtfm(&ctx->aead_req));
  75. /*
  76. * The minimum amount of memory needed for an AEAD cipher is
  77. * the AAD and in case of decryption the tag.
  78. */
  79. return ctx->used >= ctx->aead_assoclen + (ctx->enc ? 0 : as);
  80. }
  81. static void aead_reset_ctx(struct aead_ctx *ctx)
  82. {
  83. struct aead_sg_list *sgl = &ctx->tsgl;
  84. sg_init_table(sgl->sg, ALG_MAX_PAGES);
  85. sgl->cur = 0;
  86. ctx->used = 0;
  87. ctx->more = 0;
  88. ctx->merge = 0;
  89. }
  90. static void aead_put_sgl(struct sock *sk)
  91. {
  92. struct alg_sock *ask = alg_sk(sk);
  93. struct aead_ctx *ctx = ask->private;
  94. struct aead_sg_list *sgl = &ctx->tsgl;
  95. struct scatterlist *sg = sgl->sg;
  96. unsigned int i;
  97. for (i = 0; i < sgl->cur; i++) {
  98. if (!sg_page(sg + i))
  99. continue;
  100. put_page(sg_page(sg + i));
  101. sg_assign_page(sg + i, NULL);
  102. }
  103. aead_reset_ctx(ctx);
  104. }
  105. static void aead_wmem_wakeup(struct sock *sk)
  106. {
  107. struct socket_wq *wq;
  108. if (!aead_writable(sk))
  109. return;
  110. rcu_read_lock();
  111. wq = rcu_dereference(sk->sk_wq);
  112. if (skwq_has_sleeper(wq))
  113. wake_up_interruptible_sync_poll(&wq->wait, POLLIN |
  114. POLLRDNORM |
  115. POLLRDBAND);
  116. sk_wake_async(sk, SOCK_WAKE_WAITD, POLL_IN);
  117. rcu_read_unlock();
  118. }
  119. static int aead_wait_for_data(struct sock *sk, unsigned flags)
  120. {
  121. DEFINE_WAIT_FUNC(wait, woken_wake_function);
  122. struct alg_sock *ask = alg_sk(sk);
  123. struct aead_ctx *ctx = ask->private;
  124. long timeout;
  125. int err = -ERESTARTSYS;
  126. if (flags & MSG_DONTWAIT)
  127. return -EAGAIN;
  128. sk_set_bit(SOCKWQ_ASYNC_WAITDATA, sk);
  129. add_wait_queue(sk_sleep(sk), &wait);
  130. for (;;) {
  131. if (signal_pending(current))
  132. break;
  133. timeout = MAX_SCHEDULE_TIMEOUT;
  134. if (sk_wait_event(sk, &timeout, !ctx->more, &wait)) {
  135. err = 0;
  136. break;
  137. }
  138. }
  139. remove_wait_queue(sk_sleep(sk), &wait);
  140. sk_clear_bit(SOCKWQ_ASYNC_WAITDATA, sk);
  141. return err;
  142. }
  143. static void aead_data_wakeup(struct sock *sk)
  144. {
  145. struct alg_sock *ask = alg_sk(sk);
  146. struct aead_ctx *ctx = ask->private;
  147. struct socket_wq *wq;
  148. if (ctx->more)
  149. return;
  150. if (!ctx->used)
  151. return;
  152. rcu_read_lock();
  153. wq = rcu_dereference(sk->sk_wq);
  154. if (skwq_has_sleeper(wq))
  155. wake_up_interruptible_sync_poll(&wq->wait, POLLOUT |
  156. POLLRDNORM |
  157. POLLRDBAND);
  158. sk_wake_async(sk, SOCK_WAKE_SPACE, POLL_OUT);
  159. rcu_read_unlock();
  160. }
  161. static int aead_sendmsg(struct socket *sock, struct msghdr *msg, size_t size)
  162. {
  163. struct sock *sk = sock->sk;
  164. struct alg_sock *ask = alg_sk(sk);
  165. struct aead_ctx *ctx = ask->private;
  166. unsigned ivsize =
  167. crypto_aead_ivsize(crypto_aead_reqtfm(&ctx->aead_req));
  168. struct aead_sg_list *sgl = &ctx->tsgl;
  169. struct af_alg_control con = {};
  170. long copied = 0;
  171. bool enc = 0;
  172. bool init = 0;
  173. int err = -EINVAL;
  174. if (msg->msg_controllen) {
  175. err = af_alg_cmsg_send(msg, &con);
  176. if (err)
  177. return err;
  178. init = 1;
  179. switch (con.op) {
  180. case ALG_OP_ENCRYPT:
  181. enc = 1;
  182. break;
  183. case ALG_OP_DECRYPT:
  184. enc = 0;
  185. break;
  186. default:
  187. return -EINVAL;
  188. }
  189. if (con.iv && con.iv->ivlen != ivsize)
  190. return -EINVAL;
  191. }
  192. lock_sock(sk);
  193. if (!ctx->more && ctx->used)
  194. goto unlock;
  195. if (init) {
  196. ctx->enc = enc;
  197. if (con.iv)
  198. memcpy(ctx->iv, con.iv->iv, ivsize);
  199. ctx->aead_assoclen = con.aead_assoclen;
  200. }
  201. while (size) {
  202. size_t len = size;
  203. struct scatterlist *sg = NULL;
  204. /* use the existing memory in an allocated page */
  205. if (ctx->merge) {
  206. sg = sgl->sg + sgl->cur - 1;
  207. len = min_t(unsigned long, len,
  208. PAGE_SIZE - sg->offset - sg->length);
  209. err = memcpy_from_msg(page_address(sg_page(sg)) +
  210. sg->offset + sg->length,
  211. msg, len);
  212. if (err)
  213. goto unlock;
  214. sg->length += len;
  215. ctx->merge = (sg->offset + sg->length) &
  216. (PAGE_SIZE - 1);
  217. ctx->used += len;
  218. copied += len;
  219. size -= len;
  220. continue;
  221. }
  222. if (!aead_writable(sk)) {
  223. /* user space sent too much data */
  224. aead_put_sgl(sk);
  225. err = -EMSGSIZE;
  226. goto unlock;
  227. }
  228. /* allocate a new page */
  229. len = min_t(unsigned long, size, aead_sndbuf(sk));
  230. while (len) {
  231. size_t plen = 0;
  232. if (sgl->cur >= ALG_MAX_PAGES) {
  233. aead_put_sgl(sk);
  234. err = -E2BIG;
  235. goto unlock;
  236. }
  237. sg = sgl->sg + sgl->cur;
  238. plen = min_t(size_t, len, PAGE_SIZE);
  239. sg_assign_page(sg, alloc_page(GFP_KERNEL));
  240. err = -ENOMEM;
  241. if (!sg_page(sg))
  242. goto unlock;
  243. err = memcpy_from_msg(page_address(sg_page(sg)),
  244. msg, plen);
  245. if (err) {
  246. __free_page(sg_page(sg));
  247. sg_assign_page(sg, NULL);
  248. goto unlock;
  249. }
  250. sg->offset = 0;
  251. sg->length = plen;
  252. len -= plen;
  253. ctx->used += plen;
  254. copied += plen;
  255. sgl->cur++;
  256. size -= plen;
  257. ctx->merge = plen & (PAGE_SIZE - 1);
  258. }
  259. }
  260. err = 0;
  261. ctx->more = msg->msg_flags & MSG_MORE;
  262. if (!ctx->more && !aead_sufficient_data(ctx)) {
  263. aead_put_sgl(sk);
  264. err = -EMSGSIZE;
  265. }
  266. unlock:
  267. aead_data_wakeup(sk);
  268. release_sock(sk);
  269. return err ?: copied;
  270. }
  271. static ssize_t aead_sendpage(struct socket *sock, struct page *page,
  272. int offset, size_t size, int flags)
  273. {
  274. struct sock *sk = sock->sk;
  275. struct alg_sock *ask = alg_sk(sk);
  276. struct aead_ctx *ctx = ask->private;
  277. struct aead_sg_list *sgl = &ctx->tsgl;
  278. int err = -EINVAL;
  279. if (flags & MSG_SENDPAGE_NOTLAST)
  280. flags |= MSG_MORE;
  281. if (sgl->cur >= ALG_MAX_PAGES)
  282. return -E2BIG;
  283. lock_sock(sk);
  284. if (!ctx->more && ctx->used)
  285. goto unlock;
  286. if (!size)
  287. goto done;
  288. if (!aead_writable(sk)) {
  289. /* user space sent too much data */
  290. aead_put_sgl(sk);
  291. err = -EMSGSIZE;
  292. goto unlock;
  293. }
  294. ctx->merge = 0;
  295. get_page(page);
  296. sg_set_page(sgl->sg + sgl->cur, page, size, offset);
  297. sgl->cur++;
  298. ctx->used += size;
  299. err = 0;
  300. done:
  301. ctx->more = flags & MSG_MORE;
  302. if (!ctx->more && !aead_sufficient_data(ctx)) {
  303. aead_put_sgl(sk);
  304. err = -EMSGSIZE;
  305. }
  306. unlock:
  307. aead_data_wakeup(sk);
  308. release_sock(sk);
  309. return err ?: size;
  310. }
  311. #define GET_ASYM_REQ(req, tfm) (struct aead_async_req *) \
  312. ((char *)req + sizeof(struct aead_request) + \
  313. crypto_aead_reqsize(tfm))
  314. #define GET_REQ_SIZE(tfm) sizeof(struct aead_async_req) + \
  315. crypto_aead_reqsize(tfm) + crypto_aead_ivsize(tfm) + \
  316. sizeof(struct aead_request)
  317. static void aead_async_cb(struct crypto_async_request *_req, int err)
  318. {
  319. struct aead_request *req = _req->data;
  320. struct crypto_aead *tfm = crypto_aead_reqtfm(req);
  321. struct aead_async_req *areq = GET_ASYM_REQ(req, tfm);
  322. struct sock *sk = areq->sk;
  323. struct scatterlist *sg = areq->tsgl;
  324. struct aead_async_rsgl *rsgl;
  325. struct kiocb *iocb = areq->iocb;
  326. unsigned int i, reqlen = GET_REQ_SIZE(tfm);
  327. list_for_each_entry(rsgl, &areq->list, list) {
  328. af_alg_free_sg(&rsgl->sgl);
  329. if (rsgl != &areq->first_rsgl)
  330. sock_kfree_s(sk, rsgl, sizeof(*rsgl));
  331. }
  332. for (i = 0; i < areq->tsgls; i++)
  333. put_page(sg_page(sg + i));
  334. sock_kfree_s(sk, areq->tsgl, sizeof(*areq->tsgl) * areq->tsgls);
  335. sock_kfree_s(sk, req, reqlen);
  336. __sock_put(sk);
  337. iocb->ki_complete(iocb, err, err);
  338. }
  339. static int aead_recvmsg_async(struct socket *sock, struct msghdr *msg,
  340. int flags)
  341. {
  342. struct sock *sk = sock->sk;
  343. struct alg_sock *ask = alg_sk(sk);
  344. struct aead_ctx *ctx = ask->private;
  345. struct crypto_aead *tfm = crypto_aead_reqtfm(&ctx->aead_req);
  346. struct aead_async_req *areq;
  347. struct aead_request *req = NULL;
  348. struct aead_sg_list *sgl = &ctx->tsgl;
  349. struct aead_async_rsgl *last_rsgl = NULL, *rsgl;
  350. unsigned int as = crypto_aead_authsize(tfm);
  351. unsigned int i, reqlen = GET_REQ_SIZE(tfm);
  352. int err = -ENOMEM;
  353. unsigned long used;
  354. size_t outlen = 0;
  355. size_t usedpages = 0;
  356. lock_sock(sk);
  357. if (ctx->more) {
  358. err = aead_wait_for_data(sk, flags);
  359. if (err)
  360. goto unlock;
  361. }
  362. if (!aead_sufficient_data(ctx))
  363. goto unlock;
  364. used = ctx->used;
  365. if (ctx->enc)
  366. outlen = used + as;
  367. else
  368. outlen = used - as;
  369. req = sock_kmalloc(sk, reqlen, GFP_KERNEL);
  370. if (unlikely(!req))
  371. goto unlock;
  372. areq = GET_ASYM_REQ(req, tfm);
  373. memset(&areq->first_rsgl, '\0', sizeof(areq->first_rsgl));
  374. INIT_LIST_HEAD(&areq->list);
  375. areq->iocb = msg->msg_iocb;
  376. areq->sk = sk;
  377. memcpy(areq->iv, ctx->iv, crypto_aead_ivsize(tfm));
  378. aead_request_set_tfm(req, tfm);
  379. aead_request_set_ad(req, ctx->aead_assoclen);
  380. aead_request_set_callback(req, CRYPTO_TFM_REQ_MAY_BACKLOG,
  381. aead_async_cb, req);
  382. used -= ctx->aead_assoclen;
  383. /* take over all tx sgls from ctx */
  384. areq->tsgl = sock_kmalloc(sk,
  385. sizeof(*areq->tsgl) * max_t(u32, sgl->cur, 1),
  386. GFP_KERNEL);
  387. if (unlikely(!areq->tsgl))
  388. goto free;
  389. sg_init_table(areq->tsgl, max_t(u32, sgl->cur, 1));
  390. for (i = 0; i < sgl->cur; i++)
  391. sg_set_page(&areq->tsgl[i], sg_page(&sgl->sg[i]),
  392. sgl->sg[i].length, sgl->sg[i].offset);
  393. areq->tsgls = sgl->cur;
  394. /* create rx sgls */
  395. while (outlen > usedpages && iov_iter_count(&msg->msg_iter)) {
  396. size_t seglen = min_t(size_t, iov_iter_count(&msg->msg_iter),
  397. (outlen - usedpages));
  398. if (list_empty(&areq->list)) {
  399. rsgl = &areq->first_rsgl;
  400. } else {
  401. rsgl = sock_kmalloc(sk, sizeof(*rsgl), GFP_KERNEL);
  402. if (unlikely(!rsgl)) {
  403. err = -ENOMEM;
  404. goto free;
  405. }
  406. }
  407. rsgl->sgl.npages = 0;
  408. list_add_tail(&rsgl->list, &areq->list);
  409. /* make one iovec available as scatterlist */
  410. err = af_alg_make_sg(&rsgl->sgl, &msg->msg_iter, seglen);
  411. if (err < 0)
  412. goto free;
  413. usedpages += err;
  414. /* chain the new scatterlist with previous one */
  415. if (last_rsgl)
  416. af_alg_link_sg(&last_rsgl->sgl, &rsgl->sgl);
  417. last_rsgl = rsgl;
  418. iov_iter_advance(&msg->msg_iter, err);
  419. }
  420. /* ensure output buffer is sufficiently large */
  421. if (usedpages < outlen) {
  422. err = -EINVAL;
  423. goto unlock;
  424. }
  425. aead_request_set_crypt(req, areq->tsgl, areq->first_rsgl.sgl.sg, used,
  426. areq->iv);
  427. err = ctx->enc ? crypto_aead_encrypt(req) : crypto_aead_decrypt(req);
  428. if (err) {
  429. if (err == -EINPROGRESS) {
  430. sock_hold(sk);
  431. err = -EIOCBQUEUED;
  432. aead_reset_ctx(ctx);
  433. goto unlock;
  434. } else if (err == -EBADMSG) {
  435. aead_put_sgl(sk);
  436. }
  437. goto free;
  438. }
  439. aead_put_sgl(sk);
  440. free:
  441. list_for_each_entry(rsgl, &areq->list, list) {
  442. af_alg_free_sg(&rsgl->sgl);
  443. if (rsgl != &areq->first_rsgl)
  444. sock_kfree_s(sk, rsgl, sizeof(*rsgl));
  445. }
  446. if (areq->tsgl)
  447. sock_kfree_s(sk, areq->tsgl, sizeof(*areq->tsgl) * areq->tsgls);
  448. if (req)
  449. sock_kfree_s(sk, req, reqlen);
  450. unlock:
  451. aead_wmem_wakeup(sk);
  452. release_sock(sk);
  453. return err ? err : outlen;
  454. }
  455. static int aead_recvmsg_sync(struct socket *sock, struct msghdr *msg, int flags)
  456. {
  457. struct sock *sk = sock->sk;
  458. struct alg_sock *ask = alg_sk(sk);
  459. struct aead_ctx *ctx = ask->private;
  460. unsigned as = crypto_aead_authsize(crypto_aead_reqtfm(&ctx->aead_req));
  461. struct aead_sg_list *sgl = &ctx->tsgl;
  462. struct aead_async_rsgl *last_rsgl = NULL;
  463. struct aead_async_rsgl *rsgl, *tmp;
  464. int err = -EINVAL;
  465. unsigned long used = 0;
  466. size_t outlen = 0;
  467. size_t usedpages = 0;
  468. lock_sock(sk);
  469. /*
  470. * Please see documentation of aead_request_set_crypt for the
  471. * description of the AEAD memory structure expected from the caller.
  472. */
  473. if (ctx->more) {
  474. err = aead_wait_for_data(sk, flags);
  475. if (err)
  476. goto unlock;
  477. }
  478. /* data length provided by caller via sendmsg/sendpage */
  479. used = ctx->used;
  480. /*
  481. * Make sure sufficient data is present -- note, the same check is
  482. * is also present in sendmsg/sendpage. The checks in sendpage/sendmsg
  483. * shall provide an information to the data sender that something is
  484. * wrong, but they are irrelevant to maintain the kernel integrity.
  485. * We need this check here too in case user space decides to not honor
  486. * the error message in sendmsg/sendpage and still call recvmsg. This
  487. * check here protects the kernel integrity.
  488. */
  489. if (!aead_sufficient_data(ctx))
  490. goto unlock;
  491. /*
  492. * Calculate the minimum output buffer size holding the result of the
  493. * cipher operation. When encrypting data, the receiving buffer is
  494. * larger by the tag length compared to the input buffer as the
  495. * encryption operation generates the tag. For decryption, the input
  496. * buffer provides the tag which is consumed resulting in only the
  497. * plaintext without a buffer for the tag returned to the caller.
  498. */
  499. if (ctx->enc)
  500. outlen = used + as;
  501. else
  502. outlen = used - as;
  503. /*
  504. * The cipher operation input data is reduced by the associated data
  505. * length as this data is processed separately later on.
  506. */
  507. used -= ctx->aead_assoclen;
  508. /* convert iovecs of output buffers into scatterlists */
  509. while (outlen > usedpages && iov_iter_count(&msg->msg_iter)) {
  510. size_t seglen = min_t(size_t, iov_iter_count(&msg->msg_iter),
  511. (outlen - usedpages));
  512. if (list_empty(&ctx->list)) {
  513. rsgl = &ctx->first_rsgl;
  514. } else {
  515. rsgl = sock_kmalloc(sk, sizeof(*rsgl), GFP_KERNEL);
  516. if (unlikely(!rsgl)) {
  517. err = -ENOMEM;
  518. goto unlock;
  519. }
  520. }
  521. rsgl->sgl.npages = 0;
  522. list_add_tail(&rsgl->list, &ctx->list);
  523. /* make one iovec available as scatterlist */
  524. err = af_alg_make_sg(&rsgl->sgl, &msg->msg_iter, seglen);
  525. if (err < 0)
  526. goto unlock;
  527. usedpages += err;
  528. /* chain the new scatterlist with previous one */
  529. if (last_rsgl)
  530. af_alg_link_sg(&last_rsgl->sgl, &rsgl->sgl);
  531. last_rsgl = rsgl;
  532. iov_iter_advance(&msg->msg_iter, err);
  533. }
  534. /* ensure output buffer is sufficiently large */
  535. if (usedpages < outlen) {
  536. err = -EINVAL;
  537. goto unlock;
  538. }
  539. sg_mark_end(sgl->sg + sgl->cur - 1);
  540. aead_request_set_crypt(&ctx->aead_req, sgl->sg, ctx->first_rsgl.sgl.sg,
  541. used, ctx->iv);
  542. aead_request_set_ad(&ctx->aead_req, ctx->aead_assoclen);
  543. err = af_alg_wait_for_completion(ctx->enc ?
  544. crypto_aead_encrypt(&ctx->aead_req) :
  545. crypto_aead_decrypt(&ctx->aead_req),
  546. &ctx->completion);
  547. if (err) {
  548. /* EBADMSG implies a valid cipher operation took place */
  549. if (err == -EBADMSG)
  550. aead_put_sgl(sk);
  551. goto unlock;
  552. }
  553. aead_put_sgl(sk);
  554. err = 0;
  555. unlock:
  556. list_for_each_entry_safe(rsgl, tmp, &ctx->list, list) {
  557. af_alg_free_sg(&rsgl->sgl);
  558. list_del(&rsgl->list);
  559. if (rsgl != &ctx->first_rsgl)
  560. sock_kfree_s(sk, rsgl, sizeof(*rsgl));
  561. }
  562. INIT_LIST_HEAD(&ctx->list);
  563. aead_wmem_wakeup(sk);
  564. release_sock(sk);
  565. return err ? err : outlen;
  566. }
  567. static int aead_recvmsg(struct socket *sock, struct msghdr *msg, size_t ignored,
  568. int flags)
  569. {
  570. return (msg->msg_iocb && !is_sync_kiocb(msg->msg_iocb)) ?
  571. aead_recvmsg_async(sock, msg, flags) :
  572. aead_recvmsg_sync(sock, msg, flags);
  573. }
  574. static unsigned int aead_poll(struct file *file, struct socket *sock,
  575. poll_table *wait)
  576. {
  577. struct sock *sk = sock->sk;
  578. struct alg_sock *ask = alg_sk(sk);
  579. struct aead_ctx *ctx = ask->private;
  580. unsigned int mask;
  581. sock_poll_wait(file, sk_sleep(sk), wait);
  582. mask = 0;
  583. if (!ctx->more)
  584. mask |= POLLIN | POLLRDNORM;
  585. if (aead_writable(sk))
  586. mask |= POLLOUT | POLLWRNORM | POLLWRBAND;
  587. return mask;
  588. }
  589. static struct proto_ops algif_aead_ops = {
  590. .family = PF_ALG,
  591. .connect = sock_no_connect,
  592. .socketpair = sock_no_socketpair,
  593. .getname = sock_no_getname,
  594. .ioctl = sock_no_ioctl,
  595. .listen = sock_no_listen,
  596. .shutdown = sock_no_shutdown,
  597. .getsockopt = sock_no_getsockopt,
  598. .mmap = sock_no_mmap,
  599. .bind = sock_no_bind,
  600. .accept = sock_no_accept,
  601. .setsockopt = sock_no_setsockopt,
  602. .release = af_alg_release,
  603. .sendmsg = aead_sendmsg,
  604. .sendpage = aead_sendpage,
  605. .recvmsg = aead_recvmsg,
  606. .poll = aead_poll,
  607. };
  608. static int aead_check_key(struct socket *sock)
  609. {
  610. int err = 0;
  611. struct sock *psk;
  612. struct alg_sock *pask;
  613. struct aead_tfm *tfm;
  614. struct sock *sk = sock->sk;
  615. struct alg_sock *ask = alg_sk(sk);
  616. lock_sock(sk);
  617. if (ask->refcnt)
  618. goto unlock_child;
  619. psk = ask->parent;
  620. pask = alg_sk(ask->parent);
  621. tfm = pask->private;
  622. err = -ENOKEY;
  623. lock_sock_nested(psk, SINGLE_DEPTH_NESTING);
  624. if (!tfm->has_key)
  625. goto unlock;
  626. if (!pask->refcnt++)
  627. sock_hold(psk);
  628. ask->refcnt = 1;
  629. sock_put(psk);
  630. err = 0;
  631. unlock:
  632. release_sock(psk);
  633. unlock_child:
  634. release_sock(sk);
  635. return err;
  636. }
  637. static int aead_sendmsg_nokey(struct socket *sock, struct msghdr *msg,
  638. size_t size)
  639. {
  640. int err;
  641. err = aead_check_key(sock);
  642. if (err)
  643. return err;
  644. return aead_sendmsg(sock, msg, size);
  645. }
  646. static ssize_t aead_sendpage_nokey(struct socket *sock, struct page *page,
  647. int offset, size_t size, int flags)
  648. {
  649. int err;
  650. err = aead_check_key(sock);
  651. if (err)
  652. return err;
  653. return aead_sendpage(sock, page, offset, size, flags);
  654. }
  655. static int aead_recvmsg_nokey(struct socket *sock, struct msghdr *msg,
  656. size_t ignored, int flags)
  657. {
  658. int err;
  659. err = aead_check_key(sock);
  660. if (err)
  661. return err;
  662. return aead_recvmsg(sock, msg, ignored, flags);
  663. }
  664. static struct proto_ops algif_aead_ops_nokey = {
  665. .family = PF_ALG,
  666. .connect = sock_no_connect,
  667. .socketpair = sock_no_socketpair,
  668. .getname = sock_no_getname,
  669. .ioctl = sock_no_ioctl,
  670. .listen = sock_no_listen,
  671. .shutdown = sock_no_shutdown,
  672. .getsockopt = sock_no_getsockopt,
  673. .mmap = sock_no_mmap,
  674. .bind = sock_no_bind,
  675. .accept = sock_no_accept,
  676. .setsockopt = sock_no_setsockopt,
  677. .release = af_alg_release,
  678. .sendmsg = aead_sendmsg_nokey,
  679. .sendpage = aead_sendpage_nokey,
  680. .recvmsg = aead_recvmsg_nokey,
  681. .poll = aead_poll,
  682. };
  683. static void *aead_bind(const char *name, u32 type, u32 mask)
  684. {
  685. struct aead_tfm *tfm;
  686. struct crypto_aead *aead;
  687. tfm = kzalloc(sizeof(*tfm), GFP_KERNEL);
  688. if (!tfm)
  689. return ERR_PTR(-ENOMEM);
  690. aead = crypto_alloc_aead(name, type, mask);
  691. if (IS_ERR(aead)) {
  692. kfree(tfm);
  693. return ERR_CAST(aead);
  694. }
  695. tfm->aead = aead;
  696. return tfm;
  697. }
  698. static void aead_release(void *private)
  699. {
  700. struct aead_tfm *tfm = private;
  701. crypto_free_aead(tfm->aead);
  702. kfree(tfm);
  703. }
  704. static int aead_setauthsize(void *private, unsigned int authsize)
  705. {
  706. struct aead_tfm *tfm = private;
  707. return crypto_aead_setauthsize(tfm->aead, authsize);
  708. }
  709. static int aead_setkey(void *private, const u8 *key, unsigned int keylen)
  710. {
  711. struct aead_tfm *tfm = private;
  712. int err;
  713. err = crypto_aead_setkey(tfm->aead, key, keylen);
  714. tfm->has_key = !err;
  715. return err;
  716. }
  717. static void aead_sock_destruct(struct sock *sk)
  718. {
  719. struct alg_sock *ask = alg_sk(sk);
  720. struct aead_ctx *ctx = ask->private;
  721. unsigned int ivlen = crypto_aead_ivsize(
  722. crypto_aead_reqtfm(&ctx->aead_req));
  723. WARN_ON(refcount_read(&sk->sk_refcnt) != 0);
  724. aead_put_sgl(sk);
  725. sock_kzfree_s(sk, ctx->iv, ivlen);
  726. sock_kfree_s(sk, ctx, ctx->len);
  727. af_alg_release_parent(sk);
  728. }
  729. static int aead_accept_parent_nokey(void *private, struct sock *sk)
  730. {
  731. struct aead_ctx *ctx;
  732. struct alg_sock *ask = alg_sk(sk);
  733. struct aead_tfm *tfm = private;
  734. struct crypto_aead *aead = tfm->aead;
  735. unsigned int len = sizeof(*ctx) + crypto_aead_reqsize(aead);
  736. unsigned int ivlen = crypto_aead_ivsize(aead);
  737. ctx = sock_kmalloc(sk, len, GFP_KERNEL);
  738. if (!ctx)
  739. return -ENOMEM;
  740. memset(ctx, 0, len);
  741. ctx->iv = sock_kmalloc(sk, ivlen, GFP_KERNEL);
  742. if (!ctx->iv) {
  743. sock_kfree_s(sk, ctx, len);
  744. return -ENOMEM;
  745. }
  746. memset(ctx->iv, 0, ivlen);
  747. ctx->len = len;
  748. ctx->used = 0;
  749. ctx->more = 0;
  750. ctx->merge = 0;
  751. ctx->enc = 0;
  752. ctx->tsgl.cur = 0;
  753. ctx->aead_assoclen = 0;
  754. af_alg_init_completion(&ctx->completion);
  755. sg_init_table(ctx->tsgl.sg, ALG_MAX_PAGES);
  756. INIT_LIST_HEAD(&ctx->list);
  757. ask->private = ctx;
  758. aead_request_set_tfm(&ctx->aead_req, aead);
  759. aead_request_set_callback(&ctx->aead_req, CRYPTO_TFM_REQ_MAY_BACKLOG,
  760. af_alg_complete, &ctx->completion);
  761. sk->sk_destruct = aead_sock_destruct;
  762. return 0;
  763. }
  764. static int aead_accept_parent(void *private, struct sock *sk)
  765. {
  766. struct aead_tfm *tfm = private;
  767. if (!tfm->has_key)
  768. return -ENOKEY;
  769. return aead_accept_parent_nokey(private, sk);
  770. }
  771. static const struct af_alg_type algif_type_aead = {
  772. .bind = aead_bind,
  773. .release = aead_release,
  774. .setkey = aead_setkey,
  775. .setauthsize = aead_setauthsize,
  776. .accept = aead_accept_parent,
  777. .accept_nokey = aead_accept_parent_nokey,
  778. .ops = &algif_aead_ops,
  779. .ops_nokey = &algif_aead_ops_nokey,
  780. .name = "aead",
  781. .owner = THIS_MODULE
  782. };
  783. static int __init algif_aead_init(void)
  784. {
  785. return af_alg_register_type(&algif_type_aead);
  786. }
  787. static void __exit algif_aead_exit(void)
  788. {
  789. int err = af_alg_unregister_type(&algif_type_aead);
  790. BUG_ON(err);
  791. }
  792. module_init(algif_aead_init);
  793. module_exit(algif_aead_exit);
  794. MODULE_LICENSE("GPL");
  795. MODULE_AUTHOR("Stephan Mueller <smueller@chronox.de>");
  796. MODULE_DESCRIPTION("AEAD kernel crypto API user space interface");