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
|
/*
// Copyright (c) 2010-2017 Intel Corporation
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
// http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.
*/
#include <inttypes.h>
#include <unistd.h>
#include <string.h>
#include <stdio.h>
#include <fcntl.h>
#include "msr.h"
#include "log.h"
int msr_fd[RTE_MAX_LCORE];
int n_msr_fd;
int msr_init(void)
{
char msr_path[1024];
if (n_msr_fd) {
return 0;
}
for (uint32_t i = 0; i < sizeof(msr_fd)/sizeof(*msr_fd); ++i, n_msr_fd = i) {
snprintf(msr_path, sizeof(msr_path), "/dev/cpu/%u/msr", i);
msr_fd[i] = open(msr_path, O_RDWR);
if (msr_fd[i] < 0) {
return i == 0? -1 : 0;
}
}
return 0;
}
void msr_cleanup(void)
{
for (int i = 0; i < n_msr_fd; ++i) {
close(msr_fd[i]);
}
n_msr_fd = 0;
}
int msr_read(uint64_t *ret, int lcore_id, off_t offset)
{
if (lcore_id > n_msr_fd) {
return -1;
}
if (0 > pread(msr_fd[lcore_id], ret, sizeof(uint64_t), offset)) {
return -1;
}
return 0;
}
int msr_write(int lcore_id, uint64_t val, off_t offset)
{
if (lcore_id > n_msr_fd) {
return -1;
}
if (sizeof(uint64_t) != pwrite(msr_fd[lcore_id], &val, sizeof(uint64_t), offset)) {
return -1;
}
// plogx_dbg("\t\tmsr_write(core %d, offset %x, val %lx)\n", lcore_id, (int)offset, val);
return 0;
}
|
