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