18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci#include <linux/types.h>
38c2ecf20Sopenharmony_ci#include "bitops.h"
48c2ecf20Sopenharmony_ci
58c2ecf20Sopenharmony_ci#include <asm/processor-flags.h>
68c2ecf20Sopenharmony_ci#include <asm/required-features.h>
78c2ecf20Sopenharmony_ci#include <asm/msr-index.h>
88c2ecf20Sopenharmony_ci#include "cpuflags.h"
98c2ecf20Sopenharmony_ci
108c2ecf20Sopenharmony_cistruct cpu_features cpu;
118c2ecf20Sopenharmony_ciu32 cpu_vendor[3];
128c2ecf20Sopenharmony_ci
138c2ecf20Sopenharmony_cistatic bool loaded_flags;
148c2ecf20Sopenharmony_ci
158c2ecf20Sopenharmony_cistatic int has_fpu(void)
168c2ecf20Sopenharmony_ci{
178c2ecf20Sopenharmony_ci	u16 fcw = -1, fsw = -1;
188c2ecf20Sopenharmony_ci	unsigned long cr0;
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_ci	asm volatile("mov %%cr0,%0" : "=r" (cr0));
218c2ecf20Sopenharmony_ci	if (cr0 & (X86_CR0_EM|X86_CR0_TS)) {
228c2ecf20Sopenharmony_ci		cr0 &= ~(X86_CR0_EM|X86_CR0_TS);
238c2ecf20Sopenharmony_ci		asm volatile("mov %0,%%cr0" : : "r" (cr0));
248c2ecf20Sopenharmony_ci	}
258c2ecf20Sopenharmony_ci
268c2ecf20Sopenharmony_ci	asm volatile("fninit ; fnstsw %0 ; fnstcw %1"
278c2ecf20Sopenharmony_ci		     : "+m" (fsw), "+m" (fcw));
288c2ecf20Sopenharmony_ci
298c2ecf20Sopenharmony_ci	return fsw == 0 && (fcw & 0x103f) == 0x003f;
308c2ecf20Sopenharmony_ci}
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci/*
338c2ecf20Sopenharmony_ci * For building the 16-bit code we want to explicitly specify 32-bit
348c2ecf20Sopenharmony_ci * push/pop operations, rather than just saying 'pushf' or 'popf' and
358c2ecf20Sopenharmony_ci * letting the compiler choose. But this is also included from the
368c2ecf20Sopenharmony_ci * compressed/ directory where it may be 64-bit code, and thus needs
378c2ecf20Sopenharmony_ci * to be 'pushfq' or 'popfq' in that case.
388c2ecf20Sopenharmony_ci */
398c2ecf20Sopenharmony_ci#ifdef __x86_64__
408c2ecf20Sopenharmony_ci#define PUSHF "pushfq"
418c2ecf20Sopenharmony_ci#define POPF "popfq"
428c2ecf20Sopenharmony_ci#else
438c2ecf20Sopenharmony_ci#define PUSHF "pushfl"
448c2ecf20Sopenharmony_ci#define POPF "popfl"
458c2ecf20Sopenharmony_ci#endif
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_ciint has_eflag(unsigned long mask)
488c2ecf20Sopenharmony_ci{
498c2ecf20Sopenharmony_ci	unsigned long f0, f1;
508c2ecf20Sopenharmony_ci
518c2ecf20Sopenharmony_ci	asm volatile(PUSHF "	\n\t"
528c2ecf20Sopenharmony_ci		     PUSHF "	\n\t"
538c2ecf20Sopenharmony_ci		     "pop %0	\n\t"
548c2ecf20Sopenharmony_ci		     "mov %0,%1	\n\t"
558c2ecf20Sopenharmony_ci		     "xor %2,%1	\n\t"
568c2ecf20Sopenharmony_ci		     "push %1	\n\t"
578c2ecf20Sopenharmony_ci		     POPF "	\n\t"
588c2ecf20Sopenharmony_ci		     PUSHF "	\n\t"
598c2ecf20Sopenharmony_ci		     "pop %1	\n\t"
608c2ecf20Sopenharmony_ci		     POPF
618c2ecf20Sopenharmony_ci		     : "=&r" (f0), "=&r" (f1)
628c2ecf20Sopenharmony_ci		     : "ri" (mask));
638c2ecf20Sopenharmony_ci
648c2ecf20Sopenharmony_ci	return !!((f0^f1) & mask);
658c2ecf20Sopenharmony_ci}
668c2ecf20Sopenharmony_ci
678c2ecf20Sopenharmony_ci/* Handle x86_32 PIC using ebx. */
688c2ecf20Sopenharmony_ci#if defined(__i386__) && defined(__PIC__)
698c2ecf20Sopenharmony_ci# define EBX_REG "=r"
708c2ecf20Sopenharmony_ci#else
718c2ecf20Sopenharmony_ci# define EBX_REG "=b"
728c2ecf20Sopenharmony_ci#endif
738c2ecf20Sopenharmony_ci
748c2ecf20Sopenharmony_cistatic inline void cpuid_count(u32 id, u32 count,
758c2ecf20Sopenharmony_ci		u32 *a, u32 *b, u32 *c, u32 *d)
768c2ecf20Sopenharmony_ci{
778c2ecf20Sopenharmony_ci	asm volatile(".ifnc %%ebx,%3 ; movl  %%ebx,%3 ; .endif	\n\t"
788c2ecf20Sopenharmony_ci		     "cpuid					\n\t"
798c2ecf20Sopenharmony_ci		     ".ifnc %%ebx,%3 ; xchgl %%ebx,%3 ; .endif	\n\t"
808c2ecf20Sopenharmony_ci		    : "=a" (*a), "=c" (*c), "=d" (*d), EBX_REG (*b)
818c2ecf20Sopenharmony_ci		    : "a" (id), "c" (count)
828c2ecf20Sopenharmony_ci	);
838c2ecf20Sopenharmony_ci}
848c2ecf20Sopenharmony_ci
858c2ecf20Sopenharmony_ci#define cpuid(id, a, b, c, d) cpuid_count(id, 0, a, b, c, d)
868c2ecf20Sopenharmony_ci
878c2ecf20Sopenharmony_civoid get_cpuflags(void)
888c2ecf20Sopenharmony_ci{
898c2ecf20Sopenharmony_ci	u32 max_intel_level, max_amd_level;
908c2ecf20Sopenharmony_ci	u32 tfms;
918c2ecf20Sopenharmony_ci	u32 ignored;
928c2ecf20Sopenharmony_ci
938c2ecf20Sopenharmony_ci	if (loaded_flags)
948c2ecf20Sopenharmony_ci		return;
958c2ecf20Sopenharmony_ci	loaded_flags = true;
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_ci	if (has_fpu())
988c2ecf20Sopenharmony_ci		set_bit(X86_FEATURE_FPU, cpu.flags);
998c2ecf20Sopenharmony_ci
1008c2ecf20Sopenharmony_ci	if (has_eflag(X86_EFLAGS_ID)) {
1018c2ecf20Sopenharmony_ci		cpuid(0x0, &max_intel_level, &cpu_vendor[0], &cpu_vendor[2],
1028c2ecf20Sopenharmony_ci		      &cpu_vendor[1]);
1038c2ecf20Sopenharmony_ci
1048c2ecf20Sopenharmony_ci		if (max_intel_level >= 0x00000001 &&
1058c2ecf20Sopenharmony_ci		    max_intel_level <= 0x0000ffff) {
1068c2ecf20Sopenharmony_ci			cpuid(0x1, &tfms, &ignored, &cpu.flags[4],
1078c2ecf20Sopenharmony_ci			      &cpu.flags[0]);
1088c2ecf20Sopenharmony_ci			cpu.level = (tfms >> 8) & 15;
1098c2ecf20Sopenharmony_ci			cpu.family = cpu.level;
1108c2ecf20Sopenharmony_ci			cpu.model = (tfms >> 4) & 15;
1118c2ecf20Sopenharmony_ci			if (cpu.level >= 6)
1128c2ecf20Sopenharmony_ci				cpu.model += ((tfms >> 16) & 0xf) << 4;
1138c2ecf20Sopenharmony_ci		}
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci		if (max_intel_level >= 0x00000007) {
1168c2ecf20Sopenharmony_ci			cpuid_count(0x00000007, 0, &ignored, &ignored,
1178c2ecf20Sopenharmony_ci					&cpu.flags[16], &ignored);
1188c2ecf20Sopenharmony_ci		}
1198c2ecf20Sopenharmony_ci
1208c2ecf20Sopenharmony_ci		cpuid(0x80000000, &max_amd_level, &ignored, &ignored,
1218c2ecf20Sopenharmony_ci		      &ignored);
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ci		if (max_amd_level >= 0x80000001 &&
1248c2ecf20Sopenharmony_ci		    max_amd_level <= 0x8000ffff) {
1258c2ecf20Sopenharmony_ci			cpuid(0x80000001, &ignored, &ignored, &cpu.flags[6],
1268c2ecf20Sopenharmony_ci			      &cpu.flags[1]);
1278c2ecf20Sopenharmony_ci		}
1288c2ecf20Sopenharmony_ci	}
1298c2ecf20Sopenharmony_ci}
130