exynos3: power HAL: add support for interactive governor
completely kanged from d2 power HAL
Change-Id: I4f6c32165251ae76c97afb715dde1fee9544430b
diff --git a/exynos3/s5pc110/power/power.c b/exynos3/s5pc110/power/power.c
index 78a9f1e..552c098 100644
--- a/exynos3/s5pc110/power/power.c
+++ b/exynos3/s5pc110/power/power.c
@@ -20,14 +20,15 @@
#include <sys/stat.h>
#include <fcntl.h>
-#define LOG_TAG "PowerHAL"
-#include <cutils/properties.h>
+#define LOG_TAG "S5PC110 PowerHAL"
#include <utils/Log.h>
#include <hardware/hardware.h>
#include <hardware/power.h>
-#define BOOSTPULSE_PATH "/sys/devices/system/cpu/cpufreq/ondemand/boostpulse"
+#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"
struct s5pc110_power_module {
struct power_module base;
@@ -36,21 +37,75 @@
int boostpulse_warned;
};
+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 int get_scaling_governor(char governor[], int size) {
+ if (sysfs_read(SCALING_GOVERNOR_PATH, governor,
+ size) == -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 int boostpulse_open(struct s5pc110_power_module *s5pc110)
{
char buf[80];
+ char governor[80];
pthread_mutex_lock(&s5pc110->lock);
if (s5pc110->boostpulse_fd < 0) {
- s5pc110->boostpulse_fd = open(BOOSTPULSE_PATH, O_WRONLY);
+ if (get_scaling_governor(governor, sizeof(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) {
- if (!s5pc110->boostpulse_warned) {
+ if (s5pc110->boostpulse_fd < 0 && !s5pc110->boostpulse_warned) {
strerror_r(errno, buf, sizeof(buf));
- ALOGE("Error opening %s: %s\n", BOOSTPULSE_PATH, buf);
+ ALOGE("Error opening %s boostpulse interface: %s\n", governor, buf);
s5pc110->boostpulse_warned = 1;
- }
+ } else if (s5pc110->boostpulse_fd > 0)
+ ALOGD("Opened %s boostpulse interface", governor);
}
}
@@ -78,7 +133,13 @@
if (len < 0) {
strerror_r(errno, buf, sizeof(buf));
- ALOGE("Error writing to %s: %s\n", BOOSTPULSE_PATH, 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;