1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
|
#ifndef _CPU_H
#define _CPU_H
#include <stdbool.h>
#include <stdint.h>
#include <klibc/compiler.h>
static inline uint64_t rdtsc(void)
{
uint64_t v;
asm volatile ("rdtsc":"=A" (v));
return v;
}
static inline uint32_t rdtscl(void)
{
uint32_t v;
asm volatile ("rdtsc":"=a" (v)::"edx");
return v;
}
static inline void cpuid_count(uint32_t op, uint32_t cnt,
uint32_t * eax, uint32_t * ebx,
uint32_t * ecx, uint32_t * edx)
{
asm("pushl %%ebx ; cpuid ; movl %%ebx,%0 ; popl %%ebx":"=a"(*eax), "=SD"(*ebx), "=c"(*ecx),
"=d"(*edx)
: "a"(op), "c"(cnt));
}
static inline void cpuid(uint32_t op, uint32_t * eax, uint32_t * ebx,
uint32_t * ecx, uint32_t * edx)
{
asm("pushl %%ebx ; cpuid ; movl %%ebx,%0 ; popl %%ebx":"=a"(*eax), "=SD"(*ebx), "=c"(*ecx),
"=d"(*edx)
: "a"(op));
}
static inline __constfunc uint32_t cpuid_eax(uint32_t level)
{
uint32_t v;
asm("pushl %%ebx ; cpuid ; popl %%ebx":"=a"(v)
: "a"(level)
: "ecx", "edx");
return v;
}
static inline __constfunc uint32_t cpuid_ebx(uint32_t level)
{
uint32_t v;
asm("pushl %%ebx ; cpuid ; movl %%ebx,%0 ; popl %%ebx":"=a"(v)
: "a"(level)
: "ecx", "edx");
return v;
}
static inline __constfunc uint32_t cpuid_ecx(uint32_t level)
{
uint32_t v;
asm("pushl %%ebx ; cpuid ; popl %%ebx":"=c"(v), "+a"(level)
: : "edx");
return v;
}
static inline __constfunc uint32_t cpuid_edx(uint32_t level)
{
uint32_t v;
asm("pushl %%ebx ; cpuid ; popl %%ebx":"=d"(v), "+a"(level)
: : "ecx");
return v;
}
/* Standard macro to see if a specific flag is changeable */
static inline __constfunc bool cpu_has_eflag(uint32_t flag)
{
uint32_t f1, f2;
asm("pushfl\n\t" "pushfl\n\t" "popl %0\n\t" "movl %0,%1\n\t" "xorl %2,%0\n\t" "pushl %0\n\t" "popfl\n\t" "pushfl\n\t" "popl %0\n\t" "popfl\n\t":"=&r"(f1),
"=&r"
(f2)
: "ir"(flag));
return ((f1 ^ f2) & flag) != 0;
}
static inline uint64_t rdmsr(uint32_t msr)
{
uint64_t v;
asm volatile ("rdmsr":"=A" (v):"c"(msr));
return v;
}
static inline void wrmsr(uint64_t v, uint32_t msr)
{
asm volatile ("wrmsr"::"A" (v), "c"(msr));
}
static inline void cpu_relax(void)
{
asm volatile ("rep ; nop");
}
/* These are local cli/sti; not SMP-safe!!! */
static inline void cli(void)
{
asm volatile ("cli");
}
static inline void sti(void)
{
asm volatile ("sti");
}
#endif
|
