[mirror_ubuntu-focal-kernel.git] / tools / power / cpupower / utils / idle_monitor / cpuidle_sysfs.c

/*
 *  (C) 2010,2011       Thomas Renninger <trenn@suse.de>, Novell Inc
 *
 *  Licensed under the terms of the GNU GPL License version 2.
 *
 */

#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <string.h>
#include <limits.h>
#include <cpuidle.h>

#include "helpers/helpers.h"
#include "idle_monitor/cpupower-monitor.h"

#define CPUIDLE_STATES_MAX 10
static cstate_t cpuidle_cstates[CPUIDLE_STATES_MAX];
struct cpuidle_monitor cpuidle_sysfs_monitor;

static unsigned long long **previous_count;
static unsigned long long **current_count;
struct timespec start_time;
static unsigned long long timediff;

static int cpuidle_get_count_percent(unsigned int id, double *percent,
				     unsigned int cpu)
{
	unsigned long long statediff = current_count[cpu][id]
		- previous_count[cpu][id];
	dprint("%s: - diff: %llu - percent: %f (%u)\n",
	       cpuidle_cstates[id].name, timediff, *percent, cpu);

	if (timediff == 0)
		*percent = 0.0;
	else
		*percent = ((100.0 * statediff) / timediff);

	dprint("%s: - timediff: %llu - statediff: %llu - percent: %f (%u)\n",
	       cpuidle_cstates[id].name, timediff, statediff, *percent, cpu);

	return 0;
}

static int cpuidle_start(void)
{
	int cpu, state;
	clock_gettime(CLOCK_REALTIME, &start_time);
	for (cpu = 0; cpu < cpu_count; cpu++) {
		for (state = 0; state < cpuidle_sysfs_monitor.hw_states_num;
		     state++) {
			previous_count[cpu][state] =
				cpuidle_state_time(cpu, state);
			dprint("CPU %d - State: %d - Val: %llu\n",
			       cpu, state, previous_count[cpu][state]);
		}
	};
	return 0;
}

static int cpuidle_stop(void)
{
	int cpu, state;
	struct timespec end_time;
	clock_gettime(CLOCK_REALTIME, &end_time);
	timediff = timespec_diff_us(start_time, end_time);

	for (cpu = 0; cpu < cpu_count; cpu++) {
		for (state = 0; state < cpuidle_sysfs_monitor.hw_states_num;
		     state++) {
			current_count[cpu][state] =
				cpuidle_state_time(cpu, state);
			dprint("CPU %d - State: %d - Val: %llu\n",
			       cpu, state, previous_count[cpu][state]);
		}
	};
	return 0;
}

void fix_up_intel_idle_driver_name(char *tmp, int num)
{
	/* fix up cpuidle name for intel idle driver */
	if (!strncmp(tmp, "NHM-", 4)) {
		switch (num) {
		case 1:
			strcpy(tmp, "C1");
			break;
		case 2:
			strcpy(tmp, "C3");
			break;
		case 3:
			strcpy(tmp, "C6");
			break;
		}
	} else if (!strncmp(tmp, "SNB-", 4)) {
		switch (num) {
		case 1:
			strcpy(tmp, "C1");
			break;
		case 2:
			strcpy(tmp, "C3");
			break;
		case 3:
			strcpy(tmp, "C6");
			break;
		case 4:
			strcpy(tmp, "C7");
			break;
		}
	} else if (!strncmp(tmp, "ATM-", 4)) {
		switch (num) {
		case 1:
			strcpy(tmp, "C1");
			break;
		case 2:
			strcpy(tmp, "C2");
			break;
		case 3:
			strcpy(tmp, "C4");
			break;
		case 4:
			strcpy(tmp, "C6");
			break;
		}
	}
}

static struct cpuidle_monitor *cpuidle_register(void)
{
	int num;
	char *tmp;
	int this_cpu;

	this_cpu = sched_getcpu();

	/* Assume idle state count is the same for all CPUs */
	cpuidle_sysfs_monitor.hw_states_num = cpuidle_state_count(this_cpu);

	if (cpuidle_sysfs_monitor.hw_states_num <= 0)
		return NULL;

	for (num = 0; num < cpuidle_sysfs_monitor.hw_states_num; num++) {
		tmp = cpuidle_state_name(this_cpu, num);
		if (tmp == NULL)
			continue;

		fix_up_intel_idle_driver_name(tmp, num);
		strncpy(cpuidle_cstates[num].name, tmp, CSTATE_NAME_LEN - 1);
		free(tmp);

		tmp = cpuidle_state_desc(this_cpu, num);
		if (tmp == NULL)
			continue;
		strncpy(cpuidle_cstates[num].desc, tmp,	CSTATE_DESC_LEN - 1);
		free(tmp);

		cpuidle_cstates[num].range = RANGE_THREAD;
		cpuidle_cstates[num].id = num;
		cpuidle_cstates[num].get_count_percent =
			cpuidle_get_count_percent;
	};

