/* SPDX-License-Identifier: GPL-2.0-or-later */

#include <asm/cpufeature.h>

extern const struct raid6_calls raid6_mmxx1;
extern const struct raid6_calls raid6_mmxx2;
extern const struct raid6_calls raid6_sse1x1;
extern const struct raid6_calls raid6_sse1x2;
extern const struct raid6_calls raid6_sse2x1;
extern const struct raid6_calls raid6_sse2x2;
extern const struct raid6_calls raid6_sse2x4;
extern const struct raid6_calls raid6_avx2x1;
extern const struct raid6_calls raid6_avx2x2;
extern const struct raid6_calls raid6_avx2x4;
extern const struct raid6_calls raid6_avx512x1;
extern const struct raid6_calls raid6_avx512x2;
extern const struct raid6_calls raid6_avx512x4;

extern const struct raid6_recov_calls raid6_recov_ssse3;
extern const struct raid6_recov_calls raid6_recov_avx2;
extern const struct raid6_recov_calls raid6_recov_avx512;

static inline int raid6_has_avx512(void)
{
	return boot_cpu_has(X86_FEATURE_AVX2) &&
		boot_cpu_has(X86_FEATURE_AVX) &&
		boot_cpu_has(X86_FEATURE_AVX512F) &&
		boot_cpu_has(X86_FEATURE_AVX512BW) &&
		boot_cpu_has(X86_FEATURE_AVX512VL) &&
		boot_cpu_has(X86_FEATURE_AVX512DQ);
}

static inline bool raid6_has_avx2(void)
{
	return boot_cpu_has(X86_FEATURE_AVX2) && boot_cpu_has(X86_FEATURE_AVX);
}

static inline bool raid6_has_ssse3(void)
{
	return boot_cpu_has(X86_FEATURE_XMM) &&
		boot_cpu_has(X86_FEATURE_XMM2) &&
		boot_cpu_has(X86_FEATURE_SSSE3);
}

static inline bool raid6_has_sse2(void)
{
	return boot_cpu_has(X86_FEATURE_MMX) &&
		    boot_cpu_has(X86_FEATURE_FXSR) &&
		    boot_cpu_has(X86_FEATURE_XMM) &&
		    boot_cpu_has(X86_FEATURE_XMM2);
}

static inline bool raid6_has_sse1_or_mmxext(void)
{
	return boot_cpu_has(X86_FEATURE_MMX) &&
		(boot_cpu_has(X86_FEATURE_XMM) ||
		 boot_cpu_has(X86_FEATURE_MMXEXT));
}

static __always_inline void __init arch_raid6_init(void)
{
	if (raid6_has_avx2()) {
		raid6_algo_add(&raid6_avx2x1);
		raid6_algo_add(&raid6_avx2x2);
		if (IS_ENABLED(CONFIG_X86_64))
			raid6_algo_add(&raid6_avx2x4);
		if (raid6_has_avx512()) {
			raid6_algo_add(&raid6_avx512x1);
			raid6_algo_add(&raid6_avx512x2);
			if (IS_ENABLED(CONFIG_X86_64))
				raid6_algo_add(&raid6_avx512x4);
		}
	} else if (IS_ENABLED(CONFIG_X86_64) || raid6_has_sse2()) {
		/* x86_64 can assume SSE2 as baseline */
		raid6_algo_add(&raid6_sse2x1);
		raid6_algo_add(&raid6_sse2x2);
		if (IS_ENABLED(CONFIG_X86_64))
			raid6_algo_add(&raid6_sse2x4);
	} else {
		raid6_algo_add_default();
		if (raid6_has_sse1_or_mmxext()) {
			raid6_algo_add(&raid6_sse1x1);
			raid6_algo_add(&raid6_sse1x2);
		} else if (boot_cpu_has(X86_FEATURE_MMX)) {
			raid6_algo_add(&raid6_mmxx1);
			raid6_algo_add(&raid6_mmxx2);
		}
	}

	if (raid6_has_avx512())
		raid6_recov_algo_add(&raid6_recov_avx512);
	else if (raid6_has_avx2())
		raid6_recov_algo_add(&raid6_recov_avx2);
	else if (raid6_has_ssse3())
		raid6_recov_algo_add(&raid6_recov_ssse3);
}