Nyaaori/rockbox
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity
rockbox/firmware/target/hosted/cpuinfo-linux.c
Amaury Pouly 4382f8773e cleanup linux cpuinfo code 
sonynwz: quirk for cpufreq broken driver

There was some redundancy between frequency_linux(cpu, true) and
current_scaling_frequency(), also I see no reason to compile the cpuinfo stuff
unconditionally and the scaling info only on DX since it was already printed
some partial scaling info anyway. Thus compile all the code unconditionally
and simplify the logic in the debug menu. Also avoid putting buffers of size
PATH_MAX on stack since it can be quite big and we only requires 64 bytes
for those paths.

On Sony NWZ, the cpu driver reports frequency in MHz instead of kHz thus we need
to make the cpuinfo code aware of that bug.

Change-Id: I61af45ab5f179ecc909b4841b9137a915a60193a
2017-10-06 18:31:35 +02:00

319 lines
8.1 KiB
C
Raw Blame History

/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id$
*
* Copyright (C) 2011 Thomas Martitz
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version 2
* of the License, or (at your option) any later version.
*
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
* KIND, either express or implied.
*
****************************************************************************/
#include <sys/times.h>
#include <sys/sysinfo.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <time.h>
#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <ctype.h>
#include "kernel.h"
#include "thread.h"
#include "cpuinfo-linux.h"
#include "gcc_extensions.h"
#include <limits.h>
#include <string.h>
#include "debug.h"
#undef open /* want the *real* open here, not sim_open or the like */
#if (CONFIG_PLATFORM & PLATFORM_ANDROID) || defined(DX50) || defined(DX90)
#include "cpu-features.h"
#define get_nprocs android_getCpuCount
#endif
#define NUM_SAMPLES 64
#define NUM_SAMPLES_MASK (NUM_SAMPLES-1)
#define SAMPLE_RATE 4
/* Some targets like the Sony NWZ have a broken cpu driver that reports frequencies in MHz instead
* of kHz */
#if defined(SONY_NWZ_LINUX)
#define FREQ_MULTIPLIER 1000
#else
#define FREQ_MULTIPLIER 1
#endif
struct cputime_sample {
struct tms sample;
time_t time;
};
static struct cputime_sample samples[NUM_SAMPLES];
static int current_sample;
static int samples_taken;
static clock_t initial_time, hz;
static char cputime_thread_stack[DEFAULT_STACK_SIZE + 0x100];
static char cputime_thread_name[] = "cputime";
static int cputime_threadid;
static void cputime_thread(void);
/* times() can return -1 early after boot */
static clock_t times_wrapper(struct tms *t)
{
clock_t res = times(t);
if (res == (clock_t)-1)
res = time(NULL) * hz;
return res;
}
static inline void thread_func(void)
{
struct cputime_sample *s = &samples[current_sample++];
s->time = times_wrapper(&s->sample);
current_sample &= NUM_SAMPLES_MASK;
if (samples_taken < NUM_SAMPLES) samples_taken++;
sleep(HZ/SAMPLE_RATE);
}
static void NORETURN_ATTR cputime_thread(void)
{
while(1)
thread_func();
}
static void __attribute__((constructor)) get_initial_time(void)
{
struct tms ign;
hz = sysconf(_SC_CLK_TCK);
initial_time = times_wrapper(&ign); /* dont pass NULL */;
}
int cpuusage_linux(struct cpuusage* u)
{
if (UNLIKELY(!cputime_threadid))
{
/* collect some initial data and start the thread */
thread_func();
cputime_threadid = create_thread(cputime_thread, cputime_thread_stack,
sizeof(cputime_thread_stack), 0, cputime_thread_name
IF_PRIO(,PRIORITY_BACKGROUND) IF_COP(, CPU));
}
if (!u)
return -1;
clock_t total_cputime;
clock_t diff_utime, diff_stime;
time_t diff_rtime;
int latest_sample = ((current_sample == 0) ? NUM_SAMPLES : current_sample) - 1;
int oldest_sample = (samples_taken < NUM_SAMPLES) ? 0 : current_sample;
diff_utime = samples[latest_sample].sample.tms_utime - samples[oldest_sample].sample.tms_utime;
diff_stime = samples[latest_sample].sample.tms_stime - samples[oldest_sample].sample.tms_stime;
diff_rtime = samples[latest_sample].time - samples[oldest_sample].time;
if (UNLIKELY(!diff_rtime))
diff_rtime = 1;
u->hz = hz;
u->utime = samples[latest_sample].sample.tms_utime;
u->stime = samples[latest_sample].sample.tms_stime;
u->rtime = samples[latest_sample].time - initial_time;
total_cputime = diff_utime + diff_stime;
total_cputime *= 100; /* pump up by 100 for hundredth */
u->usage = total_cputime * 100 / diff_rtime;
return 0;
}
int cpucount_linux(void)
{
return get_nprocs();
}
int frequency_linux(int cpu)
{
char path[64];
char temp[10];
int cpu_dev, ret = -1;
snprintf(path, sizeof(path), "/sys/devices/system/cpu/cpu%d/cpufreq/cpuinfo_cur_freq", cpu);
cpu_dev = open(path, O_RDONLY);
if (cpu_dev < 0)
return -1;
if (read(cpu_dev, temp, sizeof(temp)) >= 0)
ret = atoi(temp) * FREQ_MULTIPLIER;
close(cpu_dev);
return ret;
}
bool current_scaling_governor(int cpu, char* governor, int governor_size)
{
if((cpu < 0) || (governor == NULL) || (governor_size <= 0))
{
return false;
}
char path[64];
snprintf(path,
sizeof(path),
"/sys/devices/system/cpu/cpu%d/cpufreq/scaling_governor",
cpu);
FILE *f = fopen(path, "r");
if(f == NULL)
{
DEBUGF("ERROR %s: Can not open %s for reading.", __func__, path);
return false;
}
if(fgets(governor, governor_size, f) == NULL)
{
DEBUGF("ERROR %s: Read failed for %s.", __func__, path);
fclose(f);
return false;
}
if(strlen(governor) > 0)
{
governor[strlen(governor) - 1] = '\0';
}
fclose(f);
return true;
}
enum cpu_frequency_options
{
SCALING_MIN_FREQ = 0,
SCALING_CUR_FREQ,
SCALING_MAX_FREQ
};
static int read_cpu_frequency(int cpu, enum cpu_frequency_options freqOpt)
{
if(cpu < 0)
{
return -1;
}
char path[64];
switch(freqOpt)
{
case SCALING_MIN_FREQ:
{
snprintf(path,
sizeof(path),
"/sys/devices/system/cpu/cpu%d/cpufreq/scaling_min_freq",
cpu);
break;
}
case SCALING_CUR_FREQ:
{
snprintf(path,
sizeof(path),
"/sys/devices/system/cpu/cpu%d/cpufreq/scaling_cur_freq",
cpu);
break;
}
case SCALING_MAX_FREQ:
{
snprintf(path,
sizeof(path),
"/sys/devices/system/cpu/cpu%d/cpufreq/scaling_max_freq",
cpu);
break;
}
default:
{
DEBUGF("ERROR %s: Unknown CpuFrequencyOptions: %d.", __func__, freqOpt);
return -1;
}
}
FILE *f = fopen(path, "r");
if(f == NULL)
{
DEBUGF("ERROR %s: Can not open %s for reading.", __func__, path);
return -1;
}
int freq;
if(fscanf(f, "%d", &freq) == EOF)
{
DEBUGF("ERROR %s: Read failed for %s.", __func__, path);
freq = -1;
}
fclose(f);
return freq * FREQ_MULTIPLIER;
}
int min_scaling_frequency(int cpu)
{
return(read_cpu_frequency(cpu, SCALING_MIN_FREQ));
}
int current_scaling_frequency(int cpu)
{
return(read_cpu_frequency(cpu, SCALING_CUR_FREQ));
}
int max_scaling_frequency(int cpu)
{
return(read_cpu_frequency(cpu, SCALING_MAX_FREQ));
}
int cpustatetimes_linux(int cpu, struct time_state* data, int max_elements)
{
int elements_left = max_elements, cpu_dev;
char buf[256], path[64], *p;
ssize_t read_size;
snprintf(path, sizeof(path), "/sys/devices/system/cpu/cpu%d/cpufreq/stats/time_in_state", cpu);
cpu_dev = open(path, O_RDONLY);
if (cpu_dev < 0)
return -1;
read_size = read(cpu_dev, buf, sizeof(buf));
close(cpu_dev);
p = buf;
while(elements_left > 0 && (p-buf) < read_size)
{
data->frequency = atol(p);
/* this loop breaks when it seems the space or line-feed,
* so buf points to a number aftwards */
while(isdigit(*p++));
data->time = atol(p);
/* now skip over to the next line */
while(isdigit(*p++));
data++;
elements_left--;
}
return (max_elements - elements_left) ?: -1;
}
Reference in a new issue View git blame Copy permalink