Revert "Revert "device: Disable hispeed_freq while screen is off""

This reverts commit fb368f8877e88eb9189977d7b55187853930dbd0.

Change-Id: Ieffc30b93cea0e5e7618f193c363173ef7aa8ad8

2 files changed, 102 insertions, 0 deletions

diff --git a/BoardConfigCommon.mk b/BoardConfigCommon.mk
index 124d2e8..4b543da 100644
--- a/BoardConfigCommon.mk
+++ b/BoardConfigCommon.mk
@@ -138,3 +138,4 @@ TARGET_USE_CUSTOM_LUN_FILE_PATH := /sys/devices/platform/msm_hsusb/gadget/lun%d/
 
 # Build our own PowerHAL
 TARGET_POWERHAL_VARIANT :=
+TARGET_POWERHAL_SET_INTERACTIVE_EXT := device/samsung/msm8960-common/power/power_ext.c
diff --git a/power/power_ext.c b/power/power_ext.c
new file mode 100644
index 0000000..6d15fca
--- /dev/null
+++ b/power/power_ext.c
@@ -0,0 +1,101 @@
+/*
+ * Copyright (c) 2015 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 <fcntl.h>
+#include <utils/Log.h>
+
+#define NODE_MAX 64
+
+#define GO_HISPEED_LOAD_PATH "/sys/devices/system/cpu/cpufreq/interactive/go_hispeed_load"
+#define OFF_HIGHSPEED_LOAD 110
+
+static int go_hispeed_load = 0;
+static int off_hispeed_load = OFF_HIGHSPEED_LOAD;
+
+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 reading %s: %s\n", path, buf);
+
+        ret = -1;
+    } else {
+        s[count] = '\0';
+    }
+
+    close(fd);
+
+    return ret;
+}
+
+static int sysfs_write(char *path, char *s)
+{
+    char buf[80];
+    int len;
+    int ret = 0;
+    int fd = open(path, O_WRONLY);
+
+    if (fd < 0) {
+        strerror_r(errno, buf, sizeof(buf));
+        ALOGE("Error opening %s: %s\n", path, buf);
+
+        return -1;
+    }
+
+    len = write(fd, s, strlen(s));
+    if (len < 0) {
+        strerror_r(errno, buf, sizeof(buf));
+        ALOGE("Error writing to %s: %s\n", path, buf);
+
+        ret = -1;
+    }
+
+    close(fd);
+
+    return ret;
+}
+
+void cm_power_set_interactive_ext(int on)
+{
+    char tmp_str[NODE_MAX];
+    int tmp;
+
+    if (sysfs_read(GO_HISPEED_LOAD_PATH, tmp_str, NODE_MAX - 1)) {
+        return;
+    }
+
+    tmp = atoi(tmp_str);
+    if (!go_hispeed_load || (go_hispeed_load != tmp && off_hispeed_load != tmp)) {
+        go_hispeed_load = tmp;
+    }
+
+    snprintf(tmp_str, NODE_MAX, "%d", on ? go_hispeed_load : off_hispeed_load);
+    sysfs_write(GO_HISPEED_LOAD_PATH, tmp_str);
+}