1// SPDX-License-Identifier: GPL-2.0-only
2// 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_SOURCE
11#include <getopt.h>
12
13#include <sys/mman.h>
14
15#define LEN (0x100000 - 0xc0000)
16#define OFFSET (0xc0000)
17
18#ifndef __packed
19#define __packed __attribute((packed))
20#endif
21
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 int
59decode_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
79static
80void 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	else
107		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
146int
147main(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