Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 3fb4f7cd authored by Srinivas Pandruvada's avatar Srinivas Pandruvada Committed by Andy Shevchenko
Browse files

tools/power/x86: A tool to validate Intel Speed Select commands 



The Intel(R) Speed select technologies contains four features.

Performance profile:An non architectural mechanism that allows multiple
optimized performance profiles per system via static and/or dynamic
adjustment of core count, workload, Tjmax, and TDP, etc. aka ISS
in the documentation.

Base Frequency: Enables users to increase guaranteed base frequency on
certain cores (high priority cores) in exchange for lower base frequency
on remaining cores (low priority cores). aka PBF in the documenation.

Turbo frequency: Enables the ability to set different turbo ratio limits
to cores based on priority. aka FACT in the documentation.

Core power: An Interface that allows user to define per core/tile
priority.

There is a multi level help for commands and options. This can be used
to check required arguments for each feature and commands for the
feature.

To start navigating the features start with

$sudo intel-speed-select --help

For help on a specific feature for example
$sudo intel-speed-select perf-profile --help

To get help for a command for a feature for example
$sudo intel-speed-select perf-profile get-lock-status --help

Signed-off-by: default avatarSrinivas Pandruvada <srinivas.pandruvada@linux.intel.com>
Acked-by: default avatarLen Brown <len.brown@intel.com>
Acked-by: default avatarRafael J. Wysocki <rafael.j.wysocki@intel.com>
Signed-off-by: default avatarAndy Shevchenko <andriy.shevchenko@linux.intel.com>
parent f607874f

tools/Makefile

+7 −5
Original line number Original line Diff line number Diff line
@@ -19,6 +19,7 @@ help: 
	@echo '  gpio                   - GPIO tools'

	@echo '  gpio                   - GPIO tools'

	@echo '  hv                     - tools used when in Hyper-V clients'

	@echo '  hv                     - tools used when in Hyper-V clients'

	@echo '  iio                    - IIO tools'

	@echo '  iio                    - IIO tools'

	@echo '  intel-speed-select     - Intel Speed Select tool'

	@echo '  kvm_stat               - top-like utility for displaying kvm statistics'

	@echo '  kvm_stat               - top-like utility for displaying kvm statistics'

	@echo '  leds                   - LEDs  tools'

	@echo '  leds                   - LEDs  tools'

	@echo '  liblockdep             - user-space wrapper for kernel locking-validator'

	@echo '  liblockdep             - user-space wrapper for kernel locking-validator'
@@ -82,7 +83,7 @@ perf: FORCE 
selftests: FORCE

selftests: FORCE

	$(call descend,testing/$@)

	$(call descend,testing/$@)





turbostat x86_energy_perf_policy: FORCE

turbostat x86_energy_perf_policy intel-speed-select: FORCE

	$(call descend,power/x86/$@)

	$(call descend,power/x86/$@)





tmon: FORCE

tmon: FORCE
@@ -115,7 +116,7 @@ liblockdep_install: 
selftests_install:

selftests_install:

	$(call descend,testing/$(@:_install=),install)

	$(call descend,testing/$(@:_install=),install)





turbostat_install x86_energy_perf_policy_install:

turbostat_install x86_energy_perf_policy_install intel-speed-select_install:

	$(call descend,power/x86/$(@:_install=),install)

	$(call descend,power/x86/$(@:_install=),install)





tmon_install:

tmon_install:
@@ -132,7 +133,7 @@ install: acpi_install cgroup_install cpupower_install gpio_install \ 
		perf_install selftests_install turbostat_install usb_install \

		perf_install selftests_install turbostat_install usb_install \

		virtio_install vm_install bpf_install x86_energy_perf_policy_install \

		virtio_install vm_install bpf_install x86_energy_perf_policy_install \

		tmon_install freefall_install objtool_install kvm_stat_install \

		tmon_install freefall_install objtool_install kvm_stat_install \

		wmi_install pci_install debugging_install

		wmi_install pci_install debugging_install intel-speed-select_install





