// SPDX-License-Identifier: GPL-2.0-only
/*
 *  (C) 2004 Bruno Ducrot <ducrot@poupinou.org>
 *
 * Based on code found in
 * linux/arch/i386/kernel/cpu/cpufreq/powernow-k8.c
 * and originally developed by Paul Devriendt
 */

#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <unistd.h>
#include <errno.h>
#include <fcntl.h>

#include <sys/types.h>
#include <sys/stat.h>

#define MCPU 32

#define MSR_FIDVID_STATUS 0xc0010042

#define MSR_S_HI_CURRENT_VID 0x0000001f
#define MSR_S_LO_CURRENT_FID 0x0000003f

static int get_fidvid(uint32_t cpu, uint32_t *fid, uint32_t *vid)
{
 int err = 1;
 uint64_t msr = 0;
 int fd;
 char file[20];

 if (cpu > MCPU)
  goto out;

 sprintf(file, "/dev/cpu/%d/msr", cpu);

 fd = open(file, O_RDONLY);
 if (fd < 0)
  goto out;
 lseek(fd, MSR_FIDVID_STATUS, SEEK_CUR);
 if (read(fd, &msr, 8) != 8)
  goto err1;

 *fid = ((uint32_t )(msr & 0xffffffffull)) & MSR_S_LO_CURRENT_FID;
 *vid = ((uint32_t )(msr>>32 & 0xffffffffull)) & MSR_S_HI_CURRENT_VID;
 err = 0;
err1:
 close(fd);
out:
 return err;
}


/* Return a frequency in MHz, given an input fid */
static uint32_t find_freq_from_fid(uint32_t fid)
{
 return 800 + (fid * 100);
}

/* Return a voltage in miliVolts, given an input vid */
static uint32_t find_millivolts_from_vid(uint32_t vid)
{
 return 1550-vid*25;
}

int main (int argc, char *argv[])
{
 int err;
 int cpu;
 uint32_t fid, vid;

 if (argc < 2)
  cpu = 0;
 else
  cpu = strtoul(argv[1], NULL, 0);

 err = get_fidvid(cpu, &fid, &vid);

 if (err) {
  printf("can't get fid, vid from MSR\n");
  printf("Possible trouble: you don't run a powernow-k8 capable cpu\n");
  printf("or you are not root, or the msr driver is not present\n");
  exit(1);
 }

 
 printf("cpu %d currently at %d MHz and %d mV\n",
   cpu,
   find_freq_from_fid(fid),
   find_millivolts_from_vid(vid));
 
 return 0;
}