summaryrefslogtreecommitdiff
path: root/src/amd_msr.c
blob: 12b9f733e0d96930da0badbb792ac44c29704e11 (plain)
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
#define _LARGEFILE64_SOURCE
#include <stdio.h>
#include <unistd.h>
#include <fcntl.h>
#include <sys/types.h>
#include <sys/errno.h>
#include "os.h"

static int _msr_open(void)
{
  static int msrfd = 0;

  if (msrfd == 0) {
    msrfd = open("/dev/cpu/0/msr", O_RDWR);
    if (msrfd == -1)
      ErrorF("Unable to open /dev/cpu/0/msr: %d\n", errno);
  }

  return msrfd;
}

int GeodeReadMSR(unsigned long addr, unsigned long *lo, unsigned long *hi)
{
  unsigned int data[2];
  int fd = _msr_open();
  int ret;

  if (fd == -1)
    return -1;
  
  ret = lseek64(fd, (off64_t) addr, SEEK_SET);
  
  if (ret == -1)
    return -1;
  
  ret = read(fd, (void *) data, sizeof(data));
  
  if (ret != 8) 
    return -1;

  *hi = data[1];
  *lo = data[0];

  return 0;
}

int GeodeWriteMSR(unsigned long addr, unsigned long lo, unsigned long hi)
{
  unsigned int data[2];
  int fd = _msr_open();

  if (fd == -1)
    return - 1;

  if (lseek64(fd, (off64_t) addr, SEEK_SET) == -1)
    return -1;

  data[0] = lo;
  data[1] = hi;

  if (write(fd, (void *) data, 8) != 8)
    return -1;

  return 0;
}