3 * CPU-specific dispatch
5 * (c) 2015 Straylight/Edgeware
8 /*----- Licensing notice --------------------------------------------------*
10 * This file is part of Catacomb.
12 * Catacomb is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU Library General Public License as
14 * published by the Free Software Foundation; either version 2 of the
15 * License, or (at your option) any later version.
17 * Catacomb is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU Library General Public License for more details.
22 * You should have received a copy of the GNU Library General Public
23 * License along with Catacomb; if not, write to the Free
24 * Software Foundation, Inc., 59 Temple Place - Suite 330, Boston,
28 /*----- Header files ------------------------------------------------------*/
36 #include <mLib/macros.h>
40 /*----- Main code ---------------------------------------------------------*/
44 #define EFLAGS_ID (1u << 21)
45 #define CPUID1D_SSE2 (1u << 26)
46 #define CPUID1D_FXSR (1u << 24)
48 struct cpuid
{ unsigned a
, b
, c
, d
; };
52 * Arguments: @struct cpuid *cc@ = where to write the result
53 * @unsigned a, c@ = EAX and ECX registers to set
57 * Use: Minimal C wrapper around the x86 `CPUID' instruction. Checks
58 * that the instruction is actually available before invoking
59 * it; fills the output structure with zero if it's not going to
64 static __inline__
unsigned getflags(void)
65 { unsigned f
; __asm__ ("pushf; popl %0" : "=g" (f
)); return (f
); }
66 static __inline__
unsigned setflags(unsigned f
)
69 __asm__ ("pushf; pushl %1; popf; pushf; popl %0; popf"
76 static void cpuid(struct cpuid
*cc
, unsigned a
, unsigned c
)
82 cc
->a
= cc
->b
= cc
->c
= cc
->d
= 0;
85 /* Stupid dance to detect whether the CPUID instruction is available. */
87 if (!(setflags(f
| EFLAGS_ID
) & EFLAGS_ID
)) return;
88 if ( setflags(f
& ~EFLAGS_ID
) & EFLAGS_ID
) return;
91 /* Alas, EBX is magical in PIC code, so abuse ESI instead. This isn't
92 * pretty, but it works.
94 __asm__ ("pushl %%ebx; cpuid; movl %%ebx, %%esi; popl %%ebx"
95 : "=a" (cc
->a
), "=S" (cc
->b
), "=c" (cc
->c
), "=d" (cc
->d
)
100 static unsigned cpuid_maxleaf(void)
101 { struct cpuid c
; cpuid(&c
, 0, 0); return (c
.a
); }
103 static int cpuid_features_p(unsigned dbits
, unsigned cbits
)
106 if (cpuid_maxleaf() < 1) return (0);
108 return ((c
.d
& dbits
) == dbits
&& (c
.c
& cbits
) == cbits
);
111 static int xmm_registers_available_p(void)
115 /* This hack is by Agner Fog. Use FXSAVE/FXRSTOR to figure out whether the
116 * XMM registers are actually alive.
118 if (!cpuid_features_p(CPUID1D_FXSR
, 0)) return (0);
119 __asm__ ("movl %%esp, %%edx; subl $512, %%esp; andl $~15, %%esp\n"
121 "movl 160(%%esp), %%eax; xorl $0xaaaa5555, 160(%%esp)\n"
122 "fxrstor (%%esp); fxsave (%%esp)\n"
123 "movl 160(%%esp), %%ecx; movl %%eax, 160(%%esp)\n"
124 "fxrstor (%%esp); movl %%edx, %%esp\n"
137 /* --- @check_env@ --- *
139 * Arguments: @const char *ftok@ = feature token
141 * Returns: Zero if the feature is forced off; positive if it's forced
142 * on; negative if the user hasn't decided.
144 * Use: Checks the environment variable `CATACOMB_CPUFEAT' for the
145 * feature token @ftok@. The variable, if it exists, should be
146 * a space-separated sequence of `+tok' and `-tok' items. These
147 * tokens may end in `*', which matches any suffix.
150 static int IGNORABLE
check_env(const char *ftok
)
152 const char *p
, *q
, *pp
;
155 p
= getenv("CATACOMB_CPUFEAT");
159 while (isspace((unsigned char)*p
)) p
++;
160 if (!*p
) return (-1);
162 case '+': d
= +1; p
++; break;
163 case '-': d
= 0; p
++; break;
164 default: d
= -1; break;
166 for (q
= p
; *q
&& !isspace((unsigned char)*q
); q
++);
168 for (pp
= ftok
; p
< q
&& *pp
&& *p
== *pp
; p
++, pp
++);
169 if ((p
== q
&& !*pp
) || (*p
== '*' && p
+ 1 == q
)) return (d
);
176 /* --- @cpu_feature_p@ --- *
178 * Arguments: @unsigned feat@ = a @CPUFEAT_...@ code
180 * Returns: Nonzero if the feature is available.
185 int cpu_feature_p(int feat
)
189 #define CHECK_ENV(ftok) \
190 do { if ((f = check_env(ftok)) >= 0) return (f); } while (0)
194 case CPUFEAT_X86_SSE2
: {
195 CHECK_ENV("x86:sse2");
196 return (xmm_registers_available_p() &&
197 cpuid_features_p(CPUID1D_SSE2
, 0));
206 /*----- That's all, folks -------------------------------------------------*/