18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Synchronous Compression operations
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright 2015 LG Electronics Inc.
68c2ecf20Sopenharmony_ci * Copyright (c) 2016, Intel Corporation
78c2ecf20Sopenharmony_ci * Author: Giovanni Cabiddu <giovanni.cabiddu@intel.com>
88c2ecf20Sopenharmony_ci */
98c2ecf20Sopenharmony_ci#include <linux/errno.h>
108c2ecf20Sopenharmony_ci#include <linux/kernel.h>
118c2ecf20Sopenharmony_ci#include <linux/module.h>
128c2ecf20Sopenharmony_ci#include <linux/seq_file.h>
138c2ecf20Sopenharmony_ci#include <linux/slab.h>
148c2ecf20Sopenharmony_ci#include <linux/string.h>
158c2ecf20Sopenharmony_ci#include <linux/crypto.h>
168c2ecf20Sopenharmony_ci#include <linux/compiler.h>
178c2ecf20Sopenharmony_ci#include <linux/vmalloc.h>
188c2ecf20Sopenharmony_ci#include <crypto/algapi.h>
198c2ecf20Sopenharmony_ci#include <linux/cryptouser.h>
208c2ecf20Sopenharmony_ci#include <net/netlink.h>
218c2ecf20Sopenharmony_ci#include <linux/scatterlist.h>
228c2ecf20Sopenharmony_ci#include <crypto/scatterwalk.h>
238c2ecf20Sopenharmony_ci#include <crypto/internal/acompress.h>
248c2ecf20Sopenharmony_ci#include <crypto/internal/scompress.h>
258c2ecf20Sopenharmony_ci#include "internal.h"
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_cistruct scomp_scratch {
288c2ecf20Sopenharmony_ci	spinlock_t	lock;
298c2ecf20Sopenharmony_ci	void		*src;
308c2ecf20Sopenharmony_ci	void		*dst;
318c2ecf20Sopenharmony_ci};
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_cistatic DEFINE_PER_CPU(struct scomp_scratch, scomp_scratch) = {
348c2ecf20Sopenharmony_ci	.lock = __SPIN_LOCK_UNLOCKED(scomp_scratch.lock),
358c2ecf20Sopenharmony_ci};
368c2ecf20Sopenharmony_ci
378c2ecf20Sopenharmony_cistatic const struct crypto_type crypto_scomp_type;
388c2ecf20Sopenharmony_cistatic int scomp_scratch_users;
398c2ecf20Sopenharmony_cistatic DEFINE_MUTEX(scomp_lock);
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_ci#ifdef CONFIG_NET
428c2ecf20Sopenharmony_cistatic int crypto_scomp_report(struct sk_buff *skb, struct crypto_alg *alg)
438c2ecf20Sopenharmony_ci{
448c2ecf20Sopenharmony_ci	struct crypto_report_comp rscomp;
458c2ecf20Sopenharmony_ci
468c2ecf20Sopenharmony_ci	memset(&rscomp, 0, sizeof(rscomp));
478c2ecf20Sopenharmony_ci
488c2ecf20Sopenharmony_ci	strscpy(rscomp.type, "scomp", sizeof(rscomp.type));
498c2ecf20Sopenharmony_ci
508c2ecf20Sopenharmony_ci	return nla_put(skb, CRYPTOCFGA_REPORT_COMPRESS,
518c2ecf20Sopenharmony_ci		       sizeof(rscomp), &rscomp);
528c2ecf20Sopenharmony_ci}
538c2ecf20Sopenharmony_ci#else
548c2ecf20Sopenharmony_cistatic int crypto_scomp_report(struct sk_buff *skb, struct crypto_alg *alg)
558c2ecf20Sopenharmony_ci{
568c2ecf20Sopenharmony_ci	return -ENOSYS;
578c2ecf20Sopenharmony_ci}
588c2ecf20Sopenharmony_ci#endif
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_cistatic void crypto_scomp_show(struct seq_file *m, struct crypto_alg *alg)
618c2ecf20Sopenharmony_ci	__maybe_unused;
628c2ecf20Sopenharmony_ci
638c2ecf20Sopenharmony_cistatic void crypto_scomp_show(struct seq_file *m, struct crypto_alg *alg)
648c2ecf20Sopenharmony_ci{
658c2ecf20Sopenharmony_ci	seq_puts(m, "type         : scomp\n");
668c2ecf20Sopenharmony_ci}
678c2ecf20Sopenharmony_ci
688c2ecf20Sopenharmony_cistatic void crypto_scomp_free_scratches(void)
698c2ecf20Sopenharmony_ci{
708c2ecf20Sopenharmony_ci	struct scomp_scratch *scratch;
718c2ecf20Sopenharmony_ci	int i;
728c2ecf20Sopenharmony_ci
738c2ecf20Sopenharmony_ci	for_each_possible_cpu(i) {
748c2ecf20Sopenharmony_ci		scratch = per_cpu_ptr(&scomp_scratch, i);
758c2ecf20Sopenharmony_ci
768c2ecf20Sopenharmony_ci		vfree(scratch->src);
778c2ecf20Sopenharmony_ci		vfree(scratch->dst);
788c2ecf20Sopenharmony_ci		scratch->src = NULL;
798c2ecf20Sopenharmony_ci		scratch->dst = NULL;
808c2ecf20Sopenharmony_ci	}
818c2ecf20Sopenharmony_ci}
828c2ecf20Sopenharmony_ci
838c2ecf20Sopenharmony_cistatic int crypto_scomp_alloc_scratches(void)
848c2ecf20Sopenharmony_ci{
858c2ecf20Sopenharmony_ci	struct scomp_scratch *scratch;
868c2ecf20Sopenharmony_ci	int i;
878c2ecf20Sopenharmony_ci
888c2ecf20Sopenharmony_ci	for_each_possible_cpu(i) {
898c2ecf20Sopenharmony_ci		void *mem;
908c2ecf20Sopenharmony_ci
918c2ecf20Sopenharmony_ci		scratch = per_cpu_ptr(&scomp_scratch, i);
928c2ecf20Sopenharmony_ci
938c2ecf20Sopenharmony_ci		mem = vmalloc_node(SCOMP_SCRATCH_SIZE, cpu_to_node(i));
948c2ecf20Sopenharmony_ci		if (!mem)
958c2ecf20Sopenharmony_ci			goto error;
968c2ecf20Sopenharmony_ci		scratch->src = mem;
978c2ecf20Sopenharmony_ci		mem = vmalloc_node(SCOMP_SCRATCH_SIZE, cpu_to_node(i));
988c2ecf20Sopenharmony_ci		if (!mem)
998c2ecf20Sopenharmony_ci			goto error;
1008c2ecf20Sopenharmony_ci		scratch->dst = mem;
1018c2ecf20Sopenharmony_ci	}
1028c2ecf20Sopenharmony_ci	return 0;
1038c2ecf20Sopenharmony_cierror:
1048c2ecf20Sopenharmony_ci	crypto_scomp_free_scratches();
1058c2ecf20Sopenharmony_ci	return -ENOMEM;
1068c2ecf20Sopenharmony_ci}
1078c2ecf20Sopenharmony_ci
1088c2ecf20Sopenharmony_cistatic int crypto_scomp_init_tfm(struct crypto_tfm *tfm)
1098c2ecf20Sopenharmony_ci{
1108c2ecf20Sopenharmony_ci	int ret = 0;
1118c2ecf20Sopenharmony_ci
1128c2ecf20Sopenharmony_ci	mutex_lock(&scomp_lock);
1138c2ecf20Sopenharmony_ci	if (!scomp_scratch_users++)
1148c2ecf20Sopenharmony_ci		ret = crypto_scomp_alloc_scratches();
1158c2ecf20Sopenharmony_ci	mutex_unlock(&scomp_lock);
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_ci	return ret;
1188c2ecf20Sopenharmony_ci}
1198c2ecf20Sopenharmony_ci
1208c2ecf20Sopenharmony_cistatic int scomp_acomp_comp_decomp(struct acomp_req *req, int dir)
1218c2ecf20Sopenharmony_ci{
1228c2ecf20Sopenharmony_ci	struct crypto_acomp *tfm = crypto_acomp_reqtfm(req);
1238c2ecf20Sopenharmony_ci	void **tfm_ctx = acomp_tfm_ctx(tfm);
1248c2ecf20Sopenharmony_ci	struct crypto_scomp *scomp = *tfm_ctx;
1258c2ecf20Sopenharmony_ci	void **ctx = acomp_request_ctx(req);
1268c2ecf20Sopenharmony_ci	struct scomp_scratch *scratch;
1278c2ecf20Sopenharmony_ci	unsigned int dlen;
1288c2ecf20Sopenharmony_ci	int ret;
1298c2ecf20Sopenharmony_ci
1308c2ecf20Sopenharmony_ci	if (!req->src || !req->slen || req->slen > SCOMP_SCRATCH_SIZE)
1318c2ecf20Sopenharmony_ci		return -EINVAL;
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_ci	if (req->dst && !req->dlen)
1348c2ecf20Sopenharmony_ci		return -EINVAL;
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_ci	if (!req->dlen || req->dlen > SCOMP_SCRATCH_SIZE)
1378c2ecf20Sopenharmony_ci		req->dlen = SCOMP_SCRATCH_SIZE;
1388c2ecf20Sopenharmony_ci
1398c2ecf20Sopenharmony_ci	dlen = req->dlen;
1408c2ecf20Sopenharmony_ci
1418c2ecf20Sopenharmony_ci	scratch = raw_cpu_ptr(&scomp_scratch);
1428c2ecf20Sopenharmony_ci	spin_lock(&scratch->lock);
1438c2ecf20Sopenharmony_ci
1448c2ecf20Sopenharmony_ci	scatterwalk_map_and_copy(scratch->src, req->src, 0, req->slen, 0);
1458c2ecf20Sopenharmony_ci	if (dir)
1468c2ecf20Sopenharmony_ci		ret = crypto_scomp_compress(scomp, scratch->src, req->slen,
1478c2ecf20Sopenharmony_ci					    scratch->dst, &req->dlen, *ctx);
1488c2ecf20Sopenharmony_ci	else
1498c2ecf20Sopenharmony_ci		ret = crypto_scomp_decompress(scomp, scratch->src, req->slen,
1508c2ecf20Sopenharmony_ci					      scratch->dst, &req->dlen, *ctx);
1518c2ecf20Sopenharmony_ci	if (!ret) {
1528c2ecf20Sopenharmony_ci		if (!req->dst) {
1538c2ecf20Sopenharmony_ci			req->dst = sgl_alloc(req->dlen, GFP_ATOMIC, NULL);
1548c2ecf20Sopenharmony_ci			if (!req->dst) {
1558c2ecf20Sopenharmony_ci				ret = -ENOMEM;
1568c2ecf20Sopenharmony_ci				goto out;
1578c2ecf20Sopenharmony_ci			}
1588c2ecf20Sopenharmony_ci		} else if (req->dlen > dlen) {
1598c2ecf20Sopenharmony_ci			ret = -ENOSPC;
1608c2ecf20Sopenharmony_ci			goto out;
1618c2ecf20Sopenharmony_ci		}
1628c2ecf20Sopenharmony_ci		scatterwalk_map_and_copy(scratch->dst, req->dst, 0, req->dlen,
1638c2ecf20Sopenharmony_ci					 1);
1648c2ecf20Sopenharmony_ci	}
1658c2ecf20Sopenharmony_ciout:
1668c2ecf20Sopenharmony_ci	spin_unlock(&scratch->lock);
1678c2ecf20Sopenharmony_ci	return ret;
1688c2ecf20Sopenharmony_ci}
1698c2ecf20Sopenharmony_ci
1708c2ecf20Sopenharmony_cistatic int scomp_acomp_compress(struct acomp_req *req)
1718c2ecf20Sopenharmony_ci{
1728c2ecf20Sopenharmony_ci	return scomp_acomp_comp_decomp(req, 1);
1738c2ecf20Sopenharmony_ci}
1748c2ecf20Sopenharmony_ci
1758c2ecf20Sopenharmony_cistatic int scomp_acomp_decompress(struct acomp_req *req)
1768c2ecf20Sopenharmony_ci{
1778c2ecf20Sopenharmony_ci	return scomp_acomp_comp_decomp(req, 0);
1788c2ecf20Sopenharmony_ci}
1798c2ecf20Sopenharmony_ci
1808c2ecf20Sopenharmony_cistatic void crypto_exit_scomp_ops_async(struct crypto_tfm *tfm)
1818c2ecf20Sopenharmony_ci{
1828c2ecf20Sopenharmony_ci	struct crypto_scomp **ctx = crypto_tfm_ctx(tfm);
1838c2ecf20Sopenharmony_ci
1848c2ecf20Sopenharmony_ci	crypto_free_scomp(*ctx);
1858c2ecf20Sopenharmony_ci
1868c2ecf20Sopenharmony_ci	mutex_lock(&scomp_lock);
1878c2ecf20Sopenharmony_ci	if (!--scomp_scratch_users)
1888c2ecf20Sopenharmony_ci		crypto_scomp_free_scratches();
1898c2ecf20Sopenharmony_ci	mutex_unlock(&scomp_lock);
1908c2ecf20Sopenharmony_ci}
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_ciint crypto_init_scomp_ops_async(struct crypto_tfm *tfm)
1938c2ecf20Sopenharmony_ci{
1948c2ecf20Sopenharmony_ci	struct crypto_alg *calg = tfm->__crt_alg;
1958c2ecf20Sopenharmony_ci	struct crypto_acomp *crt = __crypto_acomp_tfm(tfm);
1968c2ecf20Sopenharmony_ci	struct crypto_scomp **ctx = crypto_tfm_ctx(tfm);
1978c2ecf20Sopenharmony_ci	struct crypto_scomp *scomp;
1988c2ecf20Sopenharmony_ci
1998c2ecf20Sopenharmony_ci	if (!crypto_mod_get(calg))
2008c2ecf20Sopenharmony_ci		return -EAGAIN;
2018c2ecf20Sopenharmony_ci
2028c2ecf20Sopenharmony_ci	scomp = crypto_create_tfm(calg, &crypto_scomp_type);
2038c2ecf20Sopenharmony_ci	if (IS_ERR(scomp)) {
2048c2ecf20Sopenharmony_ci		crypto_mod_put(calg);
2058c2ecf20Sopenharmony_ci		return PTR_ERR(scomp);
2068c2ecf20Sopenharmony_ci	}
2078c2ecf20Sopenharmony_ci
2088c2ecf20Sopenharmony_ci	*ctx = scomp;
2098c2ecf20Sopenharmony_ci	tfm->exit = crypto_exit_scomp_ops_async;
2108c2ecf20Sopenharmony_ci
2118c2ecf20Sopenharmony_ci	crt->compress = scomp_acomp_compress;
2128c2ecf20Sopenharmony_ci	crt->decompress = scomp_acomp_decompress;
2138c2ecf20Sopenharmony_ci	crt->dst_free = sgl_free;
2148c2ecf20Sopenharmony_ci	crt->reqsize = sizeof(void *);
2158c2ecf20Sopenharmony_ci
2168c2ecf20Sopenharmony_ci	return 0;
2178c2ecf20Sopenharmony_ci}
2188c2ecf20Sopenharmony_ci
2198c2ecf20Sopenharmony_cistruct acomp_req *crypto_acomp_scomp_alloc_ctx(struct acomp_req *req)
2208c2ecf20Sopenharmony_ci{
2218c2ecf20Sopenharmony_ci	struct crypto_acomp *acomp = crypto_acomp_reqtfm(req);
2228c2ecf20Sopenharmony_ci	struct crypto_tfm *tfm = crypto_acomp_tfm(acomp);
2238c2ecf20Sopenharmony_ci	struct crypto_scomp **tfm_ctx = crypto_tfm_ctx(tfm);
2248c2ecf20Sopenharmony_ci	struct crypto_scomp *scomp = *tfm_ctx;
2258c2ecf20Sopenharmony_ci	void *ctx;
2268c2ecf20Sopenharmony_ci
2278c2ecf20Sopenharmony_ci	ctx = crypto_scomp_alloc_ctx(scomp);
2288c2ecf20Sopenharmony_ci	if (IS_ERR(ctx)) {
2298c2ecf20Sopenharmony_ci		kfree(req);
2308c2ecf20Sopenharmony_ci		return NULL;
2318c2ecf20Sopenharmony_ci	}
2328c2ecf20Sopenharmony_ci
2338c2ecf20Sopenharmony_ci	*req->__ctx = ctx;
2348c2ecf20Sopenharmony_ci
2358c2ecf20Sopenharmony_ci	return req;
2368c2ecf20Sopenharmony_ci}
2378c2ecf20Sopenharmony_ci
2388c2ecf20Sopenharmony_civoid crypto_acomp_scomp_free_ctx(struct acomp_req *req)
2398c2ecf20Sopenharmony_ci{
2408c2ecf20Sopenharmony_ci	struct crypto_acomp *acomp = crypto_acomp_reqtfm(req);
2418c2ecf20Sopenharmony_ci	struct crypto_tfm *tfm = crypto_acomp_tfm(acomp);
2428c2ecf20Sopenharmony_ci	struct crypto_scomp **tfm_ctx = crypto_tfm_ctx(tfm);
2438c2ecf20Sopenharmony_ci	struct crypto_scomp *scomp = *tfm_ctx;
2448c2ecf20Sopenharmony_ci	void *ctx = *req->__ctx;
2458c2ecf20Sopenharmony_ci
2468c2ecf20Sopenharmony_ci	if (ctx)
2478c2ecf20Sopenharmony_ci		crypto_scomp_free_ctx(scomp, ctx);
2488c2ecf20Sopenharmony_ci}
2498c2ecf20Sopenharmony_ci
2508c2ecf20Sopenharmony_cistatic const struct crypto_type crypto_scomp_type = {
2518c2ecf20Sopenharmony_ci	.extsize = crypto_alg_extsize,
2528c2ecf20Sopenharmony_ci	.init_tfm = crypto_scomp_init_tfm,
2538c2ecf20Sopenharmony_ci#ifdef CONFIG_PROC_FS
2548c2ecf20Sopenharmony_ci	.show = crypto_scomp_show,
2558c2ecf20Sopenharmony_ci#endif
2568c2ecf20Sopenharmony_ci	.report = crypto_scomp_report,
2578c2ecf20Sopenharmony_ci	.maskclear = ~CRYPTO_ALG_TYPE_MASK,
2588c2ecf20Sopenharmony_ci	.maskset = CRYPTO_ALG_TYPE_MASK,
2598c2ecf20Sopenharmony_ci	.type = CRYPTO_ALG_TYPE_SCOMPRESS,
2608c2ecf20Sopenharmony_ci	.tfmsize = offsetof(struct crypto_scomp, base),
2618c2ecf20Sopenharmony_ci};
2628c2ecf20Sopenharmony_ci
2638c2ecf20Sopenharmony_ciint crypto_register_scomp(struct scomp_alg *alg)
2648c2ecf20Sopenharmony_ci{
2658c2ecf20Sopenharmony_ci	struct crypto_alg *base = &alg->base;
2668c2ecf20Sopenharmony_ci
2678c2ecf20Sopenharmony_ci	base->cra_type = &crypto_scomp_type;
2688c2ecf20Sopenharmony_ci	base->cra_flags &= ~CRYPTO_ALG_TYPE_MASK;
2698c2ecf20Sopenharmony_ci	base->cra_flags |= CRYPTO_ALG_TYPE_SCOMPRESS;
2708c2ecf20Sopenharmony_ci
2718c2ecf20Sopenharmony_ci	return crypto_register_alg(base);
2728c2ecf20Sopenharmony_ci}
2738c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(crypto_register_scomp);
2748c2ecf20Sopenharmony_ci
2758c2ecf20Sopenharmony_civoid crypto_unregister_scomp(struct scomp_alg *alg)
2768c2ecf20Sopenharmony_ci{
2778c2ecf20Sopenharmony_ci	crypto_unregister_alg(&alg->base);
2788c2ecf20Sopenharmony_ci}
2798c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(crypto_unregister_scomp);
2808c2ecf20Sopenharmony_ci
2818c2ecf20Sopenharmony_ciint crypto_register_scomps(struct scomp_alg *algs, int count)
2828c2ecf20Sopenharmony_ci{
2838c2ecf20Sopenharmony_ci	int i, ret;
2848c2ecf20Sopenharmony_ci
2858c2ecf20Sopenharmony_ci	for (i = 0; i < count; i++) {
2868c2ecf20Sopenharmony_ci		ret = crypto_register_scomp(&algs[i]);
2878c2ecf20Sopenharmony_ci		if (ret)
2888c2ecf20Sopenharmony_ci			goto err;
2898c2ecf20Sopenharmony_ci	}
2908c2ecf20Sopenharmony_ci
2918c2ecf20Sopenharmony_ci	return 0;
2928c2ecf20Sopenharmony_ci
2938c2ecf20Sopenharmony_cierr:
2948c2ecf20Sopenharmony_ci	for (--i; i >= 0; --i)
2958c2ecf20Sopenharmony_ci		crypto_unregister_scomp(&algs[i]);
2968c2ecf20Sopenharmony_ci
2978c2ecf20Sopenharmony_ci	return ret;
2988c2ecf20Sopenharmony_ci}
2998c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(crypto_register_scomps);
3008c2ecf20Sopenharmony_ci
3018c2ecf20Sopenharmony_civoid crypto_unregister_scomps(struct scomp_alg *algs, int count)
3028c2ecf20Sopenharmony_ci{
3038c2ecf20Sopenharmony_ci	int i;
3048c2ecf20Sopenharmony_ci
3058c2ecf20Sopenharmony_ci	for (i = count - 1; i >= 0; --i)
3068c2ecf20Sopenharmony_ci		crypto_unregister_scomp(&algs[i]);
3078c2ecf20Sopenharmony_ci}
3088c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(crypto_unregister_scomps);
3098c2ecf20Sopenharmony_ci
3108c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
3118c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Synchronous compression type");
312