/* * 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 #include #include #include #include #define LOG_TAG "PowerHAL" #include #include #include #include #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; pthread_mutex_t lock; int boostpulse_fd; 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 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(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) { 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 && !s5pc110->boostpulse_warned) { strerror_r(errno, buf, sizeof(buf)); ALOGE("Error opening boostpulse: %s\n", buf); s5pc110->boostpulse_warned = 1; } else if (s5pc110->boostpulse_fd > 0) 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_set_interactive(struct power_module *module, int on) { return; } static void s5pc110_power_init(struct power_module *module) { return; } 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 Android Open Source 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, };