	/* Free this at program termination */
	previous_count = malloc(sizeof(long long *) * cpu_count);
	current_count = malloc(sizeof(long long *) * cpu_count);
	for (num = 0; num < cpu_count; num++) {
		previous_count[num] = malloc(sizeof(long long) *
					cpuidle_sysfs_monitor.hw_states_num);
		current_count[num] = malloc(sizeof(long long) *
					cpuidle_sysfs_monitor.hw_states_num);
	}

	cpuidle_sysfs_monitor.name_len = strlen(cpuidle_sysfs_monitor.name);
	return &cpuidle_sysfs_monitor;
}

void cpuidle_unregister(void)
{
	int num;

	for (num = 0; num < cpu_count; num++) {
		free(previous_count[num]);
		free(current_count[num]);
	}
	free(previous_count);
	free(current_count);
}

struct cpuidle_monitor cpuidle_sysfs_monitor = {
	.name			= "Idle_Stats",
	.hw_states		= cpuidle_cstates,
	.start			= cpuidle_start,
	.stop			= cpuidle_stop,
	.do_register		= cpuidle_register,
	.unregister		= cpuidle_unregister,
	.needs_root		= 0,
	.overflow_s		= UINT_MAX,
};
Commit	Line	Data
7fe2f639 DB	1	/*
	2	* (C) 2010,2011 Thomas Renninger <trenn@suse.de>, Novell Inc
	3	*
	4	* Licensed under the terms of the GNU GPL License version 2.
	5	*
	6	*/
	7
	8	#include <stdio.h>
	9	#include <stdlib.h>
	10	#include <stdint.h>
	11	#include <string.h>
	12	#include <limits.h>
ac5a181d	13	#include <cpuidle.h>
7fe2f639	14
7fe2f639 DB	15	#include "helpers/helpers.h"
	16	#include "idle_monitor/cpupower-monitor.h"
	17
	18	#define CPUIDLE_STATES_MAX 10
	19	static cstate_t cpuidle_cstates[CPUIDLE_STATES_MAX];
	20	struct cpuidle_monitor cpuidle_sysfs_monitor;
	21
	22	static unsigned long long **previous_count;
	23	static unsigned long long **current_count;
	24	struct timespec start_time;
	25	static unsigned long long timediff;
	26
	27	static int cpuidle_get_count_percent(unsigned int id, double *percent,
	28	unsigned int cpu)
	29	{
	30	unsigned long long statediff = current_count[cpu][id]
	31	- previous_count[cpu][id];
	32	dprint("%s: - diff: %llu - percent: %f (%u)\n",
	33	cpuidle_cstates[id].name, timediff, *percent, cpu);
	34
	35	if (timediff == 0)
	36	*percent = 0.0;
	37	else
	38	percent = ((100.0 statediff) / timediff);
b510b541	39
7fe2f639 DB	40	dprint("%s: - timediff: %llu - statediff: %llu - percent: %f (%u)\n",
7fe2f639 DB	41	cpuidle_cstates[id].name, timediff, statediff, *percent, cpu);
b510b541	42
7fe2f639 DB	43	return 0;
	44	}
	45
	46	static int cpuidle_start(void)
	47	{
	48	int cpu, state;
	49	clock_gettime(CLOCK_REALTIME, &start_time);
	50	for (cpu = 0; cpu < cpu_count; cpu++) {
	51	for (state = 0; state < cpuidle_sysfs_monitor.hw_states_num;
	52	state++) {
	53	previous_count[cpu][state] =
ac5a181d	54	cpuidle_state_time(cpu, state);
7fe2f639 DB	55	dprint("CPU %d - State: %d - Val: %llu\n",
	56	cpu, state, previous_count[cpu][state]);
	57	}
7fe2f639 DB	58	};
	59	return 0;
	60	}
	61
	62	static int cpuidle_stop(void)
	63	{
	64	int cpu, state;
	65	struct timespec end_time;
	66	clock_gettime(CLOCK_REALTIME, &end_time);
	67	timediff = timespec_diff_us(start_time, end_time);
	68
	69	for (cpu = 0; cpu < cpu_count; cpu++) {
	70	for (state = 0; state < cpuidle_sysfs_monitor.hw_states_num;
	71	state++) {
	72	current_count[cpu][state] =
ac5a181d	73	cpuidle_state_time(cpu, state);
7fe2f639 DB	74	dprint("CPU %d - State: %d - Val: %llu\n",
	75	cpu, state, previous_count[cpu][state]);
	76	}
	77	};
	78	return 0;
	79	}
	80
	81	void fix_up_intel_idle_driver_name(char *tmp, int num)
	82	{
	83	/* fix up cpuidle name for intel idle driver */
	84	if (!strncmp(tmp, "NHM-", 4)) {
b510b541 DB	85	switch (num) {
	86	case 1:
	87	strcpy(tmp, "C1");
7fe2f639	88	break;
b510b541 DB	89	case 2:
b510b541 DB	90	strcpy(tmp, "C3");
7fe2f639	91	break;
b510b541 DB	92	case 3:
b510b541 DB	93	strcpy(tmp, "C6");
7fe2f639 DB	94	break;
	95	}
	96	} else if (!strncmp(tmp, "SNB-", 4)) {
b510b541 DB	97	switch (num) {
	98	case 1:
	99	strcpy(tmp, "C1");
7fe2f639	100	break;
b510b541 DB	101	case 2:
b510b541 DB	102	strcpy(tmp, "C3");
7fe2f639	103	break;
b510b541 DB	104	case 3:
b510b541 DB	105	strcpy(tmp, "C6");
7fe2f639	106	break;
b510b541 DB	107	case 4:
b510b541 DB	108	strcpy(tmp, "C7");
7fe2f639 DB	109	break;
	110	}
	111	} else if (!strncmp(tmp, "ATM-", 4)) {
b510b541 DB	112	switch (num) {
	113	case 1:
	114	strcpy(tmp, "C1");
7fe2f639	115	break;
b510b541 DB	116	case 2:
b510b541 DB	117	strcpy(tmp, "C2");
7fe2f639	118	break;
b510b541 DB	119	case 3:
b510b541 DB	120	strcpy(tmp, "C4");
7fe2f639	121	break;
b510b541 DB	122	case 4:
b510b541 DB	123	strcpy(tmp, "C6");
7fe2f639 DB	124	break;
	125	}
	126	}
	127	}
	128
