git: ad2fac552c3f - main - lib/libc/amd64: add archlevel-based simd dispatch framework

From: Robert Clausecker <fuz_at_FreeBSD.org>
Date: Thu, 03 Aug 2023 22:55:49 UTC
The branch main has been updated by fuz:

URL: https://cgit.FreeBSD.org/src/commit/?id=ad2fac552c3fcb577feb3055fa083f2d256c06ed

commit ad2fac552c3fcb577feb3055fa083f2d256c06ed
Author:     Robert Clausecker <fuz@FreeBSD.org>
AuthorDate: 2023-08-03 22:47:31 +0000
Commit:     Robert Clausecker <fuz@FreeBSD.org>
CommitDate: 2023-08-03 22:53:43 +0000

    lib/libc/amd64: add archlevel-based simd dispatch framework
    
    Add a framework for selecting from one of multiple implementations
    of a function based on amd64 architecture level (cf. amd64 SysV
    ABI supplement).
    
    Sponsored by:   The FreeBSD Foundation
    Approved by:    kib
    Reviewed by:    jrtc27
    Differential Revision:  https://reviews.freebsd.org/D40693
---
 lib/libc/amd64/amd64_archlevel.h        |  90 ++++++++++++
 lib/libc/amd64/string/Makefile.inc      |   1 +
 lib/libc/amd64/string/amd64_archlevel.c | 241 ++++++++++++++++++++++++++++++++
 3 files changed, 332 insertions(+)

diff --git a/lib/libc/amd64/amd64_archlevel.h b/lib/libc/amd64/amd64_archlevel.h
new file mode 100644
index 000000000000..047beb9855d1
--- /dev/null
+++ b/lib/libc/amd64/amd64_archlevel.h
@@ -0,0 +1,90 @@
+/*-
+ * Copyright (c) 2023 The FreeBSD Foundation
+ *
+ * This software was developed by Robert Clausecker <fuz@FreeBSD.org>
+ * under sponsorship from the FreeBSD Foundation.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ''AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE
+ */
+
+/* must be macros so they can be accessed from assembly */
+#define X86_64_SCALAR    0 /* disable SIMD optimisations */
+#define	X86_64_BASELINE  1 /* CMOV, CX8, FPU, FXSR, MMX, OSFXSR, SSE, SSE2 */
+#define	X86_64_V2        2 /* CMPXCHG16B, LAHF-SAHF, POPCNT, SSE3, SSSE3, SSE4_1, SSE4_2 */
+#define	X86_64_V3        3 /* AVX, AVX2, BMI1, BMI2, F16C, FMA, LZCNT, MOVBE, OSXSAVE */
+#define	X86_64_V4        4 /* AVX512F, AVX512BW, AVX512CD, AVX512DQ, AVX512VL */
+
+#define	X86_64_MAX       X86_64_V4 /* highest supported architecture level */
+#define	X86_64_UNDEFINED -1 /* architecture level not set yet */
+
+#ifndef __ASSEMBLER__
+#include <dlfcn.h>
+
+dlfunc_t	__archlevel_resolve(u_int, u_int, u_int, u_int,
+		    int32_t[X86_64_MAX + 1]) __hidden;
+#else
+#include <machine/asm.h>
+
+#define ARCHRESOLVE(func) \
+	.globl CNAME(func); \
+	.type CNAME(func), @gnu_indirect_function; \
+	.set CNAME(func), __CONCAT(func,_resolver); \
+	ARCHENTRY(func, resolver); \
+	lea __CONCAT(func,_funcs)(%rip), %r8; \
+	jmp CNAME(__archlevel_resolve); \
+	ARCHEND(func, resolver)
+
+/*
+ * The func_funcs array stores the location of the implementations
+ * as the distance from the func_funcs array to the function.  Due
+ * to compiling for the medium code model, a 32 bit integer suffices
+ * to hold the distance.
+ *
+ * Doing it this way both saves storage and avoids giving rtld
+ * relocations to process at load time.
+ */
+#define ARCHFUNCS(func) \
+	ARCHRESOLVE(func); \
+	.section .rodata; \
+	.align 4; \
+	__CONCAT(func,_funcs):
+
+#define NOARCHFUNC \
+	.4byte 0
+
+#define ARCHFUNC(func, level) \
+	.4byte __CONCAT(__CONCAT(func,_),level) - __CONCAT(func,_funcs)
+
+#define ENDARCHFUNCS(func) \
+	.zero 4*(X86_64_MAX+1)-(.-__CONCAT(func,_funcs)); \
+	.size __CONCAT(func,_funcs), .-__CONCAT(func,_funcs)
+
+#define ARCHENTRY(func, level) \
+	_START_ENTRY; \
+	.type __CONCAT(__CONCAT(func,_),level), @function; \
+	__CONCAT(__CONCAT(func,_),level):; \
+	.cfi_startproc
+
+#define ARCHEND(func, level) \
+	END(__CONCAT(__CONCAT(func,_),level))
+
+#endif  /* __ASSEMBLER__ */
diff --git a/lib/libc/amd64/string/Makefile.inc b/lib/libc/amd64/string/Makefile.inc
index cb370bc6be1c..1bfefa7be98c 100644
--- a/lib/libc/amd64/string/Makefile.inc
+++ b/lib/libc/amd64/string/Makefile.inc
@@ -1,6 +1,7 @@
 # $FreeBSD$
 
 MDSRCS+= \
