--- zzzz-none-000/linux-3.10.107/drivers/cpufreq/cpufreq_stats.c 2017-06-27 09:49:32.000000000 +0000 +++ scorpion-7490-727/linux-3.10.107/drivers/cpufreq/cpufreq_stats.c 2021-02-04 17:41:59.000000000 +0000 @@ -9,118 +9,190 @@ * published by the Free Software Foundation. */ -#include -#include #include -#include #include #include -#include -#include -#include -#include -#include -#include +#include +#include +#include +#include static spinlock_t cpufreq_stats_lock; struct cpufreq_stats { - unsigned int cpu; unsigned int total_trans; - unsigned long long last_time; + unsigned long long last_time; unsigned int max_state; unsigned int state_num; - unsigned int last_index; + int last_index; u64 *time_in_state; + int *tempMax; + int *tempMin; + u32 *tempCount; //maximum: 0xffffffff which + #define TEMPCOUNT_MAX 0xffffffff //represents the overflow state + u64 *tempSum; unsigned int *freq_table; #ifdef CONFIG_CPU_FREQ_STAT_DETAILS unsigned int *trans_table; #endif }; -static DEFINE_PER_CPU(struct cpufreq_stats *, cpufreq_stats_table); - -struct cpufreq_stats_attribute { - struct attribute attr; - ssize_t(*show) (struct cpufreq_stats *, char *); -}; - -static int cpufreq_stats_update(unsigned int cpu) +static int cpufreq_stats_update(struct cpufreq_stats *stats, int *temp) { - struct cpufreq_stats *stat; - unsigned long long cur_time; + unsigned long long cur_time = get_jiffies_64(); - cur_time = get_jiffies_64(); spin_lock(&cpufreq_stats_lock); - stat = per_cpu(cpufreq_stats_table, cpu); - if (stat->time_in_state) - stat->time_in_state[stat->last_index] += - cur_time - stat->last_time; - stat->last_time = cur_time; + stats->time_in_state[stats->last_index] += cur_time - stats->last_time; + stats->last_time = cur_time; + + if(temp) { + if(stats->tempCount[stats->last_index] == 0) { + stats->tempMax[stats->last_index]= *temp; + stats->tempMin[stats->last_index]= *temp; + stats->tempCount[stats->last_index] = 1; + } else { + if(stats->tempMax[stats->last_index] < *temp) { stats->tempMax[stats->last_index] = *temp; } + if(stats->tempMin[stats->last_index] > *temp) { stats->tempMin[stats->last_index] = *temp; } + if( stats->tempCount[stats->last_index] < TEMPCOUNT_MAX ) { stats->tempCount[stats->last_index]++; } //thus TEMPCOUNT_MAX indicates overflow with high probability + } + + if( *temp < 0 ) { *temp=0; } //CPU should never be able to reach negative temperatures. If it does we might consider overclocking for more performance. + stats->tempSum[stats->last_index] += *temp; + } + spin_unlock(&cpufreq_stats_lock); return 0; } static ssize_t show_total_trans(struct cpufreq_policy *policy, char *buf) { - struct cpufreq_stats *stat = per_cpu(cpufreq_stats_table, policy->cpu); - if (!stat) - return 0; - return sprintf(buf, "%d\n", - per_cpu(cpufreq_stats_table, stat->cpu)->total_trans); + return sprintf(buf, "%d\n", policy->stats->total_trans); } +ssize_t store_time_in_state(struct cpufreq_policy *policy, const char *buf, size_t count) +{ + + struct cpufreq_stats *stats = policy->stats; + + if (!stats) + return -EIO; + + //clear the current statistics + memset( stats->time_in_state, + 0, + stats->max_state * sizeof( *(stats->time_in_state) ) ); + memset( stats->tempMax, + 0, + stats->max_state * sizeof( *(stats->tempMax) ) ); + memset( stats->tempMin, + 0, + stats->max_state * sizeof( *(stats->tempMin) ) ); + memset( stats->tempCount, + 0, + stats->max_state * sizeof( *(stats->tempCount) ) ); + memset( stats->tempSum, + 0, + stats->max_state * sizeof( *(stats->tempSum) ) ); + + return count; +} + + static ssize_t show_time_in_state(struct cpufreq_policy *policy, char *buf) { + struct cpufreq_stats *stats = policy->stats; ssize_t len = 0; int i; - struct cpufreq_stats *stat = per_cpu(cpufreq_stats_table, policy->cpu); - if (!stat) - return 0; - cpufreq_stats_update(stat->cpu); - for (i = 0; i < stat->state_num; i++) { - len += sprintf(buf + len, "%u %llu\n", stat->freq_table[i], - (unsigned long long) - jiffies_64_to_clock_t(stat->time_in_state[i])); + int temp = -1337; + + if (TemperatureSensorGetCurrentTemp(0, NULL, &temp)) { + printk(KERN_ERR "Could not get KPI temperature."); + cpufreq_stats_update(stats, 0); + } else { + cpufreq_stats_update(stats, &temp); + } + + len += sprintf(buf + len, "{Frequency TimeInFrequencyState " + "TemperatureMin(1/10 °) TemperatureSum(1/10 °) " + "TemperatureMeasurements TemperatureMax(1/10 °)}" + "[%d]:\n", stats->state_num); + + + for (i = 0; i < stats->state_num; i++) { + if( stats->tempCount[i] == 0 ) { + len += sprintf(buf + len, "%u %llu none none " + "none none ", stats->freq_table[i], + (unsigned long long) + cputime64_to_clock_t( + stats->time_in_state[i]) + ); + } else if(stats->tempCount[i]==TEMPCOUNT_MAX) { + len += sprintf(buf + len, "%u %llu %d overflow " + "overflow %d ", stats->freq_table[i], + (unsigned long long) + cputime64_to_clock_t( + stats->time_in_state[i]), + stats->tempMin[i], + stats->tempMax[i] + ); + } else { + len += sprintf(buf + len, "%u %llu %d %llu %u %d ", + stats->freq_table[i], + (unsigned long long) + cputime64_to_clock_t(stats->time_in_state[i]), + stats->tempMin[i], + stats->tempSum[i], + stats->tempCount[i], + stats->tempMax[i] + ); + } } + + len += sprintf(buf + len, "\n"); + return len; } #ifdef CONFIG_CPU_FREQ_STAT_DETAILS static ssize_t show_trans_table(struct cpufreq_policy *policy, char *buf) { + struct cpufreq_stats *stats = policy->stats; ssize_t len = 0; int i, j; + int temp = -1337; + + if (TemperatureSensorGetCurrentTemp(0, NULL, &temp)) { + printk(KERN_ERR "Could not get KPI temperature."); + cpufreq_stats_update(stats, 0); + } else { + cpufreq_stats_update(stats, &temp); + } - struct cpufreq_stats *stat = per_cpu(cpufreq_stats_table, policy->cpu); - if (!stat) - return 0; - cpufreq_stats_update(stat->cpu); len += snprintf(buf + len, PAGE_SIZE - len, " From : To\n"); len += snprintf(buf + len, PAGE_SIZE - len, " : "); - for (i = 0; i < stat->state_num; i++) { + for (i = 0; i < stats->state_num; i++) { if (len >= PAGE_SIZE) break; len += snprintf(buf + len, PAGE_SIZE - len, "%9u ", - stat->freq_table[i]); + stats->freq_table[i]); } if (len >= PAGE_SIZE) return PAGE_SIZE; len += snprintf(buf + len, PAGE_SIZE - len, "\n"); - for (i = 0; i < stat->state_num; i++) { + for (i = 0; i < stats->state_num; i++) { if (len >= PAGE_SIZE) break; len += snprintf(buf + len, PAGE_SIZE - len, "%9u: ", - stat->freq_table[i]); + stats->freq_table[i]); - for (j = 0; j < stat->state_num; j++) { + for (j = 0; j < stats->state_num; j++) { if (len >= PAGE_SIZE) break; len += snprintf(buf + len, PAGE_SIZE - len, "%9u ", - stat->trans_table[i*stat->max_state+j]); + stats->trans_table[i*stats->max_state+j]); } if (len >= PAGE_SIZE) break; @@ -134,7 +206,7 @@ #endif cpufreq_freq_attr_ro(total_trans); -cpufreq_freq_attr_ro(time_in_state); +cpufreq_freq_attr_rw(time_in_state); static struct attribute *default_attrs[] = { &total_trans.attr, @@ -149,227 +221,224 @@ .name = "stats" }; -static int freq_table_get_index(struct cpufreq_stats *stat, unsigned int freq) +static int freq_table_get_index(struct cpufreq_stats *stats, unsigned int freq) { int index; - for (index = 0; index < stat->max_state; index++) - if (stat->freq_table[index] == freq) + for (index = 0; index < stats->max_state; index++) + if (stats->freq_table[index] == freq) return index; return -1; } -/* should be called late in the CPU removal sequence so that the stats - * memory is still available in case someone tries to use it. - */ -static void cpufreq_stats_free_table(unsigned int cpu) +static void __cpufreq_stats_free_table(struct cpufreq_policy *policy) { - struct cpufreq_stats *stat = per_cpu(cpufreq_stats_table, cpu); + struct cpufreq_stats *stats = policy->stats; - if (stat) { - pr_debug("%s: Free stat table\n", __func__); - kfree(stat->time_in_state); - kfree(stat); - per_cpu(cpufreq_stats_table, cpu) = NULL; - } + /* Already freed */ + if (!stats) + return; + + pr_debug("%s: Free stats table\n", __func__); + + sysfs_remove_group(&policy->kobj, &stats_attr_group); + kfree(stats->time_in_state); + kfree(stats); + policy->stats = NULL; } -/* must be called early in the CPU removal sequence (before - * cpufreq_remove_dev) so that policy is still valid. - */ -static void cpufreq_stats_free_sysfs(unsigned int cpu) +static void cpufreq_stats_free_table(unsigned int cpu) { - struct cpufreq_policy *policy = cpufreq_cpu_get(cpu); + struct cpufreq_policy *policy; + policy = cpufreq_cpu_get(cpu); if (!policy) return; - if (!cpufreq_frequency_get_table(cpu)) - goto put_ref; + __cpufreq_stats_free_table(policy); - if (!policy_is_shared(policy)) { - pr_debug("%s: Free sysfs stat\n", __func__); - sysfs_remove_group(&policy->kobj, &stats_attr_group); - } - -put_ref: cpufreq_cpu_put(policy); } -static int cpufreq_stats_create_table(struct cpufreq_policy *policy, - struct cpufreq_frequency_table *table) +static int __cpufreq_stats_create_table(struct cpufreq_policy *policy) { - unsigned int i, j, count = 0, ret = 0; - struct cpufreq_stats *stat; - struct cpufreq_policy *data; + unsigned int i = 0, count = 0, ret = -ENOMEM; + struct cpufreq_stats *stats; unsigned int alloc_size; unsigned int cpu = policy->cpu; - if (per_cpu(cpufreq_stats_table, cpu)) - return -EBUSY; - stat = kzalloc(sizeof(struct cpufreq_stats), GFP_KERNEL); - if ((stat) == NULL) - return -ENOMEM; + struct cpufreq_frequency_table *pos, *table; - data = cpufreq_cpu_get(cpu); - if (data == NULL) { - ret = -EINVAL; - goto error_get_fail; - } + /* We need cpufreq table for creating stats table */ + table = cpufreq_frequency_get_table(cpu); + if (unlikely(!table)) + return 0; - ret = sysfs_create_group(&data->kobj, &stats_attr_group); - if (ret) - goto error_out; + /* stats already initialized */ + if (policy->stats) + return -EEXIST; - stat->cpu = cpu; - per_cpu(cpufreq_stats_table, cpu) = stat; + stats = kzalloc(sizeof(*stats), GFP_KERNEL); + if (!stats) + return -ENOMEM; - for (i = 0; table[i].frequency != CPUFREQ_TABLE_END; i++) { - unsigned int freq = table[i].frequency; - if (freq == CPUFREQ_ENTRY_INVALID) - continue; + /* Find total allocation size */ + cpufreq_for_each_valid_entry(pos, table) count++; - } alloc_size = count * sizeof(int) + count * sizeof(u64); #ifdef CONFIG_CPU_FREQ_STAT_DETAILS alloc_size += count * count * sizeof(int); #endif - stat->max_state = count; - stat->time_in_state = kzalloc(alloc_size, GFP_KERNEL); - if (!stat->time_in_state) { + stats->max_state = count; + + //add space for the current temperature statistics + + alloc_size += count * sizeof( *(stats->tempMax) ); + alloc_size += count * sizeof( *(stats->tempSum) ); + alloc_size += count * sizeof( *(stats->tempMin) ); + alloc_size += count * sizeof( *(stats->tempCount) ); + + stats->time_in_state = kzalloc(alloc_size, GFP_KERNEL); + if (!stats->time_in_state) { ret = -ENOMEM; - goto error_out; + goto free_stat; } - stat->freq_table = (unsigned int *)(stat->time_in_state + count); + + //poke current temperature statistics out of the allocated chunk + stats->tempMax = (int *)(stats->time_in_state + count); + stats->tempSum = (u64 *)(stats->tempMax + count); + stats->tempMin = (int *)(stats->tempSum + count); + stats->tempCount = (u32 *)(stats->tempMin + count); + + stats->freq_table = (unsigned int *)(stats->tempCount + count); + + /* Allocate memory for time_in_state/freq_table/trans_table in one go */ + stats->time_in_state = kzalloc(alloc_size, GFP_KERNEL); + if (!stats->time_in_state) + goto free_stat; + + stats->freq_table = (unsigned int *)(stats->time_in_state + count); #ifdef CONFIG_CPU_FREQ_STAT_DETAILS - stat->trans_table = stat->freq_table + count; + stats->trans_table = stats->freq_table + count; #endif - j = 0; - for (i = 0; table[i].frequency != CPUFREQ_TABLE_END; i++) { - unsigned int freq = table[i].frequency; - if (freq == CPUFREQ_ENTRY_INVALID) - continue; - if (freq_table_get_index(stat, freq) == -1) - stat->freq_table[j++] = freq; - } - stat->state_num = j; - spin_lock(&cpufreq_stats_lock); - stat->last_time = get_jiffies_64(); - stat->last_index = freq_table_get_index(stat, policy->cur); - spin_unlock(&cpufreq_stats_lock); - cpufreq_cpu_put(data); - return 0; -error_out: - cpufreq_cpu_put(data); -error_get_fail: - kfree(stat); - per_cpu(cpufreq_stats_table, cpu) = NULL; + + stats->max_state = count; + + /* Find valid-unique entries */ + cpufreq_for_each_valid_entry(pos, table) + if (freq_table_get_index(stats, pos->frequency) == -1) + stats->freq_table[i++] = pos->frequency; + + stats->state_num = i; + stats->last_time = get_jiffies_64(); + stats->last_index = freq_table_get_index(stats, policy->cur); + + policy->stats = stats; + ret = sysfs_create_group(&policy->kobj, &stats_attr_group); + if (!ret) + return 0; + + /* We failed, release resources */ + policy->stats = NULL; + kfree(stats->time_in_state); +free_stat: + kfree(stats); + return ret; } -static void cpufreq_stats_update_policy_cpu(struct cpufreq_policy *policy) +static void cpufreq_stats_create_table(unsigned int cpu) { - struct cpufreq_stats *stat = per_cpu(cpufreq_stats_table, - policy->last_cpu); + struct cpufreq_policy *policy; + + /* + * "likely(!policy)" because normally cpufreq_stats will be registered + * before cpufreq driver + */ + policy = cpufreq_cpu_get(cpu); + if (likely(!policy)) + return; - pr_debug("Updating stats_table for new_cpu %u from last_cpu %u\n", - policy->cpu, policy->last_cpu); - per_cpu(cpufreq_stats_table, policy->cpu) = per_cpu(cpufreq_stats_table, - policy->last_cpu); - per_cpu(cpufreq_stats_table, policy->last_cpu) = NULL; - stat->cpu = policy->cpu; + __cpufreq_stats_create_table(policy); + + cpufreq_cpu_put(policy); } static int cpufreq_stat_notifier_policy(struct notifier_block *nb, unsigned long val, void *data) { - int ret; + int ret = 0; struct cpufreq_policy *policy = data; - struct cpufreq_frequency_table *table; - unsigned int cpu = policy->cpu; - if (val == CPUFREQ_UPDATE_POLICY_CPU) { - cpufreq_stats_update_policy_cpu(policy); - return 0; - } + if (val == CPUFREQ_CREATE_POLICY) + ret = __cpufreq_stats_create_table(policy); + else if (val == CPUFREQ_REMOVE_POLICY) + __cpufreq_stats_free_table(policy); - if (val != CPUFREQ_NOTIFY) - return 0; - table = cpufreq_frequency_get_table(cpu); - if (!table) - return 0; - ret = cpufreq_stats_create_table(policy, table); - if (ret) - return ret; - return 0; + return ret; } static int cpufreq_stat_notifier_trans(struct notifier_block *nb, unsigned long val, void *data) { struct cpufreq_freqs *freq = data; - struct cpufreq_stats *stat; + struct cpufreq_policy *policy = cpufreq_cpu_get(freq->cpu); + struct cpufreq_stats *stats; int old_index, new_index; + int temp = -1337; - if (val != CPUFREQ_POSTCHANGE) + if (!policy) { + pr_err("%s: No policy found\n", __func__); return 0; + } - stat = per_cpu(cpufreq_stats_table, freq->cpu); - if (!stat) - return 0; - old_index = stat->last_index; - new_index = freq_table_get_index(stat, freq->new); + if (val != CPUFREQ_POSTCHANGE) + goto put_policy; + + if (!policy->stats) { + pr_debug("%s: No stats found\n", __func__); + goto put_policy; + } + + stats = policy->stats; - /* We can't do stat->time_in_state[-1]= .. */ - if (old_index == -1 || new_index == -1) + if (val == CPUFREQ_NOCHANGE) { + if (TemperatureSensorGetCurrentTemp(0, NULL, &temp)) { + cpufreq_stats_update(stats, 0); + } else { + cpufreq_stats_update(stats, &temp); + } return 0; + } - cpufreq_stats_update(freq->cpu); + old_index = stats->last_index; + new_index = freq_table_get_index(stats, freq->new); if (old_index == new_index) - return 0; + goto put_policy; - spin_lock(&cpufreq_stats_lock); - stat->last_index = new_index; + if (TemperatureSensorGetCurrentTemp(0, NULL, &temp)) { + cpufreq_stats_update(stats, 0); + } else { + cpufreq_stats_update(stats, &temp); + } + + stats->last_index = new_index; #ifdef CONFIG_CPU_FREQ_STAT_DETAILS - stat->trans_table[old_index * stat->max_state + new_index]++; + /* From old_index ... to new_index */ + if (old_index >= 0 && new_index >= 0) { + stat->trans_table[old_index * stat->max_state + new_index]++; + } #endif - stat->total_trans++; - spin_unlock(&cpufreq_stats_lock); - return 0; -} + stats->total_trans++; -static int __cpuinit cpufreq_stat_cpu_callback(struct notifier_block *nfb, - unsigned long action, - void *hcpu) -{ - unsigned int cpu = (unsigned long)hcpu; - - switch (action) { - case CPU_ONLINE: - case CPU_ONLINE_FROZEN: - cpufreq_update_policy(cpu); - break; - case CPU_DOWN_PREPARE: - case CPU_DOWN_PREPARE_FROZEN: - cpufreq_stats_free_sysfs(cpu); - break; - case CPU_DEAD: - case CPU_DEAD_FROZEN: - cpufreq_stats_free_table(cpu); - break; - } - return NOTIFY_OK; +put_policy: + cpufreq_cpu_put(policy); + return 0; } -/* priority=1 so this will get called before cpufreq_remove_dev */ -static struct notifier_block cpufreq_stat_cpu_notifier __refdata = { - .notifier_call = cpufreq_stat_cpu_callback, - .priority = 1, -}; - static struct notifier_block notifier_policy_block = { .notifier_call = cpufreq_stat_notifier_policy }; @@ -389,16 +458,14 @@ if (ret) return ret; - register_hotcpu_notifier(&cpufreq_stat_cpu_notifier); for_each_online_cpu(cpu) - cpufreq_update_policy(cpu); + cpufreq_stats_create_table(cpu); ret = cpufreq_register_notifier(¬ifier_trans_block, CPUFREQ_TRANSITION_NOTIFIER); if (ret) { cpufreq_unregister_notifier(¬ifier_policy_block, CPUFREQ_POLICY_NOTIFIER); - unregister_hotcpu_notifier(&cpufreq_stat_cpu_notifier); for_each_online_cpu(cpu) cpufreq_stats_free_table(cpu); return ret; @@ -414,16 +481,12 @@ CPUFREQ_POLICY_NOTIFIER); cpufreq_unregister_notifier(¬ifier_trans_block, CPUFREQ_TRANSITION_NOTIFIER); - unregister_hotcpu_notifier(&cpufreq_stat_cpu_notifier); - for_each_online_cpu(cpu) { + for_each_online_cpu(cpu) cpufreq_stats_free_table(cpu); - cpufreq_stats_free_sysfs(cpu); - } } MODULE_AUTHOR("Zou Nan hai "); -MODULE_DESCRIPTION("'cpufreq_stats' - A driver to export cpufreq stats " - "through sysfs filesystem"); +MODULE_DESCRIPTION("Export cpufreq stats via sysfs"); MODULE_LICENSE("GPL"); module_init(cpufreq_stats_init);