acpi_clean:

acpi_clean:

	$(call descend,power/acpi,clean)

	$(call descend,power/acpi,clean)
@@ -162,7 +163,7 @@ perf_clean: 
selftests_clean:

selftests_clean:

	$(call descend,testing/$(@:_clean=),clean)

	$(call descend,testing/$(@:_clean=),clean)





turbostat_clean x86_energy_perf_policy_clean:

turbostat_clean x86_energy_perf_policy_clean intel-speed-select_clean:

	$(call descend,power/x86/$(@:_clean=),clean)

	$(call descend,power/x86/$(@:_clean=),clean)





tmon_clean:

tmon_clean:
@@ -178,6 +179,7 @@ clean: acpi_clean cgroup_clean cpupower_clean hv_clean firewire_clean \ 
		perf_clean selftests_clean turbostat_clean spi_clean usb_clean virtio_clean \

		perf_clean selftests_clean turbostat_clean spi_clean usb_clean virtio_clean \

		vm_clean bpf_clean iio_clean x86_energy_perf_policy_clean tmon_clean \

		vm_clean bpf_clean iio_clean x86_energy_perf_policy_clean tmon_clean \

		freefall_clean build_clean libbpf_clean libsubcmd_clean liblockdep_clean \

		freefall_clean build_clean libbpf_clean libsubcmd_clean liblockdep_clean \

		gpio_clean objtool_clean leds_clean wmi_clean pci_clean firmware_clean debugging_clean

		gpio_clean objtool_clean leds_clean wmi_clean pci_clean firmware_clean debugging_clean \

		intel-speed-select_clean





.PHONY: FORCE
 
.PHONY: FORCE

tools/power/x86/intel-speed-select/Build

0 → 100644
+1 −0
Original line number Original line Diff line number Diff line 
intel-speed-select-y +=  isst-config.o isst-core.o isst-display.o

tools/power/x86/intel-speed-select/Makefile

0 → 100644
+56 −0
Original line number Original line Diff line number Diff line 
# SPDX-License-Identifier: GPL-2.0

include ../../../scripts/Makefile.include



bindir ?= /usr/bin



ifeq ($(srctree),)

srctree := $(patsubst %/,%,$(dir $(CURDIR)))

srctree := $(patsubst %/,%,$(dir $(srctree)))

srctree := $(patsubst %/,%,$(dir $(srctree)))

srctree := $(patsubst %/,%,$(dir $(srctree)))

endif



# Do not use make's built-in rules

# (this improves performance and avoids hard-to-debug behaviour);

MAKEFLAGS += -r



override CFLAGS += -O2 -Wall -g -D_GNU_SOURCE -I$(OUTPUT)include



ALL_TARGETS := intel-speed-select

ALL_PROGRAMS := $(patsubst %,$(OUTPUT)%,$(ALL_TARGETS))



all: $(ALL_PROGRAMS)



export srctree OUTPUT CC LD CFLAGS

include $(srctree)/tools/build/Makefile.include



#

# We need the following to be outside of kernel tree

#

$(OUTPUT)include/linux/isst_if.h: ../../../../include/uapi/linux/isst_if.h

	mkdir -p $(OUTPUT)include/linux 2>&1 || true

	ln -sf $(CURDIR)/../../../../include/uapi/linux/isst_if.h $@



prepare: $(OUTPUT)include/linux/isst_if.h



ISST_IN := $(OUTPUT)intel-speed-select-in.o



$(ISST_IN): prepare FORCE

	$(Q)$(MAKE) $(build)=intel-speed-select

$(OUTPUT)intel-speed-select: $(ISST_IN)

	$(QUIET_LINK)$(CC) $(CFLAGS) $(LDFLAGS) $< -o $@



clean:

	rm -f $(ALL_PROGRAMS)

	rm -rf $(OUTPUT)include/linux/isst_if.h

	find $(if $(OUTPUT),$(OUTPUT),.) -name '*.o' -delete -o -name '\.*.d' -delete



