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
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
|
/*
* (C) 2001 Dave Jones.
*
* Licensed under the terms of the GNU GPL License version 2.
*
* Contributions by Arjan van de Ven & Philipp Rumpf.
*
* Routines for reading MSRs.
*/
#define _LARGEFILE64_SOURCE
#include <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <unistd.h>
#include "x86info.h"
#if defined(__FreeBSD__)
# include <sys/ioctl.h>
# include <cpu.h>
#endif
#if defined(__FreeBSD__)
int read_msr(int cpu, unsigned int idx, unsigned long long *val)
{
char cpuname[16];
unsigned char buffer[8];
unsigned long lo, hi;
int fh;
static int nodriver=0;
cpu_msr_args_t args;
if (nodriver==1)
return 0;
(void)snprintf(cpuname, sizeof(cpuname), "/dev/cpu%d", cpu);
fh = open(cpuname, O_RDONLY);
if (fh==-1) {
perror(cpuname);
nodriver=1;
return 0;
}
args.msr = idx;
if (ioctl(fh, CPU_RDMSR, &args) != 0) {
if (close(fh) == -1) {
perror("close");
exit(EXIT_FAILURE);
}
return 0;
}
*val = args.data;
if (close(fh)==-1) {
perror("close");
exit(EXIT_FAILURE);
}
return 1;
}
#else /* !__FreeBSD__ */
int read_msr(int cpu, unsigned int idx, unsigned long long *val)
{
char cpuname[16];
unsigned char buffer[8];
unsigned long long lo, hi;
int fh;
static int nodriver=0;
unsigned int *ptr = (unsigned int *) buffer;
if (nodriver==1)
return 0;
(void)snprintf(cpuname, sizeof(cpuname), "/dev/cpu/%d/msr", cpu);
fh = open(cpuname, O_RDONLY);
if (fh == -1) {
perror(cpuname);
nodriver=1;
return 0;
}
if (lseek64(fh, (off64_t) idx, SEEK_CUR) == -1) {
perror("lseek");
exit(EXIT_FAILURE);
}
if (fh != -1) {
if (read(fh, &buffer[0], 8) != 8) {
if (close(fh) == -1) {
perror("close");
exit(EXIT_FAILURE);
}
return 0;
}
lo = *ptr;
hi = *(++ptr);
*val = (hi << 32) | lo;
}
if (close(fh) == -1) {
perror("close");
exit(EXIT_FAILURE);
}
return 1;
}
#endif /* __FreeBSD__ */
void dumpmsr(int cpu, unsigned int msr, int size)
{
unsigned long long val=0;
if (read_msr(cpu, msr, &val) == 1) {
if (size == 32){
printf("MSR: 0x%08x=0x%08lx : ", msr, (unsigned long) val);
binary32(val);
}
if (size == 64) {
printf("MSR: 0x%08x=0x%016llx : ", msr, val);
binary64(val);
}
return;
}
printf("Couldn't read MSR 0x%x\n", msr);
}
void dumpmsr_bin(int cpu, unsigned int msr, int size)
{
unsigned long long val=0;
if (read_msr(cpu, msr, &val) == 1) {
if (size == 32)
binary32(val);
if (size == 64)
binary64(val);
return;
}
printf("Couldn't read MSR 0x%x\n", msr);
}
|
