Fixed thermal HAL, added thresholds, skin temperature.

Bug: 27424857
Change-Id: I575c27309e5b71ecbd5c0e653a82a4e7dc2ffbb7

2 files changed, 309 insertions, 0 deletions

diff --git a/thermal/Android.mk b/thermal/Android.mk
new file mode 100644
index 0000000..69482db
--- /dev/null
+++ b/thermal/Android.mk
@@ -0,0 +1,26 @@
+#
+# Copyright 2016 The Android Open Source 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.
+#
+
+LOCAL_PATH := $(call my-dir)
+
+include $(CLEAR_VARS)
+LOCAL_CFLAGS := -Wno-unused-parameter
+LOCAL_MODULE_RELATIVE_PATH := hw
+LOCAL_SRC_FILES := thermal.c
+LOCAL_SHARED_LIBRARIES := liblog libcutils
+LOCAL_MODULE_TAGS := optional
+LOCAL_MODULE := thermal.bullhead
+include $(BUILD_SHARED_LIBRARY)
diff --git a/thermal/thermal.c b/thermal/thermal.c
new file mode 100644
index 0000000..e1628f7
--- /dev/null
+++ b/thermal/thermal.c
@@ -0,0 +1,283 @@
+/*
+ * Copyright (C) 2016 The Android Open Source 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 <ctype.h>
+#include <errno.h>
+#include <inttypes.h>
+#include <stdlib.h>
+#include <string.h>
+
+#define LOG_TAG "ThermalHAL"
+#include <utils/Log.h>
+
+#include <hardware/hardware.h>
+#include <hardware/thermal.h>
+
+#define MAX_LENGTH                      50
+
+#define CPU_USAGE_FILE                  "/proc/stat"
+#define TEMPERATURE_FILE_FORMAT         "/sys/class/thermal/thermal_zone%d/temp"
+#define SKIN_TEMPERATURE_FILE           "/sys/class/hwmon/hwmon2/device/xo_therm"
+#define SKIN_TEMPERATURE_FORMAT         "Result:%f Raw:%*d\n"
+#define CPU_ONLINE_FILE_FORMAT          "/sys/devices/system/cpu/cpu%d/online"
+
+#define BATTERY_SENSOR_NUM              1
+#define GPU_SENSOR_NUM                  12
+
+const int CPU_SENSORS[] = {8, 8, 9, 10, 13, 14};
+
+#define CPU_NUM                         (sizeof(CPU_SENSORS) / sizeof(int))
+#define TEMPERATURE_NUM                 9
+
+// qcom, therm-reset-temp
+#define CPU_SHUTDOWN_THRESHOLD          115
+//qcom, limit-temp
+#define CPU_THROTTLING_THRESHOLD        60
+
+#define BATTERY_SHUTDOWN_THRESHOLD      60
+// vendor/lge/bullhead/proprietary/thermal-engine/thermal-engine-8992.conf
+#define SKIN_THROTTLING_THRESHOLD       37
+
+#define GPU_LABEL                       "GPU"
+#define BATTERY_LABEL                   "battery"
+#define SKIN_LABEL                      "skin"
+
+const char *CPU_LABEL[] = {"CPU0", "CPU1", "CPU2", "CPU3", "CPU4", "CPU5"};
+
+/**
+ * Reads device temperature.
+ *
+ * @param file_name Name of file with temperature.
+ * @param temperature_format Format of temperature file.
+ * @param type Device temperature type.
+ * @param name Device temperature name.
+ * @param mult Multiplier used to translate temperature to Celsius.
+ * @param throttling_threshold Throttling threshold for the temperature.
+ * @param shutdown_threshold Shutdown threshold for the temperature.
+ * @param out Pointer to temperature_t structure that will be filled with current values.
+ *
+ * @return 0 on success or negative value -errno on error.
+ */
+static ssize_t read_temperature(const char *file_name, const char *temperature_format, int type,
+        const char *name, float mult, float throttling_threshold, float shutdown_threshold,
+        temperature_t *out) {
+    FILE *file;
+    float temp;
+
+    file = fopen(file_name, "r");
+    if (file == NULL) {
+        ALOGE("%s: failed to open: %s", __func__, strerror(errno));
+        return -errno;
+    }
+    if (1 != fscanf(file, temperature_format, &temp)) {
+        fclose(file);
+        ALOGE("%s: failed to read a float: %s", __func__, strerror(errno));
+        return errno ? -errno : -EIO;
+    }
+
+    fclose(file);
+
+    (*out) = (temperature_t) {
+        .type = type,
+        .name = name,
+        .current_value = temp * mult,
+        .throttling_threshold = throttling_threshold,
+        .shutdown_threshold = shutdown_threshold
+    };
+
+    return 0;
+}
+
+static ssize_t get_cpu_temperatures(temperature_t *list, size_t size) {
+    size_t cpu;
+
+    for (cpu = 0; cpu < CPU_NUM; cpu++) {
+        char file_name[MAX_LENGTH];
+
+        if (cpu >= size) {
+            break;
+        }
+
+        sprintf(file_name, TEMPERATURE_FILE_FORMAT, CPU_SENSORS[cpu]);
+        // tsens_tz_sensor[7, 7, 9, 10, 13, 14]: temperature in Celsius.
+        ssize_t result = read_temperature(file_name, "%f", DEVICE_TEMPERATURE_CPU, CPU_LABEL[cpu],
+                1, CPU_THROTTLING_THRESHOLD, CPU_SHUTDOWN_THRESHOLD, &list[cpu]);
+        if (result != 0) {
+            return result;
+        }
+    }
+    return cpu;
+}
+
+static ssize_t get_temperatures(thermal_module_t *module, temperature_t *list, size_t size) {
+    ssize_t result = 0;
+    size_t current_index = 0;
+    char file_name[MAX_LENGTH];
+
+    if (list == NULL) {
+        return TEMPERATURE_NUM;
+    }
+
+    result = get_cpu_temperatures(list, size);
+    if (result < 0) {
+        return result;
+    }
+    current_index += result;
+
+    // GPU temperautre.
+    if (current_index < size) {
+        // tsens_tz_sensor12: temperature in Celsius.
+        sprintf(file_name, TEMPERATURE_FILE_FORMAT, GPU_SENSOR_NUM);
+        result = read_temperature(file_name, "%f", DEVICE_TEMPERATURE_GPU, GPU_LABEL, 1,
+                UNKNOWN_TEMPERATURE, UNKNOWN_TEMPERATURE, &list[current_index]);
+        if (result != 0) {
+            return result;
+        }
+        current_index++;
+    }
+
+    // Battery temperautre.
+    if (current_index < size) {
+        // hwmon sensor: battery: temperature in millidegrees Celsius.
+        sprintf(file_name, TEMPERATURE_FILE_FORMAT, BATTERY_SENSOR_NUM);
+        result = read_temperature(file_name, "%f", DEVICE_TEMPERATURE_BATTERY, BATTERY_LABEL,
+                0.001, UNKNOWN_TEMPERATURE, BATTERY_SHUTDOWN_THRESHOLD, &list[current_index]);
+        if (result != 0) {
+            return result;
+        }
+        current_index++;
+    }
+
+    // Skin temperature.
+    if (current_index < size) {
+        // xo_therm: temperature in Celsius.
+        result = read_temperature(SKIN_TEMPERATURE_FILE, SKIN_TEMPERATURE_FORMAT,
+                DEVICE_TEMPERATURE_SKIN, SKIN_LABEL, 1, SKIN_THROTTLING_THRESHOLD,
+                UNKNOWN_TEMPERATURE, &list[current_index]);
+        if (result != 0) {
+            return result;
+        }
+        current_index++;
+    }
+    return TEMPERATURE_NUM;
+}
+
+static ssize_t get_cpu_usages(thermal_module_t *module, cpu_usage_t *list) {
+    int vals, cpu_num, online;
+    ssize_t read;
+    uint64_t user, nice, system, idle, active, total;
+    char *line = NULL;
+    size_t len = 0;
+    size_t size = 0;
+    char file_name[MAX_LENGTH];
+    FILE *file;
+    FILE *cpu_file;
+
+    if (list == NULL) {
+        return CPU_NUM;
+    }
+
+    file = fopen(CPU_USAGE_FILE, "r");
+    if (file == NULL) {
+        ALOGE("%s: failed to open: %s", __func__, strerror(errno));
+        return -errno;
+    }
+
+    while ((read = getline(&line, &len, file)) != -1) {
+        // Skip non "cpu[0-9]" lines.
+        if (strnlen(line, read) < 4 || strncmp(line, "cpu", 3) != 0 || !isdigit(line[3])) {
+            free(line);
+            line = NULL;
+            len = 0;
+            continue;
+        }
+
+        vals = sscanf(line, "cpu%d %" SCNu64 " %" SCNu64 " %" SCNu64 " %" SCNu64, &cpu_num, &user,
+                &nice, &system, &idle);
+
+        free(line);
+        line = NULL;
+        len = 0;
+
+        if (vals != 5 || size == CPU_NUM) {
+            if (vals != 5) {
+                ALOGE("%s: failed to read CPU information from file: %s", __func__,
+                        strerror(errno));
+            } else {
+                ALOGE("/proc/stat file has incorrect format.");
+            }
+            fclose(file);
+            return errno ? -errno : -EIO;
+        }
+
+        active = user + nice + system;
+        total = active + idle;
+
+        // Read online CPU information.
+        snprintf(file_name, MAX_LENGTH, CPU_ONLINE_FILE_FORMAT, cpu_num);
+        cpu_file = fopen(file_name, "r");
+        online = 0;
+        if (cpu_file == NULL) {
+            ALOGE("%s: failed to open file: %s (%s)", __func__, file_name, strerror(errno));
+            fclose(file);
+            return -errno;
+        }
+        if (1 != fscanf(cpu_file, "%d", &online)) {
+            ALOGE("%s: failed to read CPU online information from file: %s (%s)", __func__,
+                    file_name, strerror(errno));
+            fclose(file);
+            fclose(cpu_file);
+            return errno ? -errno : -EIO;
+        }
+        fclose(cpu_file);
+
+        list[size] = (cpu_usage_t) {
+            .name = CPU_LABEL[size],
+            .active = active,
+            .total = total,
+            .is_online = online
+        };
+
+        size++;
+    }
+
+    fclose(file);
+
+    if (size != CPU_NUM) {
+        ALOGE("/proc/stat file has incorrect format.");
+        return -EIO;
+    }
+
+    return CPU_NUM;
+}
+
+static struct hw_module_methods_t thermal_module_methods = {
+    .open = NULL,
+};
+
+thermal_module_t HAL_MODULE_INFO_SYM = {
+    .common = {
+        .tag = HARDWARE_MODULE_TAG,
+        .module_api_version = THERMAL_HARDWARE_MODULE_API_VERSION_0_1,
+        .hal_api_version = HARDWARE_HAL_API_VERSION,
+        .id = THERMAL_HARDWARE_MODULE_ID,
+        .name = "Bullhead Thermal HAL",
+        .author = "The Android Open Source Project",
+        .methods = &thermal_module_methods,
+    },
+    .getTemperatures = get_temperatures,
+    .getCpuUsages = get_cpu_usages,
+};