b510b541	129	static struct cpuidle_monitor *cpuidle_register(void)
7fe2f639 DB	130	{
	131	int num;
	132	char *tmp;
dbdc468f AG	133	int this_cpu;
	134
	135	this_cpu = sched_getcpu();
7fe2f639 DB	136
7fe2f639 DB	137	/* Assume idle state count is the same for all CPUs */
dbdc468f	138	cpuidle_sysfs_monitor.hw_states_num = cpuidle_state_count(this_cpu);
7fe2f639	139
88f984e0	140	if (cpuidle_sysfs_monitor.hw_states_num <= 0)
7fe2f639 DB	141	return NULL;
7fe2f639 DB	142
b510b541	143	for (num = 0; num < cpuidle_sysfs_monitor.hw_states_num; num++) {
dbdc468f	144	tmp = cpuidle_state_name(this_cpu, num);
7fe2f639 DB	145	if (tmp == NULL)
	146	continue;
	147
	148	fix_up_intel_idle_driver_name(tmp, num);
	149	strncpy(cpuidle_cstates[num].name, tmp, CSTATE_NAME_LEN - 1);
	150	free(tmp);
	151
dbdc468f	152	tmp = cpuidle_state_desc(this_cpu, num);
7fe2f639 DB	153	if (tmp == NULL)
	154	continue;
	155	strncpy(cpuidle_cstates[num].desc, tmp, CSTATE_DESC_LEN - 1);
	156	free(tmp);
	157
	158	cpuidle_cstates[num].range = RANGE_THREAD;
	159	cpuidle_cstates[num].id = num;
b510b541 DB	160	cpuidle_cstates[num].get_count_percent =
	161	cpuidle_get_count_percent;
	162	};
7fe2f639 DB	163
7fe2f639 DB	164	/* Free this at program termination */
b510b541 DB	165	previous_count = malloc(sizeof(long long ) cpu_count);
b510b541 DB	166	current_count = malloc(sizeof(long long ) cpu_count);
7fe2f639	167	for (num = 0; num < cpu_count; num++) {
b510b541 DB	168	previous_count[num] = malloc(sizeof(long long) *
	169	cpuidle_sysfs_monitor.hw_states_num);
	170	current_count[num] = malloc(sizeof(long long) *
	171	cpuidle_sysfs_monitor.hw_states_num);
7fe2f639 DB	172	}
	173
	174	cpuidle_sysfs_monitor.name_len = strlen(cpuidle_sysfs_monitor.name);
	175	return &cpuidle_sysfs_monitor;
	176	}
	177
	178	void cpuidle_unregister(void)
	179	{
	180	int num;
	181
	182	for (num = 0; num < cpu_count; num++) {
	183	free(previous_count[num]);
	184	free(current_count[num]);
	185	}
	186	free(previous_count);
	187	free(current_count);
	188	}
	189
	190	struct cpuidle_monitor cpuidle_sysfs_monitor = {
	191	.name = "Idle_Stats",
	192	.hw_states = cpuidle_cstates,
	193	.start = cpuidle_start,
	194	.stop = cpuidle_stop,
	195	.do_register = cpuidle_register,
	196	.unregister = cpuidle_unregister,
	197	.needs_root = 0,
	198	.overflow_s = UINT_MAX,
	199	};