install: $(ALL_PROGRAMS)

	install -d -m 755 $(DESTDIR)$(bindir);		\

	for program in $(ALL_PROGRAMS); do		\

		install $$program $(DESTDIR)$(bindir);	\

	done



FORCE:



.PHONY: all install clean FORCE prepare

tools/power/x86/intel-speed-select/isst-config.c

0 → 100644
+1607 −0

File added.

Preview size limit exceeded, changes collapsed.

tools/power/x86/intel-speed-select/isst-core.c

0 → 100644
+721 −0
Original line number Original line Diff line number Diff line 
// SPDX-License-Identifier: GPL-2.0

/*

 * Intel Speed Select -- Enumerate and control features

 * Copyright (c) 2019 Intel Corporation.

 */



#include "isst.h"



int isst_get_ctdp_levels(int cpu, struct isst_pkg_ctdp *pkg_dev)

{

	unsigned int resp;

	int ret;



	ret = isst_send_mbox_command(cpu, CONFIG_TDP,

				     CONFIG_TDP_GET_LEVELS_INFO, 0, 0, &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CONFIG_TDP_GET_LEVELS_INFO resp:%x\n", cpu, resp);



	pkg_dev->version = resp & 0xff;

	pkg_dev->levels = (resp >> 8) & 0xff;

	pkg_dev->current_level = (resp >> 16) & 0xff;

	pkg_dev->locked = !!(resp & BIT(24));

	pkg_dev->enabled = !!(resp & BIT(31));



	return 0;

}



int isst_get_ctdp_control(int cpu, int config_index,

			  struct isst_pkg_ctdp_level_info *ctdp_level)

{

	unsigned int resp;

	int ret;



	ret = isst_send_mbox_command(cpu, CONFIG_TDP,

				     CONFIG_TDP_GET_TDP_CONTROL, 0,

				     config_index, &resp);

	if (ret)

		return ret;



	ctdp_level->fact_support = resp & BIT(0);

	ctdp_level->pbf_support = !!(resp & BIT(1));

	ctdp_level->fact_enabled = !!(resp & BIT(16));

	ctdp_level->pbf_enabled = !!(resp & BIT(17));



	debug_printf(

		"cpu:%d CONFIG_TDP_GET_TDP_CONTROL resp:%x fact_support:%d pbf_support: %d fact_enabled:%d pbf_enabled:%d\n",

		cpu, resp, ctdp_level->fact_support, ctdp_level->pbf_support,

		ctdp_level->fact_enabled, ctdp_level->pbf_enabled);



	return 0;

}



int isst_get_tdp_info(int cpu, int config_index,

		      struct isst_pkg_ctdp_level_info *ctdp_level)

{

	unsigned int resp;

	int ret;



	ret = isst_send_mbox_command(cpu, CONFIG_TDP, CONFIG_TDP_GET_TDP_INFO,

				     0, config_index, &resp);

	if (ret)

		return ret;



	ctdp_level->pkg_tdp = resp & GENMASK(14, 0);

	ctdp_level->tdp_ratio = (resp & GENMASK(23, 16)) >> 16;



	debug_printf(

		"cpu:%d ctdp:%d CONFIG_TDP_GET_TDP_INFO resp:%x tdp_ratio:%d pkg_tdp:%d\n",

		cpu, config_index, resp, ctdp_level->tdp_ratio,

		ctdp_level->pkg_tdp);

	return 0;

}



int isst_get_pwr_info(int cpu, int config_index,

		      struct isst_pkg_ctdp_level_info *ctdp_level)

{

	unsigned int resp;

	int ret;



	ret = isst_send_mbox_command(cpu, CONFIG_TDP, CONFIG_TDP_GET_PWR_INFO,

				     0, config_index, &resp);

	if (ret)

		return ret;



	ctdp_level->pkg_max_power = resp & GENMASK(14, 0);

	ctdp_level->pkg_min_power = (resp & GENMASK(30, 16)) >> 16;



	debug_printf(

		"cpu:%d ctdp:%d CONFIG_TDP_GET_PWR_INFO resp:%x pkg_max_power:%d pkg_min_power:%d\n",

		cpu, config_index, resp, ctdp_level->pkg_max_power,

		ctdp_level->pkg_min_power);



	return 0;

}



int isst_get_tjmax_info(int cpu, int config_index,

			struct isst_pkg_ctdp_level_info *ctdp_level)

{

	unsigned int resp;

	int ret;



	ret = isst_send_mbox_command(cpu, CONFIG_TDP, CONFIG_TDP_GET_TJMAX_INFO,

				     0, config_index, &resp);

	if (ret)

		return ret;



	ctdp_level->t_proc_hot = resp & GENMASK(7, 0);



	debug_printf(

		"cpu:%d ctdp:%d CONFIG_TDP_GET_TJMAX_INFO resp:%x t_proc_hot:%d\n",

		cpu, config_index, resp, ctdp_level->t_proc_hot);



	return 0;

}



int isst_get_coremask_info(int cpu, int config_index,

			   struct isst_pkg_ctdp_level_info *ctdp_level)

{

	unsigned int resp;

	int i, ret;



	ctdp_level->cpu_count = 0;

	for (i = 0; i < 2; ++i) {

		unsigned long long mask;

		int cpu_count = 0;



		ret = isst_send_mbox_command(cpu, CONFIG_TDP,

					     CONFIG_TDP_GET_CORE_MASK, 0,

					     (i << 8) | config_index, &resp);

		if (ret)

			return ret;



		debug_printf(

			"cpu:%d ctdp:%d mask:%d CONFIG_TDP_GET_CORE_MASK resp:%x\n",

			cpu, config_index, i, resp);



		mask = (unsigned long long)resp << (32 * i);

		set_cpu_mask_from_punit_coremask(cpu, mask,

						 ctdp_level->core_cpumask_size,

						 ctdp_level->core_cpumask,

						 &cpu_count);

		ctdp_level->cpu_count += cpu_count;

		debug_printf("cpu:%d ctdp:%d mask:%d cpu count:%d\n", cpu,

			     config_index, i, ctdp_level->cpu_count);

	}



	return 0;

}



int isst_get_get_trl(int cpu, int level, int avx_level, int *trl)

{

	unsigned int req, resp;

	int ret;



	req = level | (avx_level << 16);

	ret = isst_send_mbox_command(cpu, CONFIG_TDP,

				     CONFIG_TDP_GET_TURBO_LIMIT_RATIOS, 0, req,

				     &resp);

	if (ret)

		return ret;



	debug_printf(

		"cpu:%d CONFIG_TDP_GET_TURBO_LIMIT_RATIOS req:%x resp:%x\n",

		cpu, req, resp);



	trl[0] = resp & GENMASK(7, 0);

	trl[1] = (resp & GENMASK(15, 8)) >> 8;

	trl[2] = (resp & GENMASK(23, 16)) >> 16;

	trl[3] = (resp & GENMASK(31, 24)) >> 24;



	req = level | BIT(8) | (avx_level << 16);

	ret = isst_send_mbox_command(cpu, CONFIG_TDP,

				     CONFIG_TDP_GET_TURBO_LIMIT_RATIOS, 0, req,

				     &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CONFIG_TDP_GET_TURBO_LIMIT req:%x resp:%x\n", cpu,

		     req, resp);



	trl[4] = resp & GENMASK(7, 0);

	trl[5] = (resp & GENMASK(15, 8)) >> 8;

	trl[6] = (resp & GENMASK(23, 16)) >> 16;

	trl[7] = (resp & GENMASK(31, 24)) >> 24;



	return 0;

}



int isst_set_tdp_level_msr(int cpu, int tdp_level)

{

	int ret;



	debug_printf("cpu: tdp_level via MSR %d\n", cpu, tdp_level);



	if (isst_get_config_tdp_lock_status(cpu)) {

		debug_printf("cpu: tdp_locked %d\n", cpu);

		return -1;

	}



	if (tdp_level > 2)

		return -1; /* invalid value */



	ret = isst_send_msr_command(cpu, 0x64b, 1,

				    (unsigned long long *)&tdp_level);

	if (ret)

		return ret;



	debug_printf("cpu: tdp_level via MSR successful %d\n", cpu, tdp_level);



	return 0;

}



int isst_set_tdp_level(int cpu, int tdp_level)

{

	unsigned int resp;

	int ret;



	ret = isst_send_mbox_command(cpu, CONFIG_TDP, CONFIG_TDP_SET_LEVEL, 0,

				     tdp_level, &resp);

	if (ret)

		return isst_set_tdp_level_msr(cpu, tdp_level);



	return 0;

}



int isst_get_pbf_info(int cpu, int level, struct isst_pbf_info *pbf_info)

{

	unsigned int req, resp;

	int i, ret;



	pbf_info->core_cpumask_size = alloc_cpu_set(&pbf_info->core_cpumask);



	for (i = 0; i < 2; ++i) {

		unsigned long long mask;

		int count;



		ret = isst_send_mbox_command(cpu, CONFIG_TDP,

					     CONFIG_TDP_PBF_GET_CORE_MASK_INFO,

					     0, (i << 8) | level, &resp);

		if (ret)

			return ret;



		debug_printf(

			"cpu:%d CONFIG_TDP_PBF_GET_CORE_MASK_INFO resp:%x\n",

			cpu, resp);



		mask = (unsigned long long)resp << (32 * i);

		set_cpu_mask_from_punit_coremask(cpu, mask,

						 pbf_info->core_cpumask_size,

						 pbf_info->core_cpumask,

						 &count);

	}



	req = level;

	ret = isst_send_mbox_command(cpu, CONFIG_TDP,

				     CONFIG_TDP_PBF_GET_P1HI_P1LO_INFO, 0, req,

				     &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CONFIG_TDP_PBF_GET_P1HI_P1LO_INFO resp:%x\n", cpu,

		     resp);



	pbf_info->p1_low = resp & 0xff;

	pbf_info->p1_high = (resp & GENMASK(15, 8)) >> 8;



	req = level;

	ret = isst_send_mbox_command(

		cpu, CONFIG_TDP, CONFIG_TDP_PBF_GET_TDP_INFO, 0, req, &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CONFIG_TDP_PBF_GET_TDP_INFO resp:%x\n", cpu, resp);



	pbf_info->tdp = resp & 0xffff;



	req = level;

	ret = isst_send_mbox_command(

		cpu, CONFIG_TDP, CONFIG_TDP_PBF_GET_TJ_MAX_INFO, 0, req, &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CONFIG_TDP_PBF_GET_TJ_MAX_INFO resp:%x\n", cpu,

		     resp);

	pbf_info->t_control = (resp >> 8) & 0xff;

	pbf_info->t_prochot = resp & 0xff;



	return 0;

}



void isst_get_pbf_info_complete(struct isst_pbf_info *pbf_info)

{

	free_cpu_set(pbf_info->core_cpumask);

}



int isst_set_pbf_fact_status(int cpu, int pbf, int enable)

{

	struct isst_pkg_ctdp pkg_dev;

	struct isst_pkg_ctdp_level_info ctdp_level;

	int current_level;

	unsigned int req = 0, resp;

	int ret;



	ret = isst_get_ctdp_levels(cpu, &pkg_dev);

	if (ret)

		return ret;



	current_level = pkg_dev.current_level;



	ret = isst_get_ctdp_control(cpu, current_level, &ctdp_level);

	if (ret)

		return ret;



	if (pbf) {

		if (ctdp_level.fact_enabled)

			req = BIT(16);



		if (enable)

			req |= BIT(17);

		else

			req &= ~BIT(17);

	} else {

		if (ctdp_level.pbf_enabled)

			req = BIT(17);



		if (enable)

			req |= BIT(16);

		else

			req &= ~BIT(16);

	}



	ret = isst_send_mbox_command(cpu, CONFIG_TDP,

				     CONFIG_TDP_SET_TDP_CONTROL, 0, req, &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CONFIG_TDP_SET_TDP_CONTROL pbf/fact:%d req:%x\n",

		     cpu, pbf, req);



	return 0;

}



int isst_get_fact_bucket_info(int cpu, int level,

			      struct isst_fact_bucket_info *bucket_info)

{

	unsigned int resp;

	int i, k, ret;



	for (i = 0; i < 2; ++i) {

		int j;



		ret = isst_send_mbox_command(

			cpu, CONFIG_TDP,

			CONFIG_TDP_GET_FACT_HP_TURBO_LIMIT_NUMCORES, 0,

			(i << 8) | level, &resp);

		if (ret)

			return ret;



		debug_printf(

			"cpu:%d CONFIG_TDP_GET_FACT_HP_TURBO_LIMIT_NUMCORES index:%d level:%d resp:%x\n",

			cpu, i, level, resp);



		for (j = 0; j < 4; ++j) {

			bucket_info[j + (i * 4)].high_priority_cores_count =

				(resp >> (j * 8)) & 0xff;

		}

	}



	for (k = 0; k < 3; ++k) {

		for (i = 0; i < 2; ++i) {

			int j;



			ret = isst_send_mbox_command(

				cpu, CONFIG_TDP,

				CONFIG_TDP_GET_FACT_HP_TURBO_LIMIT_RATIOS, 0,

				(k << 16) | (i << 8) | level, &resp);

			if (ret)

				return ret;



			debug_printf(

				"cpu:%d CONFIG_TDP_GET_FACT_HP_TURBO_LIMIT_RATIOS index:%d level:%d avx:%d resp:%x\n",

				cpu, i, level, k, resp);



			for (j = 0; j < 4; ++j) {

				switch (k) {

				case 0:

					bucket_info[j + (i * 4)].sse_trl =

						(resp >> (j * 8)) & 0xff;

					break;

				case 1:

					bucket_info[j + (i * 4)].avx_trl =

						(resp >> (j * 8)) & 0xff;

					break;

				case 2:

					bucket_info[j + (i * 4)].avx512_trl =

						(resp >> (j * 8)) & 0xff;

					break;

				default:

					break;

				}

			}

		}

	}



	return 0;

}



int isst_get_fact_info(int cpu, int level, struct isst_fact_info *fact_info)

{

	unsigned int resp;

	int ret;



	ret = isst_send_mbox_command(cpu, CONFIG_TDP,

				     CONFIG_TDP_GET_FACT_LP_CLIPPING_RATIO, 0,

				     level, &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CONFIG_TDP_GET_FACT_LP_CLIPPING_RATIO resp:%x\n",

		     cpu, resp);



	fact_info->lp_clipping_ratio_license_sse = resp & 0xff;

	fact_info->lp_clipping_ratio_license_avx2 = (resp >> 8) & 0xff;

	fact_info->lp_clipping_ratio_license_avx512 = (resp >> 16) & 0xff;



	ret = isst_get_fact_bucket_info(cpu, level, fact_info->bucket_info);



	return ret;

}



int isst_set_trl(int cpu, unsigned long long trl)

{

	int ret;



	if (!trl)

		trl = 0xFFFFFFFFFFFFFFFFULL;



	ret = isst_send_msr_command(cpu, 0x1AD, 1, &trl);

	if (ret)

		return ret;



	return 0;

}



int isst_set_trl_from_current_tdp(int cpu, unsigned long long trl)

{

	unsigned long long msr_trl;

	int ret;



	if (trl) {

		msr_trl = trl;

	} else {

		struct isst_pkg_ctdp pkg_dev;

		int trl[8];

		int i;



		ret = isst_get_ctdp_levels(cpu, &pkg_dev);

		if (ret)

			return ret;



		ret = isst_get_get_trl(cpu, pkg_dev.current_level, 0, trl);

		if (ret)

			return ret;



		msr_trl = 0;

		for (i = 0; i < 8; ++i) {

			unsigned long long _trl = trl[i];



			msr_trl |= (_trl << (i * 8));

		}

	}

	ret = isst_send_msr_command(cpu, 0x1AD, 1, &msr_trl);

	if (ret)

		return ret;



	return 0;

}



/* Return 1 if locked */

int isst_get_config_tdp_lock_status(int cpu)

{

	unsigned long long tdp_control = 0;

	int ret;



	ret = isst_send_msr_command(cpu, 0x64b, 0, &tdp_control);

	if (ret)

		return ret;



	ret = !!(tdp_control & BIT(31));



	return ret;

}



void isst_get_process_ctdp_complete(int cpu, struct isst_pkg_ctdp *pkg_dev)

{

	int i;



	if (!pkg_dev->processed)

		return;



	for (i = 0; i < pkg_dev->levels; ++i) {

		struct isst_pkg_ctdp_level_info *ctdp_level;



		ctdp_level = &pkg_dev->ctdp_level[i];

		if (ctdp_level->pbf_support)

			free_cpu_set(ctdp_level->pbf_info.core_cpumask);

		free_cpu_set(ctdp_level->core_cpumask);

	}

}



int isst_get_process_ctdp(int cpu, int tdp_level, struct isst_pkg_ctdp *pkg_dev)

{

	int i, ret;



	if (pkg_dev->processed)

		return 0;



	ret = isst_get_ctdp_levels(cpu, pkg_dev);

	if (ret)

		return ret;



	debug_printf("cpu: %d ctdp enable:%d current level: %d levels:%d\n",

		     cpu, pkg_dev->enabled, pkg_dev->current_level,

		     pkg_dev->levels);



	for (i = 0; i <= pkg_dev->levels; ++i) {

		struct isst_pkg_ctdp_level_info *ctdp_level;



		if (tdp_level != 0xff && i != tdp_level)

			continue;



		debug_printf("cpu:%d Get Information for TDP level:%d\n", cpu,

			     i);

		ctdp_level = &pkg_dev->ctdp_level[i];



		ctdp_level->processed = 1;

		ctdp_level->level = i;

		ctdp_level->control_cpu = cpu;

		ctdp_level->pkg_id = get_physical_package_id(cpu);

		ctdp_level->die_id = get_physical_die_id(cpu);



		ret = isst_get_ctdp_control(cpu, i, ctdp_level);

		if (ret)

			return ret;



		ret = isst_get_tdp_info(cpu, i, ctdp_level);

		if (ret)

			return ret;



		ret = isst_get_pwr_info(cpu, i, ctdp_level);

		if (ret)

			return ret;



		ret = isst_get_tjmax_info(cpu, i, ctdp_level);

		if (ret)

			return ret;



		ctdp_level->core_cpumask_size =

			alloc_cpu_set(&ctdp_level->core_cpumask);

		ret = isst_get_coremask_info(cpu, i, ctdp_level);

		if (ret)

			return ret;



		ret = isst_get_get_trl(cpu, i, 0,

				       ctdp_level->trl_sse_active_cores);

		if (ret)

			return ret;



		ret = isst_get_get_trl(cpu, i, 1,

				       ctdp_level->trl_avx_active_cores);

		if (ret)

			return ret;



		ret = isst_get_get_trl(cpu, i, 2,

				       ctdp_level->trl_avx_512_active_cores);

		if (ret)

			return ret;



		if (ctdp_level->pbf_support) {

			ret = isst_get_pbf_info(cpu, i, &ctdp_level->pbf_info);

			if (!ret)

				ctdp_level->pbf_found = 1;

		}



		if (ctdp_level->fact_support) {

			ret = isst_get_fact_info(cpu, i,

						 &ctdp_level->fact_info);

			if (ret)

				return ret;

		}

	}



	pkg_dev->processed = 1;



	return 0;

}



int isst_pm_qos_config(int cpu, int enable_clos, int priority_type)

{

	unsigned int req, resp;

	int ret;



	ret = isst_send_mbox_command(cpu, CONFIG_CLOS, CLOS_PM_QOS_CONFIG, 0, 0,

				     &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CLOS_PM_QOS_CONFIG resp:%x\n", cpu, resp);



	req = resp;



	if (enable_clos)

		req = req | BIT(1);

	else

		req = req & ~BIT(1);



	if (priority_type)

		req = req | BIT(2);

	else

		req = req & ~BIT(2);



	ret = isst_send_mbox_command(cpu, CONFIG_CLOS, CLOS_PM_QOS_CONFIG,

				     BIT(MBOX_CMD_WRITE_BIT), req, &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CLOS_PM_QOS_CONFIG priority type:%d req:%x\n", cpu,

		     priority_type, req);



	return 0;

}



int isst_pm_get_clos(int cpu, int clos, struct isst_clos_config *clos_config)

{

	unsigned int resp;

	int ret;



	ret = isst_send_mbox_command(cpu, CONFIG_CLOS, CLOS_PM_CLOS, clos, 0,

				     &resp);

	if (ret)

		return ret;



	clos_config->pkg_id = get_physical_package_id(cpu);

	clos_config->die_id = get_physical_die_id(cpu);



	clos_config->epp = resp & 0x0f;

	clos_config->clos_prop_prio = (resp >> 4) & 0x0f;

	clos_config->clos_min = (resp >> 8) & 0xff;

	clos_config->clos_max = (resp >> 16) & 0xff;

	clos_config->clos_desired = (resp >> 24) & 0xff;



	return 0;

}



int isst_set_clos(int cpu, int clos, struct isst_clos_config *clos_config)

{

	unsigned int req, resp;

	unsigned int param;

	int ret;



	req = clos_config->epp & 0x0f;

	req |= (clos_config->clos_prop_prio & 0x0f) << 4;

	req |= (clos_config->clos_min & 0xff) << 8;

	req |= (clos_config->clos_max & 0xff) << 16;

	req |= (clos_config->clos_desired & 0xff) << 24;



	param = BIT(MBOX_CMD_WRITE_BIT) | clos;



	ret = isst_send_mbox_command(cpu, CONFIG_CLOS, CLOS_PM_CLOS, param, req,

				     &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CLOS_PM_CLOS param:%x req:%x\n", cpu, param, req);



	return 0;

}



int isst_clos_get_assoc_status(int cpu, int *clos_id)

{

	unsigned int resp;

	unsigned int param;

	int core_id, ret;



	core_id = find_phy_core_num(cpu);

	param = core_id;



	ret = isst_send_mbox_command(cpu, CONFIG_CLOS, CLOS_PQR_ASSOC, param, 0,

				     &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CLOS_PQR_ASSOC param:%x resp:%x\n", cpu, param,

		     resp);

	*clos_id = (resp >> 16) & 0x03;



	return 0;

}



int isst_clos_associate(int cpu, int clos_id)

{

	unsigned int req, resp;

	unsigned int param;

	int core_id, ret;



	req = (clos_id & 0x03) << 16;

	core_id = find_phy_core_num(cpu);

	param = BIT(MBOX_CMD_WRITE_BIT) | core_id;



	ret = isst_send_mbox_command(cpu, CONFIG_CLOS, CLOS_PQR_ASSOC, param,

				     req, &resp);

	if (ret)

		return ret;



	debug_printf("cpu:%d CLOS_PQR_ASSOC param:%x req:%x\n", cpu, param,

		     req);



	return 0;

}