+	amd64_archlevel.c \
 	bcmp.S \
 	memcmp.S \
 	memcpy.S \
diff --git a/lib/libc/amd64/string/amd64_archlevel.c b/lib/libc/amd64/string/amd64_archlevel.c
new file mode 100644
index 000000000000..c06566658c59
--- /dev/null
+++ b/lib/libc/amd64/string/amd64_archlevel.c
@@ -0,0 +1,241 @@
+/*-
+ * Copyright (c) 2023 The FreeBSD Foundation
+ *
+ * This software was developed by Robert Clausecker <fuz@FreeBSD.org>
+ * under sponsorship from the FreeBSD Foundation.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ''AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE
+ */
+
+#include <sys/types.h>
+
+#include <machine/atomic.h>
+#include <machine/cpufunc.h>
+#include <machine/specialreg.h>
+
+#include <stddef.h>
+#include <string.h>
+
+#include "amd64_archlevel.h"
+#include "libc_private.h"
+
+#define ARCHLEVEL_ENV	"ARCHLEVEL"
+
+static volatile int amd64_archlevel = X86_64_UNDEFINED;
+
+static const struct archlevel {
+	char name[10];
+	/* CPUID feature bits that need to be present */
+	u_int feat_edx, feat_ecx, amd_ecx, ext_ebx;
+} levels[] = {
+	{
+		.name = "scalar",
+		.feat_edx = 0,
+		.feat_ecx = 0,
+		.amd_ecx = 0,
+		.ext_ebx = 0,
+	}, {
+#define FEAT_EDX_BASELINE (CPUID_FPU | CPUID_CX8 | CPUID_CMOV | CPUID_MMX | \
+	CPUID_FXSR | CPUID_SSE | CPUID_SSE2)
+		.name = "baseline",
+		.feat_edx = FEAT_EDX_BASELINE,
+		.feat_ecx = 0,
+		.amd_ecx = 0,
+		.ext_ebx = 0,
+	}, {
+#define FEAT_ECX_V2 (CPUID2_SSE3 | CPUID2_SSSE3 | CPUID2_CX16 | CPUID2_SSE41 | \
+	CPUID2_SSE42 | CPUID2_POPCNT)
+#define AMD_ECX_V2 AMDID2_LAHF
+		.name = "x86-64-v2",
+		.feat_edx = FEAT_EDX_BASELINE,
+		.feat_ecx = FEAT_ECX_V2,
+		.amd_ecx = AMD_ECX_V2,
+		.ext_ebx = 0,
+	}, {
+#define FEAT_ECX_V3 (FEAT_ECX_V2 | CPUID2_FMA | CPUID2_MOVBE | \
+	CPUID2_OSXSAVE | CPUID2_AVX | CPUID2_F16C)
+#define AMD_ECX_V3 (AMD_ECX_V2 | AMDID2_ABM)
+#define EXT_EBX_V3 (CPUID_STDEXT_BMI1 | CPUID_STDEXT_AVX2 | CPUID_STDEXT_BMI2)
+		.name = "x86-64-v3",
+		.feat_edx = FEAT_EDX_BASELINE,
+		.feat_ecx = FEAT_ECX_V3,
+		.amd_ecx = AMD_ECX_V3,
+		.ext_ebx = EXT_EBX_V3,
+	}, {
+#define EXT_EBX_V4 (EXT_EBX_V3 | CPUID_STDEXT_AVX512F | \
+	CPUID_STDEXT_AVX512DQ | CPUID_STDEXT_AVX512CD | \
+	CPUID_STDEXT_AVX512BW | CPUID_STDEXT_AVX512VL)
+		.name = "x86-64-v4",
+		.feat_edx = FEAT_EDX_BASELINE,
+		.feat_ecx = FEAT_ECX_V3,
+		.amd_ecx = AMD_ECX_V3,
+		.ext_ebx = EXT_EBX_V4,
+	}
+};
+
+static int
+supported_archlevel(u_int feat_edx, u_int feat_ecx, u_int ext_ebx, u_int ext_ecx)
+{
+	int level;
+	u_int p[4], max_leaf;
+	u_int amd_ecx = 0;
+
+	(void)ext_ecx;
+
+	do_cpuid(0x80000000, p);
+	max_leaf = p[0];
+
+	if (max_leaf >= 0x80000001) {
+		do_cpuid(0x80000001, p);
+		amd_ecx = p[2];
+	}
+
+	for (level = X86_64_BASELINE; level <= X86_64_MAX; level++) {
+		const struct archlevel *lvl = &levels[level];
+
+		if ((lvl->feat_edx & feat_edx) != lvl->feat_edx ||
+		    (lvl->feat_ecx & feat_ecx) != lvl->feat_ecx ||
+		    (lvl->amd_ecx & amd_ecx) != lvl->amd_ecx ||
+		    (lvl->ext_ebx & ext_ebx) != lvl->ext_ebx)
+			return (level - 1);
+	}
+
+	return (X86_64_MAX);
+}
+
+static int
+match_archlevel(const char *str, int *force)
+{
+	int level, want_force = 0;
+
+	*force = 0;
+
+	if (str[0] == '!') {
+		str++;
+		want_force = 1;
+	}
+
+	for (level = 0; level <= X86_64_MAX; level++) {
+		size_t i;
+		const char *candidate = levels[level].name;
+
+		/* can't use strcmp here: would recurse during ifunc resolution */
+		for (i = 0; str[i] == candidate[i]; i++)
+			/* suffixes starting with : or + are ignored for future extensions */
+			if (str[i] == '\0' || str[i] == ':' || str[i] == '+') {
+				if (want_force)
+					*force = 1;
+
+				return (level);
+			}
+	}
+
+	return (X86_64_UNDEFINED);
+}
+
+/*
+ * We can't use getenv(), strcmp(), and a bunch of other functions here as
+ * they may in turn call SIMD-optimised string functions.
+ *
+ * *force is set to 1 if the architecture level is valid and begins with a !
+ * and to 0 otherwise.
+ */
+static int
+env_archlevel(int *force)
+{
+	size_t i;
+
+	if (environ == NULL)
+		return (X86_64_UNDEFINED);
+
+	for (i = 0; environ[i] != NULL; i++) {
+		size_t j;
+
+		for (j = 0; environ[i][j] == ARCHLEVEL_ENV "="[j]; j++)
+			if (environ[i][j] == '=')
+				return (match_archlevel(&environ[i][j + 1], force));
+	}
+
+	*force = 0;
+
+	return (X86_64_UNDEFINED);
+
+}
+
+/*
+ * Determine the architecture level by checking the CPU capabilities
+ * and the environment:
+ *
+ * 1. If environment variable ARCHLEVEL starts with a ! and is followed
+ *    by a valid architecture level, that level is returned.
+ * 2. Else if ARCHLEVEL is set to a valid architecture level that is
+ *    supported by the CPU, that level is returned.
+ * 3. Else the highest architecture level supported by the CPU is
+ *    returned.
+ *
+ * Valid architecture levels are those defined in the levels array.
+ * The architecture level "scalar" indicates that SIMD enhancements
+ * shall not be used.
+ */
+static int
+archlevel(u_int feat_edx, u_int feat_ecx, u_int ext_ebx, u_int ext_ecx)
+{
+	int islevel, wantlevel, hwlevel, force;
+
+	islevel = atomic_load_int(&amd64_archlevel);
+	if (islevel != X86_64_UNDEFINED)
+		return (islevel);
+
+	wantlevel = env_archlevel(&force);
+	if (!force) {
+		hwlevel = supported_archlevel(feat_edx, feat_ecx, ext_ebx, ext_ecx);
+		if (wantlevel == X86_64_UNDEFINED || wantlevel > hwlevel)
+			wantlevel = hwlevel;
+	}
+
+	/*
+	 * Ensure amd64_archlevel is set only once and
+	 * all calls agree on what it was set to.
+	 */
+	if (atomic_cmpset_int(&amd64_archlevel, islevel, wantlevel))
+		return (wantlevel);
+	else
+		return (atomic_load_int(&amd64_archlevel));
+}
+
+/*
+ * Helper function for SIMD ifunc dispatch: select the highest level
+ * implementation up to the current architecture level.
+ */
+dlfunc_t
+__archlevel_resolve(u_int feat_edx, u_int feat_ecx, u_int ext_ebx,
+    u_int ext_ecx, int32_t funcs[static X86_64_MAX + 1])
+{
+	int level;
+
+	for (level = archlevel(feat_edx, feat_ecx, ext_ebx, ext_ecx); level >= 0; level--)
+		if (funcs[level] != 0)
+			return (dlfunc_t)((uintptr_t)funcs + (ptrdiff_t)funcs[level]);
+
+	/* no function is present -- what now? */
+	__builtin_trap();
+}