1// SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0-only)
2/* Copyright(c) 2014 - 2020 Intel Corporation */
3#include <linux/module.h>
4#include <linux/slab.h>
5#include <linux/crypto.h>
6#include <crypto/internal/aead.h>
7#include <crypto/internal/cipher.h>
8#include <crypto/internal/skcipher.h>
9#include <crypto/aes.h>
10#include <crypto/sha1.h>
11#include <crypto/sha2.h>
12#include <crypto/hash.h>
13#include <crypto/hmac.h>
14#include <crypto/algapi.h>
15#include <crypto/authenc.h>
16#include <crypto/scatterwalk.h>
17#include <crypto/xts.h>
18#include <linux/dma-mapping.h>
19#include "adf_accel_devices.h"
20#include "qat_algs_send.h"
21#include "adf_common_drv.h"
22#include "qat_crypto.h"
23#include "icp_qat_hw.h"
24#include "icp_qat_fw.h"
25#include "icp_qat_fw_la.h"
26#include "qat_bl.h"
27
28#define QAT_AES_HW_CONFIG_ENC(alg, mode) \
29	ICP_QAT_HW_CIPHER_CONFIG_BUILD(mode, alg, \
30				       ICP_QAT_HW_CIPHER_NO_CONVERT, \
31				       ICP_QAT_HW_CIPHER_ENCRYPT)
32
33#define QAT_AES_HW_CONFIG_DEC(alg, mode) \
34	ICP_QAT_HW_CIPHER_CONFIG_BUILD(mode, alg, \
35				       ICP_QAT_HW_CIPHER_KEY_CONVERT, \
36				       ICP_QAT_HW_CIPHER_DECRYPT)
37
38#define QAT_AES_HW_CONFIG_DEC_NO_CONV(alg, mode) \
39	ICP_QAT_HW_CIPHER_CONFIG_BUILD(mode, alg, \
40				       ICP_QAT_HW_CIPHER_NO_CONVERT, \
41				       ICP_QAT_HW_CIPHER_DECRYPT)
42
43#define HW_CAP_AES_V2(accel_dev) \
44	(GET_HW_DATA(accel_dev)->accel_capabilities_mask & \
45	 ICP_ACCEL_CAPABILITIES_AES_V2)
46
47static DEFINE_MUTEX(algs_lock);
48static unsigned int active_devs;
49
50/* Common content descriptor */
51struct qat_alg_cd {
52	union {
53		struct qat_enc { /* Encrypt content desc */
54			struct icp_qat_hw_cipher_algo_blk cipher;
55			struct icp_qat_hw_auth_algo_blk hash;
56		} qat_enc_cd;
57		struct qat_dec { /* Decrypt content desc */
58			struct icp_qat_hw_auth_algo_blk hash;
59			struct icp_qat_hw_cipher_algo_blk cipher;
60		} qat_dec_cd;
61	};
62} __aligned(64);
63
64struct qat_alg_aead_ctx {
65	struct qat_alg_cd *enc_cd;
66	struct qat_alg_cd *dec_cd;
67	dma_addr_t enc_cd_paddr;
68	dma_addr_t dec_cd_paddr;
69	struct icp_qat_fw_la_bulk_req enc_fw_req;
70	struct icp_qat_fw_la_bulk_req dec_fw_req;
71	struct crypto_shash *hash_tfm;
72	enum icp_qat_hw_auth_algo qat_hash_alg;
73	struct qat_crypto_instance *inst;
74	union {
75		struct sha1_state sha1;
76		struct sha256_state sha256;
77		struct sha512_state sha512;
78	};
79	char ipad[SHA512_BLOCK_SIZE]; /* sufficient for SHA-1/SHA-256 as well */
80	char opad[SHA512_BLOCK_SIZE];
81};
82
83struct qat_alg_skcipher_ctx {
84	struct icp_qat_hw_cipher_algo_blk *enc_cd;
85	struct icp_qat_hw_cipher_algo_blk *dec_cd;
86	dma_addr_t enc_cd_paddr;
87	dma_addr_t dec_cd_paddr;
88	struct icp_qat_fw_la_bulk_req enc_fw_req;
89	struct icp_qat_fw_la_bulk_req dec_fw_req;
90	struct qat_crypto_instance *inst;
91	struct crypto_skcipher *ftfm;
92	struct crypto_cipher *tweak;
93	bool fallback;
94	int mode;
95};
96
97static int qat_get_inter_state_size(enum icp_qat_hw_auth_algo qat_hash_alg)
98{
99	switch (qat_hash_alg) {
100	case ICP_QAT_HW_AUTH_ALGO_SHA1:
101		return ICP_QAT_HW_SHA1_STATE1_SZ;
102	case ICP_QAT_HW_AUTH_ALGO_SHA256:
103		return ICP_QAT_HW_SHA256_STATE1_SZ;
104	case ICP_QAT_HW_AUTH_ALGO_SHA512:
105		return ICP_QAT_HW_SHA512_STATE1_SZ;
106	default:
107		return -EFAULT;
108	}
109}
110
111static int qat_alg_do_precomputes(struct icp_qat_hw_auth_algo_blk *hash,
112				  struct qat_alg_aead_ctx *ctx,
113				  const u8 *auth_key,
114				  unsigned int auth_keylen)
115{
116	SHASH_DESC_ON_STACK(shash, ctx->hash_tfm);
117	int block_size = crypto_shash_blocksize(ctx->hash_tfm);
118	int digest_size = crypto_shash_digestsize(ctx->hash_tfm);
119	__be32 *hash_state_out;
120	__be64 *hash512_state_out;
121	int i, offset;
122
123	memset(ctx->ipad, 0, block_size);
124	memset(ctx->opad, 0, block_size);
125	shash->tfm = ctx->hash_tfm;
126
127	if (auth_keylen > block_size) {
128		int ret = crypto_shash_digest(shash, auth_key,
129					      auth_keylen, ctx->ipad);
130		if (ret)
131			return ret;
132
133		memcpy(ctx->opad, ctx->ipad, digest_size);
134	} else {
135		memcpy(ctx->ipad, auth_key, auth_keylen);
136		memcpy(ctx->opad, auth_key, auth_keylen);
137	}
138
139	for (i = 0; i < block_size; i++) {
140		char *ipad_ptr = ctx->ipad + i;
141		char *opad_ptr = ctx->opad + i;
142		*ipad_ptr ^= HMAC_IPAD_VALUE;
143		*opad_ptr ^= HMAC_OPAD_VALUE;
144	}
145
146	if (crypto_shash_init(shash))
147		return -EFAULT;
148
149	if (crypto_shash_update(shash, ctx->ipad, block_size))
150		return -EFAULT;
151
152	hash_state_out = (__be32 *)hash->sha.state1;
153	hash512_state_out = (__be64 *)hash_state_out;
154
155	switch (ctx->qat_hash_alg) {
156	case ICP_QAT_HW_AUTH_ALGO_SHA1:
157		if (crypto_shash_export(shash, &ctx->sha1))
158			return -EFAULT;
159		for (i = 0; i < digest_size >> 2; i++, hash_state_out++)
160			*hash_state_out = cpu_to_be32(ctx->sha1.state[i]);
161		break;
162	case ICP_QAT_HW_AUTH_ALGO_SHA256:
163		if (crypto_shash_export(shash, &ctx->sha256))
164			return -EFAULT;
165		for (i = 0; i < digest_size >> 2; i++, hash_state_out++)
166			*hash_state_out = cpu_to_be32(ctx->sha256.state[i]);
167		break;
168	case ICP_QAT_HW_AUTH_ALGO_SHA512:
169		if (crypto_shash_export(shash, &ctx->sha512))
170			return -EFAULT;
171		for (i = 0; i < digest_size >> 3; i++, hash512_state_out++)
172			*hash512_state_out = cpu_to_be64(ctx->sha512.state[i]);
173		break;
174	default:
175		return -EFAULT;
176	}
177
178	if (crypto_shash_init(shash))
179		return -EFAULT;
180
181	if (crypto_shash_update(shash, ctx->opad, block_size))
182		return -EFAULT;
183
184	offset = round_up(qat_get_inter_state_size(ctx->qat_hash_alg), 8);
185	if (offset < 0)
186		return -EFAULT;
187
188	hash_state_out = (__be32 *)(hash->sha.state1 + offset);
189	hash512_state_out = (__be64 *)hash_state_out;
190
191	switch (ctx->qat_hash_alg) {
192	case ICP_QAT_HW_AUTH_ALGO_SHA1:
193		if (crypto_shash_export(shash, &ctx->sha1))
194			return -EFAULT;
195		for (i = 0; i < digest_size >> 2; i++, hash_state_out++)
196			*hash_state_out = cpu_to_be32(ctx->sha1.state[i]);
197		break;
198	case ICP_QAT_HW_AUTH_ALGO_SHA256:
199		if (crypto_shash_export(shash, &ctx->sha256))
200			return -EFAULT;
201		for (i = 0; i < digest_size >> 2; i++, hash_state_out++)
202			*hash_state_out = cpu_to_be32(ctx->sha256.state[i]);
203		break;
204	case ICP_QAT_HW_AUTH_ALGO_SHA512:
205		if (crypto_shash_export(shash, &ctx->sha512))
206			return -EFAULT;
207		for (i = 0; i < digest_size >> 3; i++, hash512_state_out++)
208			*hash512_state_out = cpu_to_be64(ctx->sha512.state[i]);
209		break;
210	default:
211		return -EFAULT;
212	}
213	memzero_explicit(ctx->ipad, block_size);
214	memzero_explicit(ctx->opad, block_size);
215	return 0;
216}
217
218static void qat_alg_init_common_hdr(struct icp_qat_fw_comn_req_hdr *header)
219{
220	header->hdr_flags =
221		ICP_QAT_FW_COMN_HDR_FLAGS_BUILD(ICP_QAT_FW_COMN_REQ_FLAG_SET);
222	header->service_type = ICP_QAT_FW_COMN_REQ_CPM_FW_LA;
223	header->comn_req_flags =
224		ICP_QAT_FW_COMN_FLAGS_BUILD(QAT_COMN_CD_FLD_TYPE_64BIT_ADR,
225					    QAT_COMN_PTR_TYPE_SGL);
226	ICP_QAT_FW_LA_PARTIAL_SET(header->serv_specif_flags,
227				  ICP_QAT_FW_LA_PARTIAL_NONE);
228	ICP_QAT_FW_LA_CIPH_IV_FLD_FLAG_SET(header->serv_specif_flags,
229					   ICP_QAT_FW_CIPH_IV_16BYTE_DATA);
230	ICP_QAT_FW_LA_PROTO_SET(header->serv_specif_flags,
231				ICP_QAT_FW_LA_NO_PROTO);
232	ICP_QAT_FW_LA_UPDATE_STATE_SET(header->serv_specif_flags,
233				       ICP_QAT_FW_LA_NO_UPDATE_STATE);
234}
235
236static int qat_alg_aead_init_enc_session(struct crypto_aead *aead_tfm,
237					 int alg,
238					 struct crypto_authenc_keys *keys,
239					 int mode)
240{
241	struct qat_alg_aead_ctx *ctx = crypto_aead_ctx(aead_tfm);
242	unsigned int digestsize = crypto_aead_authsize(aead_tfm);
243	struct qat_enc *enc_ctx = &ctx->enc_cd->qat_enc_cd;
244	struct icp_qat_hw_cipher_algo_blk *cipher = &enc_ctx->cipher;
245	struct icp_qat_hw_auth_algo_blk *hash =
246		(struct icp_qat_hw_auth_algo_blk *)((char *)enc_ctx +
247		sizeof(struct icp_qat_hw_auth_setup) + keys->enckeylen);
248	struct icp_qat_fw_la_bulk_req *req_tmpl = &ctx->enc_fw_req;
249	struct icp_qat_fw_comn_req_hdr_cd_pars *cd_pars = &req_tmpl->cd_pars;
250	struct icp_qat_fw_comn_req_hdr *header = &req_tmpl->comn_hdr;
251	void *ptr = &req_tmpl->cd_ctrl;
252	struct icp_qat_fw_cipher_cd_ctrl_hdr *cipher_cd_ctrl = ptr;
253	struct icp_qat_fw_auth_cd_ctrl_hdr *hash_cd_ctrl = ptr;
254
255	/* CD setup */
256	cipher->aes.cipher_config.val = QAT_AES_HW_CONFIG_ENC(alg, mode);
257	memcpy(cipher->aes.key, keys->enckey, keys->enckeylen);
258	hash->sha.inner_setup.auth_config.config =
259		ICP_QAT_HW_AUTH_CONFIG_BUILD(ICP_QAT_HW_AUTH_MODE1,
260					     ctx->qat_hash_alg, digestsize);
261	hash->sha.inner_setup.auth_counter.counter =
262		cpu_to_be32(crypto_shash_blocksize(ctx->hash_tfm));
263
264	if (qat_alg_do_precomputes(hash, ctx, keys->authkey, keys->authkeylen))
265		return -EFAULT;
266
267	/* Request setup */
268	qat_alg_init_common_hdr(header);
269	header->service_cmd_id = ICP_QAT_FW_LA_CMD_CIPHER_HASH;
270	ICP_QAT_FW_LA_DIGEST_IN_BUFFER_SET(header->serv_specif_flags,
271					   ICP_QAT_FW_LA_DIGEST_IN_BUFFER);
272	ICP_QAT_FW_LA_RET_AUTH_SET(header->serv_specif_flags,
273				   ICP_QAT_FW_LA_RET_AUTH_RES);
274	ICP_QAT_FW_LA_CMP_AUTH_SET(header->serv_specif_flags,
275				   ICP_QAT_FW_LA_NO_CMP_AUTH_RES);
276	cd_pars->u.s.content_desc_addr = ctx->enc_cd_paddr;
277	cd_pars->u.s.content_desc_params_sz = sizeof(struct qat_alg_cd) >> 3;
278
279	/* Cipher CD config setup */
280	cipher_cd_ctrl->cipher_key_sz = keys->enckeylen >> 3;
281	cipher_cd_ctrl->cipher_state_sz = AES_BLOCK_SIZE >> 3;
282	cipher_cd_ctrl->cipher_cfg_offset = 0;
283	ICP_QAT_FW_COMN_CURR_ID_SET(cipher_cd_ctrl, ICP_QAT_FW_SLICE_CIPHER);
284	ICP_QAT_FW_COMN_NEXT_ID_SET(cipher_cd_ctrl, ICP_QAT_FW_SLICE_AUTH);
285	/* Auth CD config setup */
286	hash_cd_ctrl->hash_cfg_offset = ((char *)hash - (char *)cipher) >> 3;
287	hash_cd_ctrl->hash_flags = ICP_QAT_FW_AUTH_HDR_FLAG_NO_NESTED;
288	hash_cd_ctrl->inner_res_sz = digestsize;
289	hash_cd_ctrl->final_sz = digestsize;
290
291	switch (ctx->qat_hash_alg) {
292	case ICP_QAT_HW_AUTH_ALGO_SHA1:
293		hash_cd_ctrl->inner_state1_sz =
294			round_up(ICP_QAT_HW_SHA1_STATE1_SZ, 8);
295		hash_cd_ctrl->inner_state2_sz =
296			round_up(ICP_QAT_HW_SHA1_STATE2_SZ, 8);
297		break;
298	case ICP_QAT_HW_AUTH_ALGO_SHA256:
299		hash_cd_ctrl->inner_state1_sz = ICP_QAT_HW_SHA256_STATE1_SZ;
300		hash_cd_ctrl->inner_state2_sz = ICP_QAT_HW_SHA256_STATE2_SZ;
301		break;
302	case ICP_QAT_HW_AUTH_ALGO_SHA512:
303		hash_cd_ctrl->inner_state1_sz = ICP_QAT_HW_SHA512_STATE1_SZ;
304		hash_cd_ctrl->inner_state2_sz = ICP_QAT_HW_SHA512_STATE2_SZ;
305		break;
306	default:
307		break;
308	}
309	hash_cd_ctrl->inner_state2_offset = hash_cd_ctrl->hash_cfg_offset +
310			((sizeof(struct icp_qat_hw_auth_setup) +
311			 round_up(hash_cd_ctrl->inner_state1_sz, 8)) >> 3);
312	ICP_QAT_FW_COMN_CURR_ID_SET(hash_cd_ctrl, ICP_QAT_FW_SLICE_AUTH);
313	ICP_QAT_FW_COMN_NEXT_ID_SET(hash_cd_ctrl, ICP_QAT_FW_SLICE_DRAM_WR);
314	return 0;
315}
316
317static int qat_alg_aead_init_dec_session(struct crypto_aead *aead_tfm,
318					 int alg,
319					 struct crypto_authenc_keys *keys,
320					 int mode)
321{
322	struct qat_alg_aead_ctx *ctx = crypto_aead_ctx(aead_tfm);
323	unsigned int digestsize = crypto_aead_authsize(aead_tfm);
324	struct qat_dec *dec_ctx = &ctx->dec_cd->qat_dec_cd;
325	struct icp_qat_hw_auth_algo_blk *hash = &dec_ctx->hash;
326	struct icp_qat_hw_cipher_algo_blk *cipher =
327		(struct icp_qat_hw_cipher_algo_blk *)((char *)dec_ctx +
328		sizeof(struct icp_qat_hw_auth_setup) +
329		roundup(crypto_shash_digestsize(ctx->hash_tfm), 8) * 2);
330	struct icp_qat_fw_la_bulk_req *req_tmpl = &ctx->dec_fw_req;
331	struct icp_qat_fw_comn_req_hdr_cd_pars *cd_pars = &req_tmpl->cd_pars;
332	struct icp_qat_fw_comn_req_hdr *header = &req_tmpl->comn_hdr;
333	void *ptr = &req_tmpl->cd_ctrl;
334	struct icp_qat_fw_cipher_cd_ctrl_hdr *cipher_cd_ctrl = ptr;
335	struct icp_qat_fw_auth_cd_ctrl_hdr *hash_cd_ctrl = ptr;
336	struct icp_qat_fw_la_auth_req_params *auth_param =
337		(struct icp_qat_fw_la_auth_req_params *)
338		((char *)&req_tmpl->serv_specif_rqpars +
339		sizeof(struct icp_qat_fw_la_cipher_req_params));
340
341	/* CD setup */
342	cipher->aes.cipher_config.val = QAT_AES_HW_CONFIG_DEC(alg, mode);
343	memcpy(cipher->aes.key, keys->enckey, keys->enckeylen);
344	hash->sha.inner_setup.auth_config.config =
345		ICP_QAT_HW_AUTH_CONFIG_BUILD(ICP_QAT_HW_AUTH_MODE1,
346					     ctx->qat_hash_alg,
347					     digestsize);
348	hash->sha.inner_setup.auth_counter.counter =
349		cpu_to_be32(crypto_shash_blocksize(ctx->hash_tfm));
350
351	if (qat_alg_do_precomputes(hash, ctx, keys->authkey, keys->authkeylen))
352		return -EFAULT;
353
354	/* Request setup */
355	qat_alg_init_common_hdr(header);
356	header->service_cmd_id = ICP_QAT_FW_LA_CMD_HASH_CIPHER;
357	ICP_QAT_FW_LA_DIGEST_IN_BUFFER_SET(header->serv_specif_flags,
358					   ICP_QAT_FW_LA_DIGEST_IN_BUFFER);
359	ICP_QAT_FW_LA_RET_AUTH_SET(header->serv_specif_flags,
360				   ICP_QAT_FW_LA_NO_RET_AUTH_RES);
361	ICP_QAT_FW_LA_CMP_AUTH_SET(header->serv_specif_flags,
362				   ICP_QAT_FW_LA_CMP_AUTH_RES);
363	cd_pars->u.s.content_desc_addr = ctx->dec_cd_paddr;
364	cd_pars->u.s.content_desc_params_sz = sizeof(struct qat_alg_cd) >> 3;
365
366	/* Cipher CD config setup */
367	cipher_cd_ctrl->cipher_key_sz = keys->enckeylen >> 3;
368	cipher_cd_ctrl->cipher_state_sz = AES_BLOCK_SIZE >> 3;
369	cipher_cd_ctrl->cipher_cfg_offset =
370		(sizeof(struct icp_qat_hw_auth_setup) +
371		 roundup(crypto_shash_digestsize(ctx->hash_tfm), 8) * 2) >> 3;
372	ICP_QAT_FW_COMN_CURR_ID_SET(cipher_cd_ctrl, ICP_QAT_FW_SLICE_CIPHER);
373	ICP_QAT_FW_COMN_NEXT_ID_SET(cipher_cd_ctrl, ICP_QAT_FW_SLICE_DRAM_WR);
374
375	/* Auth CD config setup */
376	hash_cd_ctrl->hash_cfg_offset = 0;
377	hash_cd_ctrl->hash_flags = ICP_QAT_FW_AUTH_HDR_FLAG_NO_NESTED;
378	hash_cd_ctrl->inner_res_sz = digestsize;
379	hash_cd_ctrl->final_sz = digestsize;
380
381	switch (ctx->qat_hash_alg) {
382	case ICP_QAT_HW_AUTH_ALGO_SHA1:
383		hash_cd_ctrl->inner_state1_sz =
384			round_up(ICP_QAT_HW_SHA1_STATE1_SZ, 8);
385		hash_cd_ctrl->inner_state2_sz =
386			round_up(ICP_QAT_HW_SHA1_STATE2_SZ, 8);
387		break;
388	case ICP_QAT_HW_AUTH_ALGO_SHA256:
389		hash_cd_ctrl->inner_state1_sz = ICP_QAT_HW_SHA256_STATE1_SZ;
390		hash_cd_ctrl->inner_state2_sz = ICP_QAT_HW_SHA256_STATE2_SZ;
391		break;
392	case ICP_QAT_HW_AUTH_ALGO_SHA512:
393		hash_cd_ctrl->inner_state1_sz = ICP_QAT_HW_SHA512_STATE1_SZ;
394		hash_cd_ctrl->inner_state2_sz = ICP_QAT_HW_SHA512_STATE2_SZ;
395		break;
396	default:
397		break;
398	}
399
400	hash_cd_ctrl->inner_state2_offset = hash_cd_ctrl->hash_cfg_offset +
401			((sizeof(struct icp_qat_hw_auth_setup) +
402			 round_up(hash_cd_ctrl->inner_state1_sz, 8)) >> 3);
403	auth_param->auth_res_sz = digestsize;
404	ICP_QAT_FW_COMN_CURR_ID_SET(hash_cd_ctrl, ICP_QAT_FW_SLICE_AUTH);
405	ICP_QAT_FW_COMN_NEXT_ID_SET(hash_cd_ctrl, ICP_QAT_FW_SLICE_CIPHER);
406	return 0;
407}
408
409static void qat_alg_skcipher_init_com(struct qat_alg_skcipher_ctx *ctx,
410				      struct icp_qat_fw_la_bulk_req *req,
411				      struct icp_qat_hw_cipher_algo_blk *cd,
412				      const u8 *key, unsigned int keylen)
413{
414	struct icp_qat_fw_comn_req_hdr_cd_pars *cd_pars = &req->cd_pars;
415	struct icp_qat_fw_comn_req_hdr *header = &req->comn_hdr;
416	struct icp_qat_fw_cipher_cd_ctrl_hdr *cd_ctrl = (void *)&req->cd_ctrl;
417	bool aes_v2_capable = HW_CAP_AES_V2(ctx->inst->accel_dev);
418	int mode = ctx->mode;
419
420	qat_alg_init_common_hdr(header);
421	header->service_cmd_id = ICP_QAT_FW_LA_CMD_CIPHER;
422	cd_pars->u.s.content_desc_params_sz =
423				sizeof(struct icp_qat_hw_cipher_algo_blk) >> 3;
424
425	if (aes_v2_capable && mode == ICP_QAT_HW_CIPHER_XTS_MODE) {
426		ICP_QAT_FW_LA_SLICE_TYPE_SET(header->serv_specif_flags,
427					     ICP_QAT_FW_LA_USE_UCS_SLICE_TYPE);
428
429		/* Store both XTS keys in CD, only the first key is sent
430		 * to the HW, the second key is used for tweak calculation
431		 */
432		memcpy(cd->ucs_aes.key, key, keylen);
433		keylen = keylen / 2;
434	} else if (aes_v2_capable && mode == ICP_QAT_HW_CIPHER_CTR_MODE) {
435		ICP_QAT_FW_LA_SLICE_TYPE_SET(header->serv_specif_flags,
436					     ICP_QAT_FW_LA_USE_UCS_SLICE_TYPE);
437		memcpy(cd->ucs_aes.key, key, keylen);
438		keylen = round_up(keylen, 16);
439	} else {
440		memcpy(cd->aes.key, key, keylen);
441	}
442
443	/* Cipher CD config setup */
444	cd_ctrl->cipher_key_sz = keylen >> 3;
445	cd_ctrl->cipher_state_sz = AES_BLOCK_SIZE >> 3;
446	cd_ctrl->cipher_cfg_offset = 0;
447	ICP_QAT_FW_COMN_CURR_ID_SET(cd_ctrl, ICP_QAT_FW_SLICE_CIPHER);
448	ICP_QAT_FW_COMN_NEXT_ID_SET(cd_ctrl, ICP_QAT_FW_SLICE_DRAM_WR);
449}
450
451static void qat_alg_skcipher_init_enc(struct qat_alg_skcipher_ctx *ctx,
452				      int alg, const u8 *key,
453				      unsigned int keylen, int mode)
454{
455	struct icp_qat_hw_cipher_algo_blk *enc_cd = ctx->enc_cd;
456	struct icp_qat_fw_la_bulk_req *req = &ctx->enc_fw_req;
457	struct icp_qat_fw_comn_req_hdr_cd_pars *cd_pars = &req->cd_pars;
458
459	qat_alg_skcipher_init_com(ctx, req, enc_cd, key, keylen);
460	cd_pars->u.s.content_desc_addr = ctx->enc_cd_paddr;
461	enc_cd->aes.cipher_config.val = QAT_AES_HW_CONFIG_ENC(alg, mode);
462}
463
464static void qat_alg_xts_reverse_key(const u8 *key_forward, unsigned int keylen,
465				    u8 *key_reverse)
466{
467	struct crypto_aes_ctx aes_expanded;
468	int nrounds;
469	u8 *key;
470
471	aes_expandkey(&aes_expanded, key_forward, keylen);
472	if (keylen == AES_KEYSIZE_128) {
473		nrounds = 10;
474		key = (u8 *)aes_expanded.key_enc + (AES_BLOCK_SIZE * nrounds);
475		memcpy(key_reverse, key, AES_BLOCK_SIZE);
476	} else {
477		/* AES_KEYSIZE_256 */
478		nrounds = 14;
479		key = (u8 *)aes_expanded.key_enc + (AES_BLOCK_SIZE * nrounds);
480		memcpy(key_reverse, key, AES_BLOCK_SIZE);
481		memcpy(key_reverse + AES_BLOCK_SIZE, key - AES_BLOCK_SIZE,
482		       AES_BLOCK_SIZE);
483	}
484}
485
486static void qat_alg_skcipher_init_dec(struct qat_alg_skcipher_ctx *ctx,
487				      int alg, const u8 *key,
488				      unsigned int keylen, int mode)
489{
490	struct icp_qat_hw_cipher_algo_blk *dec_cd = ctx->dec_cd;
491	struct icp_qat_fw_la_bulk_req *req = &ctx->dec_fw_req;
492	struct icp_qat_fw_comn_req_hdr_cd_pars *cd_pars = &req->cd_pars;
493	bool aes_v2_capable = HW_CAP_AES_V2(ctx->inst->accel_dev);
494
495	qat_alg_skcipher_init_com(ctx, req, dec_cd, key, keylen);
496	cd_pars->u.s.content_desc_addr = ctx->dec_cd_paddr;
497
498	if (aes_v2_capable && mode == ICP_QAT_HW_CIPHER_XTS_MODE) {
499		/* Key reversing not supported, set no convert */
500		dec_cd->aes.cipher_config.val =
501				QAT_AES_HW_CONFIG_DEC_NO_CONV(alg, mode);
502
503		/* In-place key reversal */
504		qat_alg_xts_reverse_key(dec_cd->ucs_aes.key, keylen / 2,
505					dec_cd->ucs_aes.key);
506	} else if (mode != ICP_QAT_HW_CIPHER_CTR_MODE) {
507		dec_cd->aes.cipher_config.val =
508					QAT_AES_HW_CONFIG_DEC(alg, mode);
509	} else {
510		dec_cd->aes.cipher_config.val =
511					QAT_AES_HW_CONFIG_ENC(alg, mode);
512	}
513}
514
515static int qat_alg_validate_key(int key_len, int *alg, int mode)
516{
517	if (mode != ICP_QAT_HW_CIPHER_XTS_MODE) {
518		switch (key_len) {
519		case AES_KEYSIZE_128:
520			*alg = ICP_QAT_HW_CIPHER_ALGO_AES128;
521			break;
522		case AES_KEYSIZE_192:
523			*alg = ICP_QAT_HW_CIPHER_ALGO_AES192;
524			break;
525		case AES_KEYSIZE_256:
526			*alg = ICP_QAT_HW_CIPHER_ALGO_AES256;
527			break;
528		default:
529			return -EINVAL;
530		}
531	} else {
532		switch (key_len) {
533		case AES_KEYSIZE_128 << 1:
534			*alg = ICP_QAT_HW_CIPHER_ALGO_AES128;
535			break;
536		case AES_KEYSIZE_256 << 1:
537			*alg = ICP_QAT_HW_CIPHER_ALGO_AES256;
538			break;
539		default:
540			return -EINVAL;
541		}
542	}
543	return 0;
544}
545
546static int qat_alg_aead_init_sessions(struct crypto_aead *tfm, const u8 *key,
547				      unsigned int keylen,  int mode)
548{
549	struct crypto_authenc_keys keys;
550	int alg;
551
552	if (crypto_authenc_extractkeys(&keys, key, keylen))
553		goto bad_key;
554
555	if (qat_alg_validate_key(keys.enckeylen, &alg, mode))
556		goto bad_key;
557
558	if (qat_alg_aead_init_enc_session(tfm, alg, &keys, mode))
559		goto error;
560
561	if (qat_alg_aead_init_dec_session(tfm, alg, &keys, mode))
562		goto error;
563
564	memzero_explicit(&keys, sizeof(keys));
565	return 0;
566bad_key:
567	memzero_explicit(&keys, sizeof(keys));
568	return -EINVAL;
569error:
570	memzero_explicit(&keys, sizeof(keys));
571	return -EFAULT;
572}
573
574static int qat_alg_skcipher_init_sessions(struct qat_alg_skcipher_ctx *ctx,
575					  const u8 *key,
576					  unsigned int keylen,
577					  int mode)
578{
579	int alg;
580
581	if (qat_alg_validate_key(keylen, &alg, mode))
582		return -EINVAL;
583
584	qat_alg_skcipher_init_enc(ctx, alg, key, keylen, mode);
585	qat_alg_skcipher_init_dec(ctx, alg, key, keylen, mode);
586	return 0;
587}
588
589static int qat_alg_aead_rekey(struct crypto_aead *tfm, const u8 *key,
590			      unsigned int keylen)
591{
592	struct qat_alg_aead_ctx *ctx = crypto_aead_ctx(tfm);
593
594	memset(ctx->enc_cd, 0, sizeof(*ctx->enc_cd));
595	memset(ctx->dec_cd, 0, sizeof(*ctx->dec_cd));
596	memset(&ctx->enc_fw_req, 0, sizeof(ctx->enc_fw_req));
597	memset(&ctx->dec_fw_req, 0, sizeof(ctx->dec_fw_req));
598
599	return qat_alg_aead_init_sessions(tfm, key, keylen,
600					  ICP_QAT_HW_CIPHER_CBC_MODE);
601}
602
603static int qat_alg_aead_newkey(struct crypto_aead *tfm, const u8 *key,
604			       unsigned int keylen)
605{
606	struct qat_alg_aead_ctx *ctx = crypto_aead_ctx(tfm);
607	struct qat_crypto_instance *inst = NULL;
608	int node = numa_node_id();
609	struct device *dev;
610	int ret;
611
612	inst = qat_crypto_get_instance_node(node);
613	if (!inst)
614		return -EINVAL;
615	dev = &GET_DEV(inst->accel_dev);
616	ctx->inst = inst;
617	ctx->enc_cd = dma_alloc_coherent(dev, sizeof(*ctx->enc_cd),
618					 &ctx->enc_cd_paddr,
619					 GFP_ATOMIC);
620	if (!ctx->enc_cd) {
621		ret = -ENOMEM;
622		goto out_free_inst;
623	}
624	ctx->dec_cd = dma_alloc_coherent(dev, sizeof(*ctx->dec_cd),
625					 &ctx->dec_cd_paddr,
626					 GFP_ATOMIC);
627	if (!ctx->dec_cd) {
628		ret = -ENOMEM;
629		goto out_free_enc;
630	}
631
632	ret = qat_alg_aead_init_sessions(tfm, key, keylen,
633					 ICP_QAT_HW_CIPHER_CBC_MODE);
634	if (ret)
635		goto out_free_all;
636
637	return 0;
638
639out_free_all:
640	memset(ctx->dec_cd, 0, sizeof(struct qat_alg_cd));
641	dma_free_coherent(dev, sizeof(struct qat_alg_cd),
642			  ctx->dec_cd, ctx->dec_cd_paddr);
643	ctx->dec_cd = NULL;
644out_free_enc:
645	memset(ctx->enc_cd, 0, sizeof(struct qat_alg_cd));
646	dma_free_coherent(dev, sizeof(struct qat_alg_cd),
647			  ctx->enc_cd, ctx->enc_cd_paddr);
648	ctx->enc_cd = NULL;
649out_free_inst:
650	ctx->inst = NULL;
651	qat_crypto_put_instance(inst);
652	return ret;
653}
654
655static int qat_alg_aead_setkey(struct crypto_aead *tfm, const u8 *key,
656			       unsigned int keylen)
657{
658	struct qat_alg_aead_ctx *ctx = crypto_aead_ctx(tfm);
659
660	if (ctx->enc_cd)
661		return qat_alg_aead_rekey(tfm, key, keylen);
662	else
663		return qat_alg_aead_newkey(tfm, key, keylen);
664}
665
666static void qat_aead_alg_callback(struct icp_qat_fw_la_resp *qat_resp,
667				  struct qat_crypto_request *qat_req)
668{
669	struct qat_alg_aead_ctx *ctx = qat_req->aead_ctx;
670	struct qat_crypto_instance *inst = ctx->inst;
671	struct aead_request *areq = qat_req->aead_req;
672	u8 stat_filed = qat_resp->comn_resp.comn_status;
673	int res = 0, qat_res = ICP_QAT_FW_COMN_RESP_CRYPTO_STAT_GET(stat_filed);
674
675	qat_bl_free_bufl(inst->accel_dev, &qat_req->buf);
676	if (unlikely(qat_res != ICP_QAT_FW_COMN_STATUS_FLAG_OK))
677		res = -EBADMSG;
678	aead_request_complete(areq, res);
679}
680
681static void qat_alg_update_iv_ctr_mode(struct qat_crypto_request *qat_req)
682{
683	struct skcipher_request *sreq = qat_req->skcipher_req;
684	u64 iv_lo_prev;
685	u64 iv_lo;
686	u64 iv_hi;
687
688	memcpy(qat_req->iv, sreq->iv, AES_BLOCK_SIZE);
689
690	iv_lo = be64_to_cpu(qat_req->iv_lo);
691	iv_hi = be64_to_cpu(qat_req->iv_hi);
692
693	iv_lo_prev = iv_lo;
694	iv_lo += DIV_ROUND_UP(sreq->cryptlen, AES_BLOCK_SIZE);
695	if (iv_lo < iv_lo_prev)
696		iv_hi++;
697
698	qat_req->iv_lo = cpu_to_be64(iv_lo);
699	qat_req->iv_hi = cpu_to_be64(iv_hi);
700}
701
702static void qat_alg_update_iv_cbc_mode(struct qat_crypto_request *qat_req)
703{
704	struct skcipher_request *sreq = qat_req->skcipher_req;
705	int offset = sreq->cryptlen - AES_BLOCK_SIZE;
706	struct scatterlist *sgl;
707
708	if (qat_req->encryption)
709		sgl = sreq->dst;
710	else
711		sgl = sreq->src;
712
713	scatterwalk_map_and_copy(qat_req->iv, sgl, offset, AES_BLOCK_SIZE, 0);
714}
715
716static void qat_alg_update_iv(struct qat_crypto_request *qat_req)
717{
718	struct qat_alg_skcipher_ctx *ctx = qat_req->skcipher_ctx;
719	struct device *dev = &GET_DEV(ctx->inst->accel_dev);
720
721	switch (ctx->mode) {
722	case ICP_QAT_HW_CIPHER_CTR_MODE:
723		qat_alg_update_iv_ctr_mode(qat_req);
724		break;
725	case ICP_QAT_HW_CIPHER_CBC_MODE:
726		qat_alg_update_iv_cbc_mode(qat_req);
727		break;
728	case ICP_QAT_HW_CIPHER_XTS_MODE:
729		break;
730	default:
731		dev_warn(dev, "Unsupported IV update for cipher mode %d\n",
732			 ctx->mode);
733	}
734}
735
736static void qat_skcipher_alg_callback(struct icp_qat_fw_la_resp *qat_resp,
737				      struct qat_crypto_request *qat_req)
738{
739	struct qat_alg_skcipher_ctx *ctx = qat_req->skcipher_ctx;
740	struct qat_crypto_instance *inst = ctx->inst;
741	struct skcipher_request *sreq = qat_req->skcipher_req;
742	u8 stat_filed = qat_resp->comn_resp.comn_status;
743	int res = 0, qat_res = ICP_QAT_FW_COMN_RESP_CRYPTO_STAT_GET(stat_filed);
744
745	qat_bl_free_bufl(inst->accel_dev, &qat_req->buf);
746	if (unlikely(qat_res != ICP_QAT_FW_COMN_STATUS_FLAG_OK))
747		res = -EINVAL;
748
749	if (qat_req->encryption)
750		qat_alg_update_iv(qat_req);
751
752	memcpy(sreq->iv, qat_req->iv, AES_BLOCK_SIZE);
753
754	skcipher_request_complete(sreq, res);
755}
756
757void qat_alg_callback(void *resp)
758{
759	struct icp_qat_fw_la_resp *qat_resp = resp;
760	struct qat_crypto_request *qat_req =
761				(void *)(__force long)qat_resp->opaque_data;
762	struct qat_instance_backlog *backlog = qat_req->alg_req.backlog;
763
764	qat_req->cb(qat_resp, qat_req);
765
766	qat_alg_send_backlog(backlog);
767}
768
769static int qat_alg_send_sym_message(struct qat_crypto_request *qat_req,
770				    struct qat_crypto_instance *inst,
771				    struct crypto_async_request *base)
772{
773	struct qat_alg_req *alg_req = &qat_req->alg_req;
774
775	alg_req->fw_req = (u32 *)&qat_req->req;
776	alg_req->tx_ring = inst->sym_tx;
777	alg_req->base = base;
778	alg_req->backlog = &inst->backlog;
779
780	return qat_alg_send_message(alg_req);
781}
782
783static int qat_alg_aead_dec(struct aead_request *areq)
784{
785	struct crypto_aead *aead_tfm = crypto_aead_reqtfm(areq);
786	struct crypto_tfm *tfm = crypto_aead_tfm(aead_tfm);
787	struct qat_alg_aead_ctx *ctx = crypto_tfm_ctx(tfm);
788	struct qat_crypto_request *qat_req = aead_request_ctx(areq);
789	struct icp_qat_fw_la_cipher_req_params *cipher_param;
790	struct icp_qat_fw_la_auth_req_params *auth_param;
791	struct icp_qat_fw_la_bulk_req *msg;
792	int digst_size = crypto_aead_authsize(aead_tfm);
793	gfp_t f = qat_algs_alloc_flags(&areq->base);
794	int ret;
795	u32 cipher_len;
796
797	cipher_len = areq->cryptlen - digst_size;
798	if (cipher_len % AES_BLOCK_SIZE != 0)
799		return -EINVAL;
800
801	ret = qat_bl_sgl_to_bufl(ctx->inst->accel_dev, areq->src, areq->dst,
802				 &qat_req->buf, NULL, f);
803	if (unlikely(ret))
804		return ret;
805
806	msg = &qat_req->req;
807	*msg = ctx->dec_fw_req;
808	qat_req->aead_ctx = ctx;
809	qat_req->aead_req = areq;
810	qat_req->cb = qat_aead_alg_callback;
811	qat_req->req.comn_mid.opaque_data = (u64)(__force long)qat_req;
812	qat_req->req.comn_mid.src_data_addr = qat_req->buf.blp;
813	qat_req->req.comn_mid.dest_data_addr = qat_req->buf.bloutp;
814	cipher_param = (void *)&qat_req->req.serv_specif_rqpars;
815	cipher_param->cipher_length = cipher_len;
816	cipher_param->cipher_offset = areq->assoclen;
817	memcpy(cipher_param->u.cipher_IV_array, areq->iv, AES_BLOCK_SIZE);
818	auth_param = (void *)((u8 *)cipher_param + sizeof(*cipher_param));
819	auth_param->auth_off = 0;
820	auth_param->auth_len = areq->assoclen + cipher_param->cipher_length;
821
822	ret = qat_alg_send_sym_message(qat_req, ctx->inst, &areq->base);
823	if (ret == -ENOSPC)
824		qat_bl_free_bufl(ctx->inst->accel_dev, &qat_req->buf);
825
826	return ret;
827}
828
829static int qat_alg_aead_enc(struct aead_request *areq)
830{
831	struct crypto_aead *aead_tfm = crypto_aead_reqtfm(areq);
832	struct crypto_tfm *tfm = crypto_aead_tfm(aead_tfm);
833	struct qat_alg_aead_ctx *ctx = crypto_tfm_ctx(tfm);
834	struct qat_crypto_request *qat_req = aead_request_ctx(areq);
835	struct icp_qat_fw_la_cipher_req_params *cipher_param;
836	struct icp_qat_fw_la_auth_req_params *auth_param;
837	gfp_t f = qat_algs_alloc_flags(&areq->base);
838	struct icp_qat_fw_la_bulk_req *msg;
839	u8 *iv = areq->iv;
840	int ret;
841
842	if (areq->cryptlen % AES_BLOCK_SIZE != 0)
843		return -EINVAL;
844
845	ret = qat_bl_sgl_to_bufl(ctx->inst->accel_dev, areq->src, areq->dst,
846				 &qat_req->buf, NULL, f);
847	if (unlikely(ret))
848		return ret;
849
850	msg = &qat_req->req;
851	*msg = ctx->enc_fw_req;
852	qat_req->aead_ctx = ctx;
853	qat_req->aead_req = areq;
854	qat_req->cb = qat_aead_alg_callback;
855	qat_req->req.comn_mid.opaque_data = (u64)(__force long)qat_req;
856	qat_req->req.comn_mid.src_data_addr = qat_req->buf.blp;
857	qat_req->req.comn_mid.dest_data_addr = qat_req->buf.bloutp;
858	cipher_param = (void *)&qat_req->req.serv_specif_rqpars;
859	auth_param = (void *)((u8 *)cipher_param + sizeof(*cipher_param));
860
861	memcpy(cipher_param->u.cipher_IV_array, iv, AES_BLOCK_SIZE);
862	cipher_param->cipher_length = areq->cryptlen;
863	cipher_param->cipher_offset = areq->assoclen;
864
865	auth_param->auth_off = 0;
866	auth_param->auth_len = areq->assoclen + areq->cryptlen;
867
868	ret = qat_alg_send_sym_message(qat_req, ctx->inst, &areq->base);
869	if (ret == -ENOSPC)
870		qat_bl_free_bufl(ctx->inst->accel_dev, &qat_req->buf);
871
872	return ret;
873}
874
875static int qat_alg_skcipher_rekey(struct qat_alg_skcipher_ctx *ctx,
876				  const u8 *key, unsigned int keylen,
877				  int mode)
878{
879	memset(ctx->enc_cd, 0, sizeof(*ctx->enc_cd));
880	memset(ctx->dec_cd, 0, sizeof(*ctx->dec_cd));
881	memset(&ctx->enc_fw_req, 0, sizeof(ctx->enc_fw_req));
882	memset(&ctx->dec_fw_req, 0, sizeof(ctx->dec_fw_req));
883
884	return qat_alg_skcipher_init_sessions(ctx, key, keylen, mode);
885}
886
887static int qat_alg_skcipher_newkey(struct qat_alg_skcipher_ctx *ctx,
888				   const u8 *key, unsigned int keylen,
889				   int mode)
890{
891	struct qat_crypto_instance *inst = NULL;
892	struct device *dev;
893	int node = numa_node_id();
894	int ret;
895
896	inst = qat_crypto_get_instance_node(node);
897	if (!inst)
898		return -EINVAL;
899	dev = &GET_DEV(inst->accel_dev);
900	ctx->inst = inst;
901	ctx->enc_cd = dma_alloc_coherent(dev, sizeof(*ctx->enc_cd),
902					 &ctx->enc_cd_paddr,
903					 GFP_ATOMIC);
904	if (!ctx->enc_cd) {
905		ret = -ENOMEM;
906		goto out_free_instance;
907	}
908	ctx->dec_cd = dma_alloc_coherent(dev, sizeof(*ctx->dec_cd),
909					 &ctx->dec_cd_paddr,
910					 GFP_ATOMIC);
911	if (!ctx->dec_cd) {
912		ret = -ENOMEM;
913		goto out_free_enc;
914	}
915
916	ret = qat_alg_skcipher_init_sessions(ctx, key, keylen, mode);
917	if (ret)
918		goto out_free_all;
919
920	return 0;
921
922out_free_all:
923	memset(ctx->dec_cd, 0, sizeof(*ctx->dec_cd));
924	dma_free_coherent(dev, sizeof(*ctx->dec_cd),
925			  ctx->dec_cd, ctx->dec_cd_paddr);
926	ctx->dec_cd = NULL;
927out_free_enc:
928	memset(ctx->enc_cd, 0, sizeof(*ctx->enc_cd));
929	dma_free_coherent(dev, sizeof(*ctx->enc_cd),
930			  ctx->enc_cd, ctx->enc_cd_paddr);
931	ctx->enc_cd = NULL;
932out_free_instance:
933	ctx->inst = NULL;
934	qat_crypto_put_instance(inst);
935	return ret;
936}
937
938static int qat_alg_skcipher_setkey(struct crypto_skcipher *tfm,
939				   const u8 *key, unsigned int keylen,
940				   int mode)
941{
942	struct qat_alg_skcipher_ctx *ctx = crypto_skcipher_ctx(tfm);
943
944	ctx->mode = mode;
945
946	if (ctx->enc_cd)
947		return qat_alg_skcipher_rekey(ctx, key, keylen, mode);
948	else
949		return qat_alg_skcipher_newkey(ctx, key, keylen, mode);
950}
951
952static int qat_alg_skcipher_cbc_setkey(struct crypto_skcipher *tfm,
953				       const u8 *key, unsigned int keylen)
954{
955	return qat_alg_skcipher_setkey(tfm, key, keylen,
956				       ICP_QAT_HW_CIPHER_CBC_MODE);
957}
958
959static int qat_alg_skcipher_ctr_setkey(struct crypto_skcipher *tfm,
960				       const u8 *key, unsigned int keylen)
961{
962	return qat_alg_skcipher_setkey(tfm, key, keylen,
963				       ICP_QAT_HW_CIPHER_CTR_MODE);
964}
965
966static int qat_alg_skcipher_xts_setkey(struct crypto_skcipher *tfm,
967				       const u8 *key, unsigned int keylen)
968{
969	struct qat_alg_skcipher_ctx *ctx = crypto_skcipher_ctx(tfm);
970	int ret;
971
972	ret = xts_verify_key(tfm, key, keylen);
973	if (ret)
974		return ret;
975
976	if (keylen >> 1 == AES_KEYSIZE_192) {
977		ret = crypto_skcipher_setkey(ctx->ftfm, key, keylen);
978		if (ret)
979			return ret;
980
981		ctx->fallback = true;
982
983		return 0;
984	}
985
986	ctx->fallback = false;
987
988	ret = qat_alg_skcipher_setkey(tfm, key, keylen,
989				      ICP_QAT_HW_CIPHER_XTS_MODE);
990	if (ret)
991		return ret;
992
993	if (HW_CAP_AES_V2(ctx->inst->accel_dev))
994		ret = crypto_cipher_setkey(ctx->tweak, key + (keylen / 2),
995					   keylen / 2);
996
997	return ret;
998}
999
1000static void qat_alg_set_req_iv(struct qat_crypto_request *qat_req)
1001{
1002	struct icp_qat_fw_la_cipher_req_params *cipher_param;
1003	struct qat_alg_skcipher_ctx *ctx = qat_req->skcipher_ctx;
1004	bool aes_v2_capable = HW_CAP_AES_V2(ctx->inst->accel_dev);
1005	u8 *iv = qat_req->skcipher_req->iv;
1006
1007	cipher_param = (void *)&qat_req->req.serv_specif_rqpars;
1008
1009	if (aes_v2_capable && ctx->mode == ICP_QAT_HW_CIPHER_XTS_MODE)
1010		crypto_cipher_encrypt_one(ctx->tweak,
1011					  (u8 *)cipher_param->u.cipher_IV_array,
1012					  iv);
1013	else
1014		memcpy(cipher_param->u.cipher_IV_array, iv, AES_BLOCK_SIZE);
1015}
1016
1017static int qat_alg_skcipher_encrypt(struct skcipher_request *req)
1018{
1019	struct crypto_skcipher *stfm = crypto_skcipher_reqtfm(req);
1020	struct crypto_tfm *tfm = crypto_skcipher_tfm(stfm);
1021	struct qat_alg_skcipher_ctx *ctx = crypto_tfm_ctx(tfm);
1022	struct qat_crypto_request *qat_req = skcipher_request_ctx(req);
1023	struct icp_qat_fw_la_cipher_req_params *cipher_param;
1024	gfp_t f = qat_algs_alloc_flags(&req->base);
1025	struct icp_qat_fw_la_bulk_req *msg;
1026	int ret;
1027
1028	if (req->cryptlen == 0)
1029		return 0;
1030
1031	ret = qat_bl_sgl_to_bufl(ctx->inst->accel_dev, req->src, req->dst,
1032				 &qat_req->buf, NULL, f);
1033	if (unlikely(ret))
1034		return ret;
1035
1036	msg = &qat_req->req;
1037	*msg = ctx->enc_fw_req;
1038	qat_req->skcipher_ctx = ctx;
1039	qat_req->skcipher_req = req;
1040	qat_req->cb = qat_skcipher_alg_callback;
1041	qat_req->req.comn_mid.opaque_data = (u64)(__force long)qat_req;
1042	qat_req->req.comn_mid.src_data_addr = qat_req->buf.blp;
1043	qat_req->req.comn_mid.dest_data_addr = qat_req->buf.bloutp;
1044	qat_req->encryption = true;
1045	cipher_param = (void *)&qat_req->req.serv_specif_rqpars;
1046	cipher_param->cipher_length = req->cryptlen;
1047	cipher_param->cipher_offset = 0;
1048
1049	qat_alg_set_req_iv(qat_req);
1050
1051	ret = qat_alg_send_sym_message(qat_req, ctx->inst, &req->base);
1052	if (ret == -ENOSPC)
1053		qat_bl_free_bufl(ctx->inst->accel_dev, &qat_req->buf);
1054
1055	return ret;
1056}
1057
1058static int qat_alg_skcipher_blk_encrypt(struct skcipher_request *req)
1059{
1060	if (req->cryptlen % AES_BLOCK_SIZE != 0)
1061		return -EINVAL;
1062
1063	return qat_alg_skcipher_encrypt(req);
1064}
1065
1066static int qat_alg_skcipher_xts_encrypt(struct skcipher_request *req)
1067{
1068	struct crypto_skcipher *stfm = crypto_skcipher_reqtfm(req);
1069	struct qat_alg_skcipher_ctx *ctx = crypto_skcipher_ctx(stfm);
1070	struct skcipher_request *nreq = skcipher_request_ctx(req);
1071
1072	if (req->cryptlen < XTS_BLOCK_SIZE)
1073		return -EINVAL;
1074
1075	if (ctx->fallback) {
1076		memcpy(nreq, req, sizeof(*req));
1077		skcipher_request_set_tfm(nreq, ctx->ftfm);
1078		return crypto_skcipher_encrypt(nreq);
1079	}
1080
1081	return qat_alg_skcipher_encrypt(req);
1082}
1083
1084static int qat_alg_skcipher_decrypt(struct skcipher_request *req)
1085{
1086	struct crypto_skcipher *stfm = crypto_skcipher_reqtfm(req);
1087	struct crypto_tfm *tfm = crypto_skcipher_tfm(stfm);
1088	struct qat_alg_skcipher_ctx *ctx = crypto_tfm_ctx(tfm);
1089	struct qat_crypto_request *qat_req = skcipher_request_ctx(req);
1090	struct icp_qat_fw_la_cipher_req_params *cipher_param;
1091	gfp_t f = qat_algs_alloc_flags(&req->base);
1092	struct icp_qat_fw_la_bulk_req *msg;
1093	int ret;
1094
1095	if (req->cryptlen == 0)
1096		return 0;
1097
1098	ret = qat_bl_sgl_to_bufl(ctx->inst->accel_dev, req->src, req->dst,
1099				 &qat_req->buf, NULL, f);
1100	if (unlikely(ret))
1101		return ret;
1102
1103	msg = &qat_req->req;
1104	*msg = ctx->dec_fw_req;
1105	qat_req->skcipher_ctx = ctx;
1106	qat_req->skcipher_req = req;
1107	qat_req->cb = qat_skcipher_alg_callback;
1108	qat_req->req.comn_mid.opaque_data = (u64)(__force long)qat_req;
1109	qat_req->req.comn_mid.src_data_addr = qat_req->buf.blp;
1110	qat_req->req.comn_mid.dest_data_addr = qat_req->buf.bloutp;
1111	qat_req->encryption = false;
1112	cipher_param = (void *)&qat_req->req.serv_specif_rqpars;
1113	cipher_param->cipher_length = req->cryptlen;
1114	cipher_param->cipher_offset = 0;
1115
1116	qat_alg_set_req_iv(qat_req);
1117	qat_alg_update_iv(qat_req);
1118
1119	ret = qat_alg_send_sym_message(qat_req, ctx->inst, &req->base);
1120	if (ret == -ENOSPC)
1121		qat_bl_free_bufl(ctx->inst->accel_dev, &qat_req->buf);
1122
1123	return ret;
1124}
1125
1126static int qat_alg_skcipher_blk_decrypt(struct skcipher_request *req)
1127{
1128	if (req->cryptlen % AES_BLOCK_SIZE != 0)
1129		return -EINVAL;
1130
1131	return qat_alg_skcipher_decrypt(req);
1132}
1133
1134static int qat_alg_skcipher_xts_decrypt(struct skcipher_request *req)
1135{
1136	struct crypto_skcipher *stfm = crypto_skcipher_reqtfm(req);
1137	struct qat_alg_skcipher_ctx *ctx = crypto_skcipher_ctx(stfm);
1138	struct skcipher_request *nreq = skcipher_request_ctx(req);
1139
1140	if (req->cryptlen < XTS_BLOCK_SIZE)
1141		return -EINVAL;
1142
1143	if (ctx->fallback) {
1144		memcpy(nreq, req, sizeof(*req));
1145		skcipher_request_set_tfm(nreq, ctx->ftfm);
1146		return crypto_skcipher_decrypt(nreq);
1147	}
1148
1149	return qat_alg_skcipher_decrypt(req);
1150}
1151
1152static int qat_alg_aead_init(struct crypto_aead *tfm,
1153			     enum icp_qat_hw_auth_algo hash,
1154			     const char *hash_name)
1155{
1156	struct qat_alg_aead_ctx *ctx = crypto_aead_ctx(tfm);
1157
1158	ctx->hash_tfm = crypto_alloc_shash(hash_name, 0, 0);
1159	if (IS_ERR(ctx->hash_tfm))
1160		return PTR_ERR(ctx->hash_tfm);
1161	ctx->qat_hash_alg = hash;
1162	crypto_aead_set_reqsize(tfm, sizeof(struct qat_crypto_request));
1163	return 0;
1164}
1165
1166static int qat_alg_aead_sha1_init(struct crypto_aead *tfm)
1167{
1168	return qat_alg_aead_init(tfm, ICP_QAT_HW_AUTH_ALGO_SHA1, "sha1");
1169}
1170
1171static int qat_alg_aead_sha256_init(struct crypto_aead *tfm)
1172{
1173	return qat_alg_aead_init(tfm, ICP_QAT_HW_AUTH_ALGO_SHA256, "sha256");
1174}
1175
1176static int qat_alg_aead_sha512_init(struct crypto_aead *tfm)
1177{
1178	return qat_alg_aead_init(tfm, ICP_QAT_HW_AUTH_ALGO_SHA512, "sha512");
1179}
1180
1181static void qat_alg_aead_exit(struct crypto_aead *tfm)
1182{
1183	struct qat_alg_aead_ctx *ctx = crypto_aead_ctx(tfm);
1184	struct qat_crypto_instance *inst = ctx->inst;
1185	struct device *dev;
1186
1187	crypto_free_shash(ctx->hash_tfm);
1188
1189	if (!inst)
1190		return;
1191
1192	dev = &GET_DEV(inst->accel_dev);
1193	if (ctx->enc_cd) {
1194		memset(ctx->enc_cd, 0, sizeof(struct qat_alg_cd));
1195		dma_free_coherent(dev, sizeof(struct qat_alg_cd),
1196				  ctx->enc_cd, ctx->enc_cd_paddr);
1197	}
1198	if (ctx->dec_cd) {
1199		memset(ctx->dec_cd, 0, sizeof(struct qat_alg_cd));
1200		dma_free_coherent(dev, sizeof(struct qat_alg_cd),
1201				  ctx->dec_cd, ctx->dec_cd_paddr);
1202	}
1203	qat_crypto_put_instance(inst);
1204}
1205
1206static int qat_alg_skcipher_init_tfm(struct crypto_skcipher *tfm)
1207{
1208	crypto_skcipher_set_reqsize(tfm, sizeof(struct qat_crypto_request));
1209	return 0;
1210}
1211
1212static int qat_alg_skcipher_init_xts_tfm(struct crypto_skcipher *tfm)
1213{
1214	struct qat_alg_skcipher_ctx *ctx = crypto_skcipher_ctx(tfm);
1215	int reqsize;
1216
1217	ctx->ftfm = crypto_alloc_skcipher("xts(aes)", 0,
1218					  CRYPTO_ALG_NEED_FALLBACK);
1219	if (IS_ERR(ctx->ftfm))
1220		return PTR_ERR(ctx->ftfm);
1221
1222	ctx->tweak = crypto_alloc_cipher("aes", 0, 0);
1223	if (IS_ERR(ctx->tweak)) {
1224		crypto_free_skcipher(ctx->ftfm);
1225		return PTR_ERR(ctx->tweak);
1226	}
1227
1228	reqsize = max(sizeof(struct qat_crypto_request),
1229		      sizeof(struct skcipher_request) +
1230		      crypto_skcipher_reqsize(ctx->ftfm));
1231	crypto_skcipher_set_reqsize(tfm, reqsize);
1232
1233	return 0;
1234}
1235
1236static void qat_alg_skcipher_exit_tfm(struct crypto_skcipher *tfm)
1237{
1238	struct qat_alg_skcipher_ctx *ctx = crypto_skcipher_ctx(tfm);
1239	struct qat_crypto_instance *inst = ctx->inst;
1240	struct device *dev;
1241
1242	if (!inst)
1243		return;
1244
1245	dev = &GET_DEV(inst->accel_dev);
1246	if (ctx->enc_cd) {
1247		memset(ctx->enc_cd, 0,
1248		       sizeof(struct icp_qat_hw_cipher_algo_blk));
1249		dma_free_coherent(dev,
1250				  sizeof(struct icp_qat_hw_cipher_algo_blk),
1251				  ctx->enc_cd, ctx->enc_cd_paddr);
1252	}
1253	if (ctx->dec_cd) {
1254		memset(ctx->dec_cd, 0,
1255		       sizeof(struct icp_qat_hw_cipher_algo_blk));
1256		dma_free_coherent(dev,
1257				  sizeof(struct icp_qat_hw_cipher_algo_blk),
1258				  ctx->dec_cd, ctx->dec_cd_paddr);
1259	}
1260	qat_crypto_put_instance(inst);
1261}
1262
1263static void qat_alg_skcipher_exit_xts_tfm(struct crypto_skcipher *tfm)
1264{
1265	struct qat_alg_skcipher_ctx *ctx = crypto_skcipher_ctx(tfm);
1266
1267	if (ctx->ftfm)
1268		crypto_free_skcipher(ctx->ftfm);
1269
1270	if (ctx->tweak)
1271		crypto_free_cipher(ctx->tweak);
1272
1273	qat_alg_skcipher_exit_tfm(tfm);
1274}
1275
1276static struct aead_alg qat_aeads[] = { {
1277	.base = {
1278		.cra_name = "authenc(hmac(sha1),cbc(aes))",
1279		.cra_driver_name = "qat_aes_cbc_hmac_sha1",
1280		.cra_priority = 4001,
1281		.cra_flags = CRYPTO_ALG_ASYNC | CRYPTO_ALG_ALLOCATES_MEMORY,
1282		.cra_blocksize = AES_BLOCK_SIZE,
1283		.cra_ctxsize = sizeof(struct qat_alg_aead_ctx),
1284		.cra_module = THIS_MODULE,
1285	},
1286	.init = qat_alg_aead_sha1_init,
1287	.exit = qat_alg_aead_exit,
1288	.setkey = qat_alg_aead_setkey,
1289	.decrypt = qat_alg_aead_dec,
1290	.encrypt = qat_alg_aead_enc,
1291	.ivsize = AES_BLOCK_SIZE,
1292	.maxauthsize = SHA1_DIGEST_SIZE,
1293}, {
1294	.base = {
1295		.cra_name = "authenc(hmac(sha256),cbc(aes))",
1296		.cra_driver_name = "qat_aes_cbc_hmac_sha256",
1297		.cra_priority = 4001,
1298		.cra_flags = CRYPTO_ALG_ASYNC | CRYPTO_ALG_ALLOCATES_MEMORY,
1299		.cra_blocksize = AES_BLOCK_SIZE,
1300		.cra_ctxsize = sizeof(struct qat_alg_aead_ctx),
1301		.cra_module = THIS_MODULE,
1302	},
1303	.init = qat_alg_aead_sha256_init,
1304	.exit = qat_alg_aead_exit,
1305	.setkey = qat_alg_aead_setkey,
1306	.decrypt = qat_alg_aead_dec,
1307	.encrypt = qat_alg_aead_enc,
1308	.ivsize = AES_BLOCK_SIZE,
1309	.maxauthsize = SHA256_DIGEST_SIZE,
1310}, {
1311	.base = {
1312		.cra_name = "authenc(hmac(sha512),cbc(aes))",
1313		.cra_driver_name = "qat_aes_cbc_hmac_sha512",
1314		.cra_priority = 4001,
1315		.cra_flags = CRYPTO_ALG_ASYNC | CRYPTO_ALG_ALLOCATES_MEMORY,
1316		.cra_blocksize = AES_BLOCK_SIZE,
1317		.cra_ctxsize = sizeof(struct qat_alg_aead_ctx),
1318		.cra_module = THIS_MODULE,
1319	},
1320	.init = qat_alg_aead_sha512_init,
1321	.exit = qat_alg_aead_exit,
1322	.setkey = qat_alg_aead_setkey,
1323	.decrypt = qat_alg_aead_dec,
1324	.encrypt = qat_alg_aead_enc,
1325	.ivsize = AES_BLOCK_SIZE,
1326	.maxauthsize = SHA512_DIGEST_SIZE,
1327} };
1328
1329static struct skcipher_alg qat_skciphers[] = { {
1330	.base.cra_name = "cbc(aes)",
1331	.base.cra_driver_name = "qat_aes_cbc",
1332	.base.cra_priority = 4001,
1333	.base.cra_flags = CRYPTO_ALG_ASYNC | CRYPTO_ALG_ALLOCATES_MEMORY,
1334	.base.cra_blocksize = AES_BLOCK_SIZE,
1335	.base.cra_ctxsize = sizeof(struct qat_alg_skcipher_ctx),
1336	.base.cra_alignmask = 0,
1337	.base.cra_module = THIS_MODULE,
1338
1339	.init = qat_alg_skcipher_init_tfm,
1340	.exit = qat_alg_skcipher_exit_tfm,
1341	.setkey = qat_alg_skcipher_cbc_setkey,
1342	.decrypt = qat_alg_skcipher_blk_decrypt,
1343	.encrypt = qat_alg_skcipher_blk_encrypt,
1344	.min_keysize = AES_MIN_KEY_SIZE,
1345	.max_keysize = AES_MAX_KEY_SIZE,
1346	.ivsize = AES_BLOCK_SIZE,
1347}, {
1348	.base.cra_name = "ctr(aes)",
1349	.base.cra_driver_name = "qat_aes_ctr",
1350	.base.cra_priority = 4001,
1351	.base.cra_flags = CRYPTO_ALG_ASYNC | CRYPTO_ALG_ALLOCATES_MEMORY,
1352	.base.cra_blocksize = 1,
1353	.base.cra_ctxsize = sizeof(struct qat_alg_skcipher_ctx),
1354	.base.cra_alignmask = 0,
1355	.base.cra_module = THIS_MODULE,
1356
1357	.init = qat_alg_skcipher_init_tfm,
1358	.exit = qat_alg_skcipher_exit_tfm,
1359	.setkey = qat_alg_skcipher_ctr_setkey,
1360	.decrypt = qat_alg_skcipher_decrypt,
1361	.encrypt = qat_alg_skcipher_encrypt,
1362	.min_keysize = AES_MIN_KEY_SIZE,
1363	.max_keysize = AES_MAX_KEY_SIZE,
1364	.ivsize = AES_BLOCK_SIZE,
1365}, {
1366	.base.cra_name = "xts(aes)",
1367	.base.cra_driver_name = "qat_aes_xts",
1368	.base.cra_priority = 4001,
1369	.base.cra_flags = CRYPTO_ALG_ASYNC | CRYPTO_ALG_NEED_FALLBACK |
1370			  CRYPTO_ALG_ALLOCATES_MEMORY,
1371	.base.cra_blocksize = AES_BLOCK_SIZE,
1372	.base.cra_ctxsize = sizeof(struct qat_alg_skcipher_ctx),
1373	.base.cra_alignmask = 0,
1374	.base.cra_module = THIS_MODULE,
1375
1376	.init = qat_alg_skcipher_init_xts_tfm,
1377	.exit = qat_alg_skcipher_exit_xts_tfm,
1378	.setkey = qat_alg_skcipher_xts_setkey,
1379	.decrypt = qat_alg_skcipher_xts_decrypt,
1380	.encrypt = qat_alg_skcipher_xts_encrypt,
1381	.min_keysize = 2 * AES_MIN_KEY_SIZE,
1382	.max_keysize = 2 * AES_MAX_KEY_SIZE,
1383	.ivsize = AES_BLOCK_SIZE,
1384} };
1385
1386int qat_algs_register(void)
1387{
1388	int ret = 0;
1389
1390	mutex_lock(&algs_lock);
1391	if (++active_devs != 1)
1392		goto unlock;
1393
1394	ret = crypto_register_skciphers(qat_skciphers,
1395					ARRAY_SIZE(qat_skciphers));
1396	if (ret)
1397		goto unlock;
1398
1399	ret = crypto_register_aeads(qat_aeads, ARRAY_SIZE(qat_aeads));
1400	if (ret)
1401		goto unreg_algs;
1402
1403unlock:
1404	mutex_unlock(&algs_lock);
1405	return ret;
1406
1407unreg_algs:
1408	crypto_unregister_skciphers(qat_skciphers, ARRAY_SIZE(qat_skciphers));
1409	goto unlock;
1410}
1411
1412void qat_algs_unregister(void)
1413{
1414	mutex_lock(&algs_lock);
1415	if (--active_devs != 0)
1416		goto unlock;
1417
1418	crypto_unregister_aeads(qat_aeads, ARRAY_SIZE(qat_aeads));
1419	crypto_unregister_skciphers(qat_skciphers, ARRAY_SIZE(qat_skciphers));
1420
1421unlock:
1422	mutex_unlock(&algs_lock);
1423}
1424