/* SPDX-License-Identifier: GPL-2.0-or-later */
/*
 * AES optimized using the CP Assist for Cryptographic Functions (CPACF)
 *
 * Copyright 2026 Google LLC
 */
#include <asm/cpacf.h>
#include <linux/cpufeature.h>

static __ro_after_init DEFINE_STATIC_KEY_FALSE(have_cpacf_aes128);
static __ro_after_init DEFINE_STATIC_KEY_FALSE(have_cpacf_aes192);
static __ro_after_init DEFINE_STATIC_KEY_FALSE(have_cpacf_aes256);

/*
 * When the CPU supports CPACF AES for the requested key length, we need only
 * save a copy of the raw AES key, as that's what the CPACF instructions need.
 *
 * When unsupported, fall back to the generic key expansion and en/decryption.
 */
static void aes_preparekey_arch(union aes_enckey_arch *k,
				union aes_invkey_arch *inv_k,
				const u8 *in_key, int key_len, int nrounds)
{
	if (key_len == AES_KEYSIZE_128) {
		if (static_branch_likely(&have_cpacf_aes128)) {
			memcpy(k->raw_key, in_key, AES_KEYSIZE_128);
			return;
		}
	} else if (key_len == AES_KEYSIZE_192) {
		if (static_branch_likely(&have_cpacf_aes192)) {
			memcpy(k->raw_key, in_key, AES_KEYSIZE_192);
			return;
		}
	} else {
		if (static_branch_likely(&have_cpacf_aes256)) {
			memcpy(k->raw_key, in_key, AES_KEYSIZE_256);
			return;
		}
	}
	aes_expandkey_generic(k->rndkeys, inv_k ? inv_k->inv_rndkeys : NULL,
			      in_key, key_len);
}

static inline bool aes_crypt_s390(const struct aes_enckey *key,
				  u8 out[AES_BLOCK_SIZE],
				  const u8 in[AES_BLOCK_SIZE], int decrypt)
{
	if (key->len == AES_KEYSIZE_128) {
		if (static_branch_likely(&have_cpacf_aes128)) {
			cpacf_km(CPACF_KM_AES_128 | decrypt,
				 (void *)key->k.raw_key, out, in,
				 AES_BLOCK_SIZE);
			return true;
		}
	} else if (key->len == AES_KEYSIZE_192) {
		if (static_branch_likely(&have_cpacf_aes192)) {
			cpacf_km(CPACF_KM_AES_192 | decrypt,
				 (void *)key->k.raw_key, out, in,
				 AES_BLOCK_SIZE);
			return true;
		}
	} else {
		if (static_branch_likely(&have_cpacf_aes256)) {
			cpacf_km(CPACF_KM_AES_256 | decrypt,
				 (void *)key->k.raw_key, out, in,
				 AES_BLOCK_SIZE);
			return true;
		}
	}
	return false;
}

static void aes_encrypt_arch(const struct aes_enckey *key,
			     u8 out[AES_BLOCK_SIZE],
			     const u8 in[AES_BLOCK_SIZE])
{
	if (likely(aes_crypt_s390(key, out, in, 0)))
		return;
	aes_encrypt_generic(key->k.rndkeys, key->nrounds, out, in);
}

static void aes_decrypt_arch(const struct aes_key *key,
			     u8 out[AES_BLOCK_SIZE],
			     const u8 in[AES_BLOCK_SIZE])
{
	if (likely(aes_crypt_s390((const struct aes_enckey *)key, out, in,
				  CPACF_DECRYPT)))
		return;
	aes_decrypt_generic(key->inv_k.inv_rndkeys, key->nrounds, out, in);
}

#define aes_mod_init_arch aes_mod_init_arch
static void aes_mod_init_arch(void)
{
	if (cpu_have_feature(S390_CPU_FEATURE_MSA)) {
		cpacf_mask_t km_functions;

		cpacf_query(CPACF_KM, &km_functions);
		if (cpacf_test_func(&km_functions, CPACF_KM_AES_128))
			static_branch_enable(&have_cpacf_aes128);
		if (cpacf_test_func(&km_functions, CPACF_KM_AES_192))
			static_branch_enable(&have_cpacf_aes192);
		if (cpacf_test_func(&km_functions, CPACF_KM_AES_256))
			static_branch_enable(&have_cpacf_aes256);
	}
}