195 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2// dump_psb. (c) 2004, Dave Jones, Red Hat Inc.3 4#include <fcntl.h>5#include <stdio.h>6#include <stdlib.h>7#include <string.h>8#include <unistd.h>9 10#define _GNU_SOURCE11#include <getopt.h>12 13#include <sys/mman.h>14 15#define LEN (0x100000 - 0xc0000)16#define OFFSET (0xc0000)17 18#ifndef __packed19#define __packed __attribute((packed))20#endif21 22static long relevant;23 24static const int fid_to_mult[32] = {25 110, 115, 120, 125, 50, 55, 60, 65,26 70, 75, 80, 85, 90, 95, 100, 105,27 30, 190, 40, 200, 130, 135, 140, 210,28 150, 225, 160, 165, 170, 180, -1, -1,29};30 31static const int vid_to_voltage[32] = {32 2000, 1950, 1900, 1850, 1800, 1750, 1700, 1650,33 1600, 1550, 1500, 1450, 1400, 1350, 1300, 0,34 1275, 1250, 1225, 1200, 1175, 1150, 1125, 1100,35 1075, 1050, 1024, 1000, 975, 950, 925, 0,36};37 38struct psb_header {39 char signature[10];40 u_char version;41 u_char flags;42 u_short settlingtime;43 u_char res1;44 u_char numpst;45} __packed;46 47struct pst_header {48 u_int32_t cpuid;49 u_char fsb;50 u_char maxfid;51 u_char startvid;52 u_char numpstates;53} __packed;54 55static u_int fsb;56static u_int sgtc;57 58static int59decode_pst(char *p, int npstates)60{61 int i;62 int freq, fid, vid;63 64 for (i = 0; i < npstates; ++i) {65 fid = *p++;66 vid = *p++;67 freq = 100 * fid_to_mult[fid] * fsb;68 69 printf(" %2d %8dkHz FID %02x (%2d.%01d) VID %02x (%4dmV)\n",70 i,71 freq,72 fid, fid_to_mult[fid]/10, fid_to_mult[fid]%10,73 vid, vid_to_voltage[vid]);74 }75 76 return 0;77}78 79static80void decode_psb(char *p, int numpst)81{82 int i;83 struct psb_header *psb;84 struct pst_header *pst;85 86 psb = (struct psb_header*) p;87 88 if (psb->version != 0x12)89 return;90 91 printf("PSB version: %hhx flags: %hhx settling time %hhuus res1 %hhx num pst %hhu\n",92 psb->version,93 psb->flags,94 psb->settlingtime,95 psb->res1,96 psb->numpst);97 sgtc = psb->settlingtime * 100;98 99 if (sgtc < 10000)100 sgtc = 10000;101 102 p = ((char *) psb) + sizeof(struct psb_header);103 104 if (numpst < 0)105 numpst = psb->numpst;106 else107 printf("Overriding number of pst :%d\n", numpst);108 109 for (i = 0; i < numpst; i++) {110 pst = (struct pst_header*) p;111 112 if (relevant != 0) {113 if (relevant!= pst->cpuid)114 goto next_one;115 }116 117 printf(" PST %d cpuid %.3x fsb %hhu mfid %hhx svid %hhx numberstates %hhu\n",118 i+1,119 pst->cpuid,120 pst->fsb,121 pst->maxfid,122 pst->startvid,123 pst->numpstates);124 125 fsb = pst->fsb;126 decode_pst(p + sizeof(struct pst_header), pst->numpstates);127 128next_one:129 p += sizeof(struct pst_header) + 2*pst->numpstates;130 }131 132}133 134static struct option info_opts[] = {135 {"numpst", no_argument, NULL, 'n'},136};137 138void print_help(void)139{140 printf ("Usage: dump_psb [options]\n");141 printf ("Options:\n");142 printf (" -n, --numpst Set number of PST tables to scan\n");143 printf (" -r, --relevant Only display PSTs relevant to cpuid N\n");144}145 146int147main(int argc, char *argv[])148{149 int fd;150 int numpst=-1;151 int ret=0, cont=1;152 char *mem = NULL;153 char *p;154 155 do {156 ret = getopt_long(argc, argv, "hr:n:", info_opts, NULL);157 switch (ret){158 case '?':159 case 'h':160 print_help();161 cont = 0;162 break;163 case 'r':164 relevant = strtol(optarg, NULL, 16);165 break;166 case 'n':167 numpst = strtol(optarg, NULL, 10);168 break;169 case -1:170 cont = 0;171 break;172 }173 174 } while(cont);175 176 fd = open("/dev/mem", O_RDONLY);177 if (fd < 0) {178 printf ("Couldn't open /dev/mem. Are you root?\n");179 exit(1);180 }181 182 mem = mmap(mem, 0x100000 - 0xc0000, PROT_READ, MAP_SHARED, fd, 0xc0000);183 close(fd);184 185 for (p = mem; p - mem < LEN; p+=16) {186 if (memcmp(p, "AMDK7PNOW!", 10) == 0) {187 decode_psb(p, numpst);188 break;189 }190 }191 192 munmap(mem, LEN);193 return 0;194}195