1 #if defined(__i386__) || defined(__x86_64__)
2 #include <unistd.h>
3 #include <errno.h>
4 #include <stdio.h>
5 #include <stdint.h>
6 
7 #include <pci/pci.h>
8 
9 #include "helpers/helpers.h"
10 
11 #define MSR_AMD_PSTATE_STATUS	0xc0010063
12 #define MSR_AMD_PSTATE		0xc0010064
13 #define MSR_AMD_PSTATE_LIMIT	0xc0010061
14 
15 union msr_pstate {
16 	struct {
17 		unsigned fid:6;
18 		unsigned did:3;
19 		unsigned vid:7;
20 		unsigned res1:6;
21 		unsigned nbdid:1;
22 		unsigned res2:2;
23 		unsigned nbvid:7;
24 		unsigned iddval:8;
25 		unsigned idddiv:2;
26 		unsigned res3:21;
27 		unsigned en:1;
28 	} bits;
29 	struct {
30 		unsigned fid:8;
31 		unsigned did:6;
32 		unsigned vid:8;
33 		unsigned iddval:8;
34 		unsigned idddiv:2;
35 		unsigned res1:30;
36 		unsigned en:1;
37 	} fam17h_bits;
38 	unsigned long long val;
39 };
40 
41 static int get_did(int family, union msr_pstate pstate)
42 {
43 	int t;
44 
45 	if (family == 0x12)
46 		t = pstate.val & 0xf;
47 	else if (family == 0x17)
48 		t = pstate.fam17h_bits.did;
49 	else
50 		t = pstate.bits.did;
51 
52 	return t;
53 }
54 
55 static int get_cof(int family, union msr_pstate pstate)
56 {
57 	int t;
58 	int fid, did, cof;
59 
60 	did = get_did(family, pstate);
61 	if (family == 0x17) {
62 		fid = pstate.fam17h_bits.fid;
63 		cof = 200 * fid / did;
64 	} else {
65 		t = 0x10;
66 		fid = pstate.bits.fid;
67 		if (family == 0x11)
68 			t = 0x8;
69 		cof = (100 * (fid + t)) >> did;
70 	}
71 	return cof;
72 }
73 
74 /* Needs:
75  * cpu          -> the cpu that gets evaluated
76  * cpu_family   -> The cpu's family (0x10, 0x12,...)
77  * boots_states -> how much boost states the machines support
78  *
79  * Fills up:
80  * pstates -> a pointer to an array of size MAX_HW_PSTATES
81  *            must be initialized with zeros.
82  *            All available  HW pstates (including boost states)
83  * no      -> amount of pstates above array got filled up with
84  *
85  * returns zero on success, -1 on failure
86  */
87 int decode_pstates(unsigned int cpu, unsigned int cpu_family,
88 		   int boost_states, unsigned long *pstates, int *no)
89 {
90 	int i, psmax, pscur;
91 	union msr_pstate pstate;
92 	unsigned long long val;
93 
94 	/* Only read out frequencies from HW when CPU might be boostable
95 	   to keep the code as short and clean as possible.
96 	   Otherwise frequencies are exported via ACPI tables.
97 	*/
98 	if (cpu_family < 0x10 || cpu_family == 0x14)
99 		return -1;
100 
101 	if (read_msr(cpu, MSR_AMD_PSTATE_LIMIT, &val))
102 		return -1;
103 
104 	psmax = (val >> 4) & 0x7;
105 
106 	if (read_msr(cpu, MSR_AMD_PSTATE_STATUS, &val))
107 		return -1;
108 
109 	pscur = val & 0x7;
110 
111 	pscur += boost_states;
112 	psmax += boost_states;
113 	for (i = 0; i <= psmax; i++) {
114 		if (i >= MAX_HW_PSTATES) {
115 			fprintf(stderr, "HW pstates [%d] exceeding max [%d]\n",
116 				psmax, MAX_HW_PSTATES);
117 			return -1;
118 		}
119 		if (read_msr(cpu, MSR_AMD_PSTATE + i, &pstate.val))
120 			return -1;
121 		pstates[i] = get_cof(cpu_family, pstate);
122 	}
123 	*no = i;
124 	return 0;
125 }
126 
127 int amd_pci_get_num_boost_states(int *active, int *states)
128 {
129 	struct pci_access *pci_acc;
130 	struct pci_dev *device;
131 	uint8_t val = 0;
132 
133 	*active = *states = 0;
134 
135 	device = pci_slot_func_init(&pci_acc, 0x18, 4);
136 
137 	if (device == NULL)
138 		return -ENODEV;
139 
140 	val = pci_read_byte(device, 0x15c);
141 	if (val & 3)
142 		*active = 1;
143 	else
144 		*active = 0;
145 	*states = (val >> 2) & 7;
146 
147 	pci_cleanup(pci_acc);
148 	return 0;
149 }
150 #endif /* defined(__i386__) || defined(__x86_64__) */
151