// SPDX-License-Identifier: BSD-2-Clause
/*
 * Copyright (c) 2019 Huawei Technologies Co., Ltd
 */

#include <assert.h>
#include <crypto/crypto.h>
#include <crypto/crypto_impl.h>
#include <stdlib.h>
#include <string.h>
#include <string_ext.h>
#include <tee_api_types.h>
#include <util.h>

#include "sm4.h"

struct sm4_ctr_ctx {
	struct crypto_cipher_ctx ctx;
	struct sm4_context state;
	uint8_t ctr[16];
};

static const struct crypto_cipher_ops sm4_ctr_ops;

static struct sm4_ctr_ctx *to_sm4_ctr_ctx(struct crypto_cipher_ctx *ctx)
{
	assert(ctx && ctx->ops == &sm4_ctr_ops);

	return container_of(ctx, struct sm4_ctr_ctx, ctx);
}

static TEE_Result sm4_ctr_init(struct crypto_cipher_ctx *ctx,
			       TEE_OperationMode mode __unused,
			       const uint8_t *key1, size_t key1_len,
			       const uint8_t *key2 __unused,
			       size_t key2_len __unused,
			       const uint8_t *iv, size_t iv_len)
{
	struct sm4_ctr_ctx *c = to_sm4_ctr_ctx(ctx);

	if (key1_len != 16 || iv_len != sizeof(c->ctr))
		return TEE_ERROR_BAD_PARAMETERS;

	sm4_setkey_enc(&c->state, key1);
	memcpy(c->ctr, iv, sizeof(c->ctr));

	return TEE_SUCCESS;
}

static TEE_Result sm4_ctr_update(struct crypto_cipher_ctx *ctx,
				 bool last_block __unused,
				 const uint8_t *data, size_t len, uint8_t *dst)
{
	struct sm4_ctr_ctx *c = to_sm4_ctr_ctx(ctx);

	sm4_crypt_ctr(&c->state, len, c->ctr, data, dst);

	return TEE_SUCCESS;
}

static void sm4_ctr_final(struct crypto_cipher_ctx *ctx)
{
	struct sm4_ctr_ctx *c = to_sm4_ctr_ctx(ctx);

	memzero_explicit(&c->state, sizeof(c->state));
	memzero_explicit(&c->ctr, sizeof(c->ctr));
}

static void sm4_ctr_free_ctx(struct crypto_cipher_ctx *ctx)
{
	free(to_sm4_ctr_ctx(ctx));
}

static void sm4_ctr_copy_state(struct crypto_cipher_ctx *dst_ctx,
			       struct crypto_cipher_ctx *src_ctx)
{
	struct sm4_ctr_ctx *src = to_sm4_ctr_ctx(src_ctx);
	struct sm4_ctr_ctx *dst = to_sm4_ctr_ctx(dst_ctx);

	dst->state = src->state;
	memcpy(dst->ctr, src->ctr, sizeof(src->ctr));
}

static const struct crypto_cipher_ops sm4_ctr_ops = {
	.init = sm4_ctr_init,
	.update = sm4_ctr_update,
	.final = sm4_ctr_final,
	.free_ctx = sm4_ctr_free_ctx,
	.copy_state = sm4_ctr_copy_state,
};

TEE_Result crypto_sm4_ctr_alloc_ctx(struct crypto_cipher_ctx **ctx_ret)
{
	struct sm4_ctr_ctx *c = NULL;

	c = calloc(1, sizeof(*c));
	if (!c)
		return TEE_ERROR_OUT_OF_MEMORY;

	c->ctx.ops = &sm4_ctr_ops;
	*ctx_ret = &c->ctx;

	return TEE_SUCCESS;
}