You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

232 lines
6.6 KiB

/*
* Copyright (C) 2012 The Android Open Source Project
* Copyright (C) 2012 The CyanogenMod Project
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#include <errno.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#define LOG_TAG "S5PC110 PowerHAL"
#include <utils/Log.h>
#include <hardware/hardware.h>
#include <hardware/power.h>
#define SCALING_GOVERNOR_PATH "/sys/devices/system/cpu/cpu0/cpufreq/scaling_governor"
#define BOOSTPULSE_ONDEMAND "/sys/devices/system/cpu/cpufreq/ondemand/boostpulse"
#define BOOSTPULSE_INTERACTIVE "/sys/devices/system/cpu/cpufreq/interactive/boostpulse"
#define TIMER_RATE_SCREEN_ON "30000"
#define TIMER_RATE_SCREEN_OFF "150000"
struct s5pc110_power_module {
struct power_module base;
pthread_mutex_t lock;
int boostpulse_fd;
int boostpulse_warned;
};
static char governor[20];
static int sysfs_read(char *path, char *s, int num_bytes)
{
char buf[80];
int count;
int ret = 0;
int fd = open(path, O_RDONLY);
if (fd < 0) {
strerror_r(errno, buf, sizeof(buf));
ALOGE("Error opening %s: %s\n", path, buf);
return -1;
}
if ((count = read(fd, s, num_bytes - 1)) < 0) {
strerror_r(errno, buf, sizeof(buf));
ALOGE("Error writing to %s: %s\n", path, buf);
ret = -1;
} else {
s[count] = '\0';
}
close(fd);
return ret;
}
static void sysfs_write(char *path, char *s)
{
char buf[80];
int len;
int fd = open(path, O_WRONLY);
if (fd < 0) {
strerror_r(errno, buf, sizeof(buf));
ALOGE("Error opening %s: %s\n", path, buf);
return;
}
len = write(fd, s, strlen(s));
if (len < 0) {
strerror_r(errno, buf, sizeof(buf));
ALOGE("Error writing to %s: %s\n", path, buf);
}
close(fd);
}
static int get_scaling_governor() {
if (sysfs_read(SCALING_GOVERNOR_PATH, governor,
sizeof(governor)) == -1) {
// Can't obtain the scaling governor. Return.
return -1;
} else {
// Strip newline at the end.
int len = strlen(governor);
len--;
while (len >= 0 && (governor[len] == '\n' || governor[len] == '\r'))
governor[len--] = '\0';
}
return 0;
}
static void s5pc110_power_set_interactive(struct power_module *module, int on)
{
if (strncmp(governor, "interactive", 11) == 0)
sysfs_write("/sys/devices/system/cpu/cpufreq/interactive/timer_rate",
on ? TIMER_RATE_SCREEN_ON : TIMER_RATE_SCREEN_OFF);
}
static void configure_governor()
{
s5pc110_power_set_interactive(NULL, 1);
if (strncmp(governor, "ondemand", 8) == 0) {
sysfs_write("/sys/devices/system/cpu/cpufreq/ondemand/up_threshold", "95");
sysfs_write("/sys/devices/system/cpu/cpufreq/ondemand/io_is_busy", "1");
sysfs_write("/sys/devices/system/cpu/cpufreq/ondemand/sampling_down_factor", "4");
} else if (strncmp(governor, "interactive", 11) == 0) {
sysfs_write("/sys/devices/system/cpu/cpufreq/interactive/min_sample_time", "90000");
sysfs_write("/sys/devices/system/cpu/cpufreq/interactive/above_hispeed_delay", "30000");
}
}
static int boostpulse_open(struct s5pc110_power_module *s5pc110)
{
char buf[80];
pthread_mutex_lock(&s5pc110->lock);
if (s5pc110->boostpulse_fd < 0) {
if (get_scaling_governor() < 0) {
ALOGE("Can't read scaling governor.");
s5pc110->boostpulse_warned = 1;
} else {
if (strncmp(governor, "ondemand", 8) == 0)
s5pc110->boostpulse_fd = open(BOOSTPULSE_ONDEMAND, O_WRONLY);
else if (strncmp(governor, "interactive", 11) == 0)
s5pc110->boostpulse_fd = open(BOOSTPULSE_INTERACTIVE, O_WRONLY);
if (s5pc110->boostpulse_fd < 0 && !s5pc110->boostpulse_warned) {
strerror_r(errno, buf, sizeof(buf));
ALOGE("Error opening %s boostpulse interface: %s\n", governor, buf);
s5pc110->boostpulse_warned = 1;
} else if (s5pc110->boostpulse_fd > 0) {
configure_governor();
ALOGD("Opened %s boostpulse interface", governor);
}
}
}
pthread_mutex_unlock(&s5pc110->lock);
return s5pc110->boostpulse_fd;
}
static void s5pc110_power_hint(struct power_module *module, power_hint_t hint,
void *data)
{
struct s5pc110_power_module *s5pc110 = (struct s5pc110_power_module *) module;
char buf[80];
int len;
int duration = 1;
switch (hint) {
case POWER_HINT_INTERACTION:
case POWER_HINT_CPU_BOOST:
if (boostpulse_open(s5pc110) >= 0) {
if (data != NULL)
duration = (int) data;
snprintf(buf, sizeof(buf), "%d", duration);
len = write(s5pc110->boostpulse_fd, buf, strlen(buf));
if (len < 0) {
strerror_r(errno, buf, sizeof(buf));
ALOGE("Error writing to boostpulse: %s\n", buf);
pthread_mutex_lock(&s5pc110->lock);
close(s5pc110->boostpulse_fd);
s5pc110->boostpulse_fd = -1;
s5pc110->boostpulse_warned = 0;
pthread_mutex_unlock(&s5pc110->lock);
}
}
break;
case POWER_HINT_VSYNC:
break;
default:
break;
}
}
static void s5pc110_power_init(struct power_module *module)
{
get_scaling_governor();
configure_governor();
}
static struct hw_module_methods_t power_module_methods = {
.open = NULL,
};
struct s5pc110_power_module HAL_MODULE_INFO_SYM = {
base: {
common: {
tag: HARDWARE_MODULE_TAG,
module_api_version: POWER_MODULE_API_VERSION_0_2,
hal_api_version: HARDWARE_HAL_API_VERSION,
id: POWER_HARDWARE_MODULE_ID,
name: "S5PC110 Power HAL",
author: "The CyanogenMod Project",
methods: &power_module_methods,
},
init: s5pc110_power_init,
setInteractive: s5pc110_power_set_interactive,
powerHint: s5pc110_power_hint,
},
lock: PTHREAD_MUTEX_INITIALIZER,
boostpulse_fd: -1,
boostpulse_warned: 0,
};