1// SPDX-License-Identifier: GPL-2.0
2/* Copyright (c) 2019 HiSilicon Limited. */
3#include <crypto/internal/acompress.h>
4#include <linux/bitfield.h>
5#include <linux/dma-mapping.h>
6#include <linux/scatterlist.h>
7#include "zip.h"
8
9/* hisi_zip_sqe dw3 */
10#define HZIP_BD_STATUS_M			GENMASK(7, 0)
11/* hisi_zip_sqe dw7 */
12#define HZIP_IN_SGE_DATA_OFFSET_M		GENMASK(23, 0)
13/* hisi_zip_sqe dw8 */
14#define HZIP_OUT_SGE_DATA_OFFSET_M		GENMASK(23, 0)
15/* hisi_zip_sqe dw9 */
16#define HZIP_REQ_TYPE_M				GENMASK(7, 0)
17#define HZIP_ALG_TYPE_ZLIB			0x02
18#define HZIP_ALG_TYPE_GZIP			0x03
19#define HZIP_BUF_TYPE_M				GENMASK(11, 8)
20#define HZIP_PBUFFER				0x0
21#define HZIP_SGL				0x1
22
23#define HZIP_ZLIB_HEAD_SIZE			2
24#define HZIP_GZIP_HEAD_SIZE			10
25
26#define GZIP_HEAD_FHCRC_BIT			BIT(1)
27#define GZIP_HEAD_FEXTRA_BIT			BIT(2)
28#define GZIP_HEAD_FNAME_BIT			BIT(3)
29#define GZIP_HEAD_FCOMMENT_BIT			BIT(4)
30
31#define GZIP_HEAD_FLG_SHIFT			3
32#define GZIP_HEAD_FEXTRA_SHIFT			10
33#define GZIP_HEAD_FEXTRA_XLEN			2UL
34#define GZIP_HEAD_FHCRC_SIZE			2
35
36#define HZIP_GZIP_HEAD_BUF			256
37#define HZIP_ALG_PRIORITY			300
38#define HZIP_SGL_SGE_NR				10
39
40static const u8 zlib_head[HZIP_ZLIB_HEAD_SIZE] = {0x78, 0x9c};
41static const u8 gzip_head[HZIP_GZIP_HEAD_SIZE] = {
42	0x1f, 0x8b, 0x08, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x03
43};
44
45enum hisi_zip_alg_type {
46	HZIP_ALG_TYPE_COMP = 0,
47	HZIP_ALG_TYPE_DECOMP = 1,
48};
49
50enum {
51	HZIP_QPC_COMP,
52	HZIP_QPC_DECOMP,
53	HZIP_CTX_Q_NUM
54};
55
56#define COMP_NAME_TO_TYPE(alg_name)					\
57	(!strcmp((alg_name), "zlib-deflate") ? HZIP_ALG_TYPE_ZLIB :	\
58	 !strcmp((alg_name), "gzip") ? HZIP_ALG_TYPE_GZIP : 0)		\
59
60#define TO_HEAD_SIZE(req_type)						\
61	(((req_type) == HZIP_ALG_TYPE_ZLIB) ? sizeof(zlib_head) :	\
62	 ((req_type) == HZIP_ALG_TYPE_GZIP) ? sizeof(gzip_head) : 0)	\
63
64#define TO_HEAD(req_type)						\
65	(((req_type) == HZIP_ALG_TYPE_ZLIB) ? zlib_head :		\
66	 ((req_type) == HZIP_ALG_TYPE_GZIP) ? gzip_head : NULL)		\
67
68struct hisi_zip_req {
69	struct acomp_req *req;
70	u32 sskip;
71	u32 dskip;
72	struct hisi_acc_hw_sgl *hw_src;
73	struct hisi_acc_hw_sgl *hw_dst;
74	dma_addr_t dma_src;
75	dma_addr_t dma_dst;
76	u16 req_id;
77};
78
79struct hisi_zip_req_q {
80	struct hisi_zip_req *q;
81	unsigned long *req_bitmap;
82	rwlock_t req_lock;
83	u16 size;
84};
85
86struct hisi_zip_qp_ctx {
87	struct hisi_qp *qp;
88	struct hisi_zip_req_q req_q;
89	struct hisi_acc_sgl_pool *sgl_pool;
90	struct hisi_zip *zip_dev;
91	struct hisi_zip_ctx *ctx;
92};
93
94struct hisi_zip_ctx {
95	struct hisi_zip_qp_ctx qp_ctx[HZIP_CTX_Q_NUM];
96};
97
98static int sgl_sge_nr_set(const char *val, const struct kernel_param *kp)
99{
100	int ret;
101	u16 n;
102
103	if (!val)
104		return -EINVAL;
105
106	ret = kstrtou16(val, 10, &n);
107	if (ret || n == 0 || n > HISI_ACC_SGL_SGE_NR_MAX)
108		return -EINVAL;
109
110	return param_set_ushort(val, kp);
111}
112
113static const struct kernel_param_ops sgl_sge_nr_ops = {
114	.set = sgl_sge_nr_set,
115	.get = param_get_ushort,
116};
117
118static u16 sgl_sge_nr = HZIP_SGL_SGE_NR;
119module_param_cb(sgl_sge_nr, &sgl_sge_nr_ops, &sgl_sge_nr, 0444);
120MODULE_PARM_DESC(sgl_sge_nr, "Number of sge in sgl(1-255)");
121
122static void hisi_zip_config_buf_type(struct hisi_zip_sqe *sqe, u8 buf_type)
123{
124	u32 val;
125
126	val = (sqe->dw9) & ~HZIP_BUF_TYPE_M;
127	val |= FIELD_PREP(HZIP_BUF_TYPE_M, buf_type);
128	sqe->dw9 = val;
129}
130
131static void hisi_zip_config_tag(struct hisi_zip_sqe *sqe, u32 tag)
132{
133	sqe->tag = tag;
134}
135
136static void hisi_zip_fill_sqe(struct hisi_zip_sqe *sqe, u8 req_type,
137			      dma_addr_t s_addr, dma_addr_t d_addr, u32 slen,
138			      u32 dlen, u32 sskip, u32 dskip)
139{
140	memset(sqe, 0, sizeof(struct hisi_zip_sqe));
141
142	sqe->input_data_length = slen - sskip;
143	sqe->dw7 = FIELD_PREP(HZIP_IN_SGE_DATA_OFFSET_M, sskip);
144	sqe->dw8 = FIELD_PREP(HZIP_OUT_SGE_DATA_OFFSET_M, dskip);
145	sqe->dw9 = FIELD_PREP(HZIP_REQ_TYPE_M, req_type);
146	sqe->dest_avail_out = dlen - dskip;
147	sqe->source_addr_l = lower_32_bits(s_addr);
148	sqe->source_addr_h = upper_32_bits(s_addr);
149	sqe->dest_addr_l = lower_32_bits(d_addr);
150	sqe->dest_addr_h = upper_32_bits(d_addr);
151}
152
153static int hisi_zip_start_qp(struct hisi_qp *qp, struct hisi_zip_qp_ctx *ctx,
154			     int alg_type, int req_type)
155{
156	struct device *dev = &qp->qm->pdev->dev;
157	int ret;
158
159	qp->req_type = req_type;
160	qp->alg_type = alg_type;
161	qp->qp_ctx = ctx;
162
163	ret = hisi_qm_start_qp(qp, 0);
164	if (ret < 0) {
165		dev_err(dev, "failed to start qp (%d)!\n", ret);
166		return ret;
167	}
168
169	ctx->qp = qp;
170
171	return 0;
172}
173
174static void hisi_zip_release_qp(struct hisi_zip_qp_ctx *ctx)
175{
176	hisi_qm_stop_qp(ctx->qp);
177	hisi_qm_release_qp(ctx->qp);
178}
179
180static int hisi_zip_ctx_init(struct hisi_zip_ctx *hisi_zip_ctx, u8 req_type, int node)
181{
182	struct hisi_qp *qps[HZIP_CTX_Q_NUM] = { NULL };
183	struct hisi_zip *hisi_zip;
184	int ret, i, j;
185
186	ret = zip_create_qps(qps, HZIP_CTX_Q_NUM, node);
187	if (ret) {
188		pr_err("failed to create zip qps (%d)!\n", ret);
189		return -ENODEV;
190	}
191
192	hisi_zip = container_of(qps[0]->qm, struct hisi_zip, qm);
193
194	for (i = 0; i < HZIP_CTX_Q_NUM; i++) {
195		/* alg_type = 0 for compress, 1 for decompress in hw sqe */
196		ret = hisi_zip_start_qp(qps[i], &hisi_zip_ctx->qp_ctx[i], i,
197					req_type);
198		if (ret) {
199			for (j = i - 1; j >= 0; j--)
200				hisi_qm_stop_qp(hisi_zip_ctx->qp_ctx[j].qp);
201
202			hisi_qm_free_qps(qps, HZIP_CTX_Q_NUM);
203			return ret;
204		}
205
206		hisi_zip_ctx->qp_ctx[i].zip_dev = hisi_zip;
207	}
208
209	return 0;
210}
211
212static void hisi_zip_ctx_exit(struct hisi_zip_ctx *hisi_zip_ctx)
213{
214	int i;
215
216	for (i = 1; i >= 0; i--)
217		hisi_zip_release_qp(&hisi_zip_ctx->qp_ctx[i]);
218}
219
220static u16 get_extra_field_size(const u8 *start)
221{
222	return *((u16 *)start) + GZIP_HEAD_FEXTRA_XLEN;
223}
224
225static u32 get_name_field_size(const u8 *start)
226{
227	return strlen(start) + 1;
228}
229
230static u32 get_comment_field_size(const u8 *start)
231{
232	return strlen(start) + 1;
233}
234
235static u32 __get_gzip_head_size(const u8 *src)
236{
237	u8 head_flg = *(src + GZIP_HEAD_FLG_SHIFT);
238	u32 size = GZIP_HEAD_FEXTRA_SHIFT;
239
240	if (head_flg & GZIP_HEAD_FEXTRA_BIT)
241		size += get_extra_field_size(src + size);
242	if (head_flg & GZIP_HEAD_FNAME_BIT)
243		size += get_name_field_size(src + size);
244	if (head_flg & GZIP_HEAD_FCOMMENT_BIT)
245		size += get_comment_field_size(src + size);
246	if (head_flg & GZIP_HEAD_FHCRC_BIT)
247		size += GZIP_HEAD_FHCRC_SIZE;
248
249	return size;
250}
251
252static int hisi_zip_create_req_q(struct hisi_zip_ctx *ctx)
253{
254	struct hisi_zip_req_q *req_q;
255	int i, ret;
256
257	for (i = 0; i < HZIP_CTX_Q_NUM; i++) {
258		req_q = &ctx->qp_ctx[i].req_q;
259		req_q->size = QM_Q_DEPTH;
260
261		req_q->req_bitmap = kcalloc(BITS_TO_LONGS(req_q->size),
262					    sizeof(long), GFP_KERNEL);
263		if (!req_q->req_bitmap) {
264			ret = -ENOMEM;
265			if (i == 0)
266				return ret;
267
268			goto err_free_loop0;
269		}
270		rwlock_init(&req_q->req_lock);
271
272		req_q->q = kcalloc(req_q->size, sizeof(struct hisi_zip_req),
273				   GFP_KERNEL);
274		if (!req_q->q) {
275			ret = -ENOMEM;
276			if (i == 0)
277				goto err_free_bitmap;
278			else
279				goto err_free_loop1;
280		}
281	}
282
283	return 0;
284
285err_free_loop1:
286	kfree(ctx->qp_ctx[HZIP_QPC_DECOMP].req_q.req_bitmap);
287err_free_loop0:
288	kfree(ctx->qp_ctx[HZIP_QPC_COMP].req_q.q);
289err_free_bitmap:
290	kfree(ctx->qp_ctx[HZIP_QPC_COMP].req_q.req_bitmap);
291	return ret;
292}
293
294static void hisi_zip_release_req_q(struct hisi_zip_ctx *ctx)
295{
296	int i;
297
298	for (i = 0; i < HZIP_CTX_Q_NUM; i++) {
299		kfree(ctx->qp_ctx[i].req_q.q);
300		kfree(ctx->qp_ctx[i].req_q.req_bitmap);
301	}
302}
303
304static int hisi_zip_create_sgl_pool(struct hisi_zip_ctx *ctx)
305{
306	struct hisi_zip_qp_ctx *tmp;
307	struct device *dev;
308	int i;
309
310	for (i = 0; i < HZIP_CTX_Q_NUM; i++) {
311		tmp = &ctx->qp_ctx[i];
312		dev = &tmp->qp->qm->pdev->dev;
313		tmp->sgl_pool = hisi_acc_create_sgl_pool(dev, QM_Q_DEPTH << 1,
314							 sgl_sge_nr);
315		if (IS_ERR(tmp->sgl_pool)) {
316			if (i == 1)
317				goto err_free_sgl_pool0;
318			return -ENOMEM;
319		}
320	}
321
322	return 0;
323
324err_free_sgl_pool0:
325	hisi_acc_free_sgl_pool(&ctx->qp_ctx[HZIP_QPC_COMP].qp->qm->pdev->dev,
326			       ctx->qp_ctx[HZIP_QPC_COMP].sgl_pool);
327	return -ENOMEM;
328}
329
330static void hisi_zip_release_sgl_pool(struct hisi_zip_ctx *ctx)
331{
332	int i;
333
334	for (i = 0; i < HZIP_CTX_Q_NUM; i++)
335		hisi_acc_free_sgl_pool(&ctx->qp_ctx[i].qp->qm->pdev->dev,
336				       ctx->qp_ctx[i].sgl_pool);
337}
338
339static void hisi_zip_remove_req(struct hisi_zip_qp_ctx *qp_ctx,
340				struct hisi_zip_req *req)
341{
342	struct hisi_zip_req_q *req_q = &qp_ctx->req_q;
343
344	write_lock(&req_q->req_lock);
345	clear_bit(req->req_id, req_q->req_bitmap);
346	memset(req, 0, sizeof(struct hisi_zip_req));
347	write_unlock(&req_q->req_lock);
348}
349
350static void hisi_zip_acomp_cb(struct hisi_qp *qp, void *data)
351{
352	struct hisi_zip_sqe *sqe = data;
353	struct hisi_zip_qp_ctx *qp_ctx = qp->qp_ctx;
354	struct hisi_zip_dfx *dfx = &qp_ctx->zip_dev->dfx;
355	struct hisi_zip_req_q *req_q = &qp_ctx->req_q;
356	struct hisi_zip_req *req = req_q->q + sqe->tag;
357	struct acomp_req *acomp_req = req->req;
358	struct device *dev = &qp->qm->pdev->dev;
359	u32 status, dlen, head_size;
360	int err = 0;
361
362	atomic64_inc(&dfx->recv_cnt);
363	status = sqe->dw3 & HZIP_BD_STATUS_M;
364	if (status != 0 && status != HZIP_NC_ERR) {
365		dev_err(dev, "%scompress fail in qp%u: %u, output: %u\n",
366			(qp->alg_type == 0) ? "" : "de", qp->qp_id, status,
367			sqe->produced);
368		atomic64_inc(&dfx->err_bd_cnt);
369		err = -EIO;
370	}
371	dlen = sqe->produced;
372
373	hisi_acc_sg_buf_unmap(dev, acomp_req->src, req->hw_src);
374	hisi_acc_sg_buf_unmap(dev, acomp_req->dst, req->hw_dst);
375
376	head_size = (qp->alg_type == 0) ? TO_HEAD_SIZE(qp->req_type) : 0;
377	acomp_req->dlen = dlen + head_size;
378
379	if (acomp_req->base.complete)
380		acomp_request_complete(acomp_req, err);
381
382	hisi_zip_remove_req(qp_ctx, req);
383}
384
385static void hisi_zip_set_acomp_cb(struct hisi_zip_ctx *ctx,
386				  void (*fn)(struct hisi_qp *, void *))
387{
388	int i;
389
390	for (i = 0; i < HZIP_CTX_Q_NUM; i++)
391		ctx->qp_ctx[i].qp->req_cb = fn;
392}
393
394static int hisi_zip_acomp_init(struct crypto_acomp *tfm)
395{
396	const char *alg_name = crypto_tfm_alg_name(&tfm->base);
397	struct hisi_zip_ctx *ctx = crypto_tfm_ctx(&tfm->base);
398	struct device *dev;
399	int ret;
400
401	ret = hisi_zip_ctx_init(ctx, COMP_NAME_TO_TYPE(alg_name), tfm->base.node);
402	if (ret) {
403		pr_err("failed to init ctx (%d)!\n", ret);
404		return ret;
405	}
406
407	dev = &ctx->qp_ctx[0].qp->qm->pdev->dev;
408
409	ret = hisi_zip_create_req_q(ctx);
410	if (ret) {
411		dev_err(dev, "failed to create request queue (%d)!\n", ret);
412		goto err_ctx_exit;
413	}
414
415	ret = hisi_zip_create_sgl_pool(ctx);
416	if (ret) {
417		dev_err(dev, "failed to create sgl pool (%d)!\n", ret);
418		goto err_release_req_q;
419	}
420
421	hisi_zip_set_acomp_cb(ctx, hisi_zip_acomp_cb);
422
423	return 0;
424
425err_release_req_q:
426	hisi_zip_release_req_q(ctx);
427err_ctx_exit:
428	hisi_zip_ctx_exit(ctx);
429	return ret;
430}
431
432static void hisi_zip_acomp_exit(struct crypto_acomp *tfm)
433{
434	struct hisi_zip_ctx *ctx = crypto_tfm_ctx(&tfm->base);
435
436	hisi_zip_set_acomp_cb(ctx, NULL);
437	hisi_zip_release_sgl_pool(ctx);
438	hisi_zip_release_req_q(ctx);
439	hisi_zip_ctx_exit(ctx);
440}
441
442static int add_comp_head(struct scatterlist *dst, u8 req_type)
443{
444	int head_size = TO_HEAD_SIZE(req_type);
445	const u8 *head = TO_HEAD(req_type);
446	int ret;
447
448	ret = sg_copy_from_buffer(dst, sg_nents(dst), head, head_size);
449	if (ret != head_size) {
450		pr_err("the head size of buffer is wrong (%d)!\n", ret);
451		return -ENOMEM;
452	}
453
454	return head_size;
455}
456
457static size_t __maybe_unused get_gzip_head_size(struct scatterlist *sgl)
458{
459	char buf[HZIP_GZIP_HEAD_BUF];
460
461	sg_copy_to_buffer(sgl, sg_nents(sgl), buf, sizeof(buf));
462
463	return __get_gzip_head_size(buf);
464}
465
466static int  get_comp_head_size(struct acomp_req *acomp_req, u8 req_type)
467{
468	if (!acomp_req->src || !acomp_req->slen)
469		return -EINVAL;
470
471	if ((req_type == HZIP_ALG_TYPE_GZIP) &&
472	    (acomp_req->slen < GZIP_HEAD_FEXTRA_SHIFT))
473		return -EINVAL;
474
475	switch (req_type) {
476	case HZIP_ALG_TYPE_ZLIB:
477		return TO_HEAD_SIZE(HZIP_ALG_TYPE_ZLIB);
478	case HZIP_ALG_TYPE_GZIP:
479		return TO_HEAD_SIZE(HZIP_ALG_TYPE_GZIP);
480	default:
481		pr_err("request type does not support!\n");
482		return -EINVAL;
483	}
484}
485
486static struct hisi_zip_req *hisi_zip_create_req(struct acomp_req *req,
487						struct hisi_zip_qp_ctx *qp_ctx,
488						size_t head_size, bool is_comp)
489{
490	struct hisi_zip_req_q *req_q = &qp_ctx->req_q;
491	struct hisi_zip_req *q = req_q->q;
492	struct hisi_zip_req *req_cache;
493	int req_id;
494
495	write_lock(&req_q->req_lock);
496
497	req_id = find_first_zero_bit(req_q->req_bitmap, req_q->size);
498	if (req_id >= req_q->size) {
499		write_unlock(&req_q->req_lock);
500		dev_dbg(&qp_ctx->qp->qm->pdev->dev, "req cache is full!\n");
501		return ERR_PTR(-EAGAIN);
502	}
503	set_bit(req_id, req_q->req_bitmap);
504
505	req_cache = q + req_id;
506	req_cache->req_id = req_id;
507	req_cache->req = req;
508
509	if (is_comp) {
510		req_cache->sskip = 0;
511		req_cache->dskip = head_size;
512	} else {
513		req_cache->sskip = head_size;
514		req_cache->dskip = 0;
515	}
516
517	write_unlock(&req_q->req_lock);
518
519	return req_cache;
520}
521
522static int hisi_zip_do_work(struct hisi_zip_req *req,
523			    struct hisi_zip_qp_ctx *qp_ctx)
524{
525	struct acomp_req *a_req = req->req;
526	struct hisi_qp *qp = qp_ctx->qp;
527	struct device *dev = &qp->qm->pdev->dev;
528	struct hisi_acc_sgl_pool *pool = qp_ctx->sgl_pool;
529	struct hisi_zip_dfx *dfx = &qp_ctx->zip_dev->dfx;
530	struct hisi_zip_sqe zip_sqe;
531	dma_addr_t input, output;
532	int ret;
533
534	if (!a_req->src || !a_req->slen || !a_req->dst || !a_req->dlen)
535		return -EINVAL;
536
537	req->hw_src = hisi_acc_sg_buf_map_to_hw_sgl(dev, a_req->src, pool,
538						    req->req_id << 1, &input);
539	if (IS_ERR(req->hw_src)) {
540		dev_err(dev, "failed to map the src buffer to hw sgl (%ld)!\n",
541			PTR_ERR(req->hw_src));
542		return PTR_ERR(req->hw_src);
543	}
544	req->dma_src = input;
545
546	req->hw_dst = hisi_acc_sg_buf_map_to_hw_sgl(dev, a_req->dst, pool,
547						    (req->req_id << 1) + 1,
548						    &output);
549	if (IS_ERR(req->hw_dst)) {
550		ret = PTR_ERR(req->hw_dst);
551		dev_err(dev, "failed to map the dst buffer to hw slg (%d)!\n",
552			ret);
553		goto err_unmap_input;
554	}
555	req->dma_dst = output;
556
557	hisi_zip_fill_sqe(&zip_sqe, qp->req_type, input, output, a_req->slen,
558			  a_req->dlen, req->sskip, req->dskip);
559	hisi_zip_config_buf_type(&zip_sqe, HZIP_SGL);
560	hisi_zip_config_tag(&zip_sqe, req->req_id);
561
562	/* send command to start a task */
563	atomic64_inc(&dfx->send_cnt);
564	ret = hisi_qp_send(qp, &zip_sqe);
565	if (ret < 0) {
566		atomic64_inc(&dfx->send_busy_cnt);
567		ret = -EAGAIN;
568		dev_dbg_ratelimited(dev, "failed to send request!\n");
569		goto err_unmap_output;
570	}
571
572	return -EINPROGRESS;
573
574err_unmap_output:
575	hisi_acc_sg_buf_unmap(dev, a_req->dst, req->hw_dst);
576err_unmap_input:
577	hisi_acc_sg_buf_unmap(dev, a_req->src, req->hw_src);
578	return ret;
579}
580
581static int hisi_zip_acompress(struct acomp_req *acomp_req)
582{
583	struct hisi_zip_ctx *ctx = crypto_tfm_ctx(acomp_req->base.tfm);
584	struct hisi_zip_qp_ctx *qp_ctx = &ctx->qp_ctx[HZIP_QPC_COMP];
585	struct device *dev = &qp_ctx->qp->qm->pdev->dev;
586	struct hisi_zip_req *req;
587	int head_size;
588	int ret;
589
590	/* let's output compression head now */
591	head_size = add_comp_head(acomp_req->dst, qp_ctx->qp->req_type);
592	if (head_size < 0) {
593		dev_err_ratelimited(dev, "failed to add comp head (%d)!\n",
594				    head_size);
595		return head_size;
596	}
597
598	req = hisi_zip_create_req(acomp_req, qp_ctx, head_size, true);
599	if (IS_ERR(req))
600		return PTR_ERR(req);
601
602	ret = hisi_zip_do_work(req, qp_ctx);
603	if (ret != -EINPROGRESS) {
604		dev_info_ratelimited(dev, "failed to do compress (%d)!\n", ret);
605		hisi_zip_remove_req(qp_ctx, req);
606	}
607
608	return ret;
609}
610
611static int hisi_zip_adecompress(struct acomp_req *acomp_req)
612{
613	struct hisi_zip_ctx *ctx = crypto_tfm_ctx(acomp_req->base.tfm);
614	struct hisi_zip_qp_ctx *qp_ctx = &ctx->qp_ctx[HZIP_QPC_DECOMP];
615	struct device *dev = &qp_ctx->qp->qm->pdev->dev;
616	struct hisi_zip_req *req;
617	int head_size, ret;
618
619	head_size = get_comp_head_size(acomp_req, qp_ctx->qp->req_type);
620	if (head_size < 0) {
621		dev_err_ratelimited(dev, "failed to get comp head size (%d)!\n",
622				    head_size);
623		return head_size;
624	}
625
626	req = hisi_zip_create_req(acomp_req, qp_ctx, head_size, false);
627	if (IS_ERR(req))
628		return PTR_ERR(req);
629
630	ret = hisi_zip_do_work(req, qp_ctx);
631	if (ret != -EINPROGRESS) {
632		dev_info_ratelimited(dev, "failed to do decompress (%d)!\n",
633				     ret);
634		hisi_zip_remove_req(qp_ctx, req);
635	}
636
637	return ret;
638}
639
640static struct acomp_alg hisi_zip_acomp_zlib = {
641	.init			= hisi_zip_acomp_init,
642	.exit			= hisi_zip_acomp_exit,
643	.compress		= hisi_zip_acompress,
644	.decompress		= hisi_zip_adecompress,
645	.base			= {
646		.cra_name		= "zlib-deflate",
647		.cra_driver_name	= "hisi-zlib-acomp",
648		.cra_module		= THIS_MODULE,
649		.cra_priority           = HZIP_ALG_PRIORITY,
650		.cra_ctxsize		= sizeof(struct hisi_zip_ctx),
651	}
652};
653
654static struct acomp_alg hisi_zip_acomp_gzip = {
655	.init			= hisi_zip_acomp_init,
656	.exit			= hisi_zip_acomp_exit,
657	.compress		= hisi_zip_acompress,
658	.decompress		= hisi_zip_adecompress,
659	.base			= {
660		.cra_name		= "gzip",
661		.cra_driver_name	= "hisi-gzip-acomp",
662		.cra_module		= THIS_MODULE,
663		.cra_priority           = HZIP_ALG_PRIORITY,
664		.cra_ctxsize		= sizeof(struct hisi_zip_ctx),
665	}
666};
667
668int hisi_zip_register_to_crypto(void)
669{
670	int ret;
671
672	ret = crypto_register_acomp(&hisi_zip_acomp_zlib);
673	if (ret) {
674		pr_err("failed to register to zlib (%d)!\n", ret);
675		return ret;
676	}
677
678	ret = crypto_register_acomp(&hisi_zip_acomp_gzip);
679	if (ret) {
680		pr_err("failed to register to gzip (%d)!\n", ret);
681		crypto_unregister_acomp(&hisi_zip_acomp_zlib);
682	}
683
684	return ret;
685}
686
687void hisi_zip_unregister_from_crypto(void)
688{
689	crypto_unregister_acomp(&hisi_zip_acomp_gzip);
690	crypto_unregister_acomp(&hisi_zip_acomp_zlib);
691}
692