[mirror_ubuntu-bionic-kernel.git] / tools / power / cpupower / utils / helpers / amd.c

// SPDX-License-Identifier: GPL-2.0
#if defined(__i386__) || defined(__x86_64__)
#include <unistd.h>
#include <errno.h>
#include <stdio.h>
#include <stdint.h>

#include <pci/pci.h>

#include "helpers/helpers.h"

#define MSR_AMD_PSTATE_STATUS	0xc0010063
#define MSR_AMD_PSTATE		0xc0010064
#define MSR_AMD_PSTATE_LIMIT	0xc0010061

union msr_pstate {
	struct {
		unsigned fid:6;
		unsigned did:3;
		unsigned vid:7;
		unsigned res1:6;
		unsigned nbdid:1;
		unsigned res2:2;
		unsigned nbvid:7;
		unsigned iddval:8;
		unsigned idddiv:2;
		unsigned res3:21;
		unsigned en:1;
	} bits;
	struct {
		unsigned fid:8;
		unsigned did:6;
		unsigned vid:8;
		unsigned iddval:8;
		unsigned idddiv:2;
		unsigned res1:30;
		unsigned en:1;
	} fam17h_bits;
	unsigned long long val;
};

static int get_did(int family, union msr_pstate pstate)
{
	int t;

	if (family == 0x12)
		t = pstate.val & 0xf;
	else if (family == 0x17)
		t = pstate.fam17h_bits.did;
	else
		t = pstate.bits.did;

	return t;
}

static int get_cof(int family, union msr_pstate pstate)
{
	int t;
	int fid, did, cof;

	did = get_did(family, pstate);
	if (family == 0x17) {
		fid = pstate.fam17h_bits.fid;
		cof = 200 * fid / did;
	} else {
		t = 0x10;
		fid = pstate.bits.fid;
		if (family == 0x11)
			t = 0x8;
		cof = (100 * (fid + t)) >> did;
	}
	return cof;
}

/* Needs:
 * cpu          -> the cpu that gets evaluated
 * cpu_family   -> The cpu's family (0x10, 0x12,...)
 * boots_states -> how much boost states the machines support
 *
 * Fills up:
 * pstates -> a pointer to an array of size MAX_HW_PSTATES
 *            must be initialized with zeros.
 *            All available  HW pstates (including boost states)
 * no      -> amount of pstates above array got filled up with
 *
 * returns zero on success, -1 on failure
 */
int decode_pstates(unsigned int cpu, unsigned int cpu_family,
		   int boost_states, unsigned long *pstates, int *no)
{
	int i, psmax, pscur;
	union msr_pstate pstate;
	unsigned long long val;

	/* Only read out frequencies from HW when CPU might be boostable
	   to keep the code as short and clean as possible.
	   Otherwise frequencies are exported via ACPI tables.
	*/
	if (cpu_family < 0x10 || cpu_family == 0x14)
		return -1;

	if (read_msr(cpu, MSR_AMD_PSTATE_LIMIT, &val))
		return -1;

	psmax = (val >> 4) & 0x7;

	if (read_msr(cpu, MSR_AMD_PSTATE_STATUS, &val))
		return -1;

	pscur = val & 0x7;

	pscur += boost_states;
	psmax += boost_states;
	for (i = 0; i <= psmax; i++) {
		if (i >= MAX_HW_PSTATES) {
			fprintf(stderr, "HW pstates [%d] exceeding max [%d]\n",
				psmax, MAX_HW_PSTATES);
			return -1;
		}
		if (read_msr(cpu, MSR_AMD_PSTATE + i, &pstate.val))
			return -1;
		pstates[i] = get_cof(cpu_family, pstate);
	}
	*no = i;
	return 0;
}

int amd_pci_get_num_boost_states(int *active, int *states)
{
	struct pci_access *pci_acc;
	struct pci_dev *device;
	uint8_t val = 0;

	*active = *states = 0;

	device = pci_slot_func_init(&pci_acc, 0x18, 4);

	if (device == NULL)
		return -ENODEV;

	val = pci_read_byte(device, 0x15c);
	if (val & 3)
		*active = 1;
	else
		*active = 0;
	*states = (val >> 2) & 7;

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