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> 13 #include <cpuidle.h> 14 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); 39 40 dprint("%s: - timediff: %llu - statediff: %llu - percent: %f (%u)\n", 41 cpuidle_cstates[id].name, timediff, statediff, *percent, cpu); 42 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] = 54 cpuidle_state_time(cpu, state); 55 dprint("CPU %d - State: %d - Val: %llu\n", 56 cpu, state, previous_count[cpu][state]); 57 } 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] = 73 cpuidle_state_time(cpu, state); 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)) { 85 switch (num) { 86 case 1: 87 strcpy(tmp, "C1"); 88 break; 89 case 2: 90 strcpy(tmp, "C3"); 91 break; 92 case 3: 93 strcpy(tmp, "C6"); 94 break; 95 } 96 } else if (!strncmp(tmp, "SNB-", 4)) { 97 switch (num) { 98 case 1: 99 strcpy(tmp, "C1"); 100 break; 101 case 2: 102 strcpy(tmp, "C3"); 103 break; 104 case 3: 105 strcpy(tmp, "C6"); 106 break; 107 case 4: 108 strcpy(tmp, "C7"); 109 break; 110 } 111 } else if (!strncmp(tmp, "ATM-", 4)) { 112 switch (num) { 113 case 1: 114 strcpy(tmp, "C1"); 115 break; 116 case 2: 117 strcpy(tmp, "C2"); 118 break; 119 case 3: 120 strcpy(tmp, "C4"); 121 break; 122 case 4: 123 strcpy(tmp, "C6"); 124 break; 125 } 126 } 127 } 128 129 static struct cpuidle_monitor *cpuidle_register(void) 130 { 131 int num; 132 char *tmp; 133 int this_cpu; 134 135 this_cpu = sched_getcpu(); 136 137 /* Assume idle state count is the same for all CPUs */ 138 cpuidle_sysfs_monitor.hw_states_num = cpuidle_state_count(this_cpu); 139 140 if (cpuidle_sysfs_monitor.hw_states_num <= 0) 141 return NULL; 142 143 for (num = 0; num < cpuidle_sysfs_monitor.hw_states_num; num++) { 144 tmp = cpuidle_state_name(this_cpu, num); 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 152 tmp = cpuidle_state_desc(this_cpu, num); 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; 160 cpuidle_cstates[num].get_count_percent = 161 cpuidle_get_count_percent; 162 }; 163 164 /* Free this at program termination */ 165 previous_count = malloc(sizeof(long long *) * cpu_count); 166 current_count = malloc(sizeof(long long *) * cpu_count); 167 for (num = 0; num < cpu_count; num++) { 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); 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 }; 200