summaryrefslogtreecommitdiff
path: root/power/utils.c
diff options
context:
space:
mode:
authoralk3pInjection <webmaster@raspii.tech>2022-01-11 14:42:50 +0800
committeralk3pInjection <webmaster@raspii.tech>2022-01-11 14:42:50 +0800
commite9b02761301fff7278682c48d59ecc50b6e3ddd2 (patch)
tree983eb8e7950cf715849d7e78515957c12db9f502 /power/utils.c
parent6e48da0dd09ba3ccd7c84a147aed502ca9429dc5 (diff)
common: Initial startup
Change-Id: Ie73007b3fe2462dee2c85aeb5c68a5807f9ff4af
Diffstat (limited to 'power/utils.c')
-rw-r--r--power/utils.c426
1 files changed, 0 insertions, 426 deletions
diff --git a/power/utils.c b/power/utils.c
deleted file mode 100644
index ac73edd..0000000
--- a/power/utils.c
+++ /dev/null
@@ -1,426 +0,0 @@
-/*
- * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions are
- * met:
- * * * Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * * Redistributions in binary form must reproduce the above
- * copyright notice, this list of conditions and the following
- * disclaimer in the documentation and/or other materials provided
- * with the distribution.
- * * Neither the name of The Linux Foundation nor the names of its
- * contributors may be used to endorse or promote products derived
- * from this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
- * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
- * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
- * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
- * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
- * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
- * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
- * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
- * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
- * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
- * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
-#define LOG_NIDEBUG 0
-
-#include <dlfcn.h>
-#include <fcntl.h>
-#include <errno.h>
-#include <string.h>
-#include <stdlib.h>
-#include <sys/stat.h>
-
-#include "utils.h"
-#include "list.h"
-#include "hint-data.h"
-#include "power-common.h"
-
-#define LOG_TAG "QCOM PowerHAL"
-#include <utils/Log.h>
-
-#define USINSEC 1000000L
-#define NSINUS 1000L
-
-#define SOC_ID_0 "/sys/devices/soc0/soc_id"
-#define SOC_ID_1 "/sys/devices/system/soc/soc0/id"
-
-char scaling_gov_path[4][80] ={
- "sys/devices/system/cpu/cpu0/cpufreq/scaling_governor",
- "sys/devices/system/cpu/cpu1/cpufreq/scaling_governor",
- "sys/devices/system/cpu/cpu2/cpufreq/scaling_governor",
- "sys/devices/system/cpu/cpu3/cpufreq/scaling_governor"
-};
-
-static void *qcopt_handle;
-static void *iop_handle;
-static int (*perf_lock_acq)(unsigned long handle, int duration,
- int list[], int numArgs);
-static int (*perf_lock_rel)(unsigned long handle);
-static int (*perf_lock_use_profile)(unsigned long handle, int profile);
-static int (*perf_io_prefetch_start)(int, const char*);
-static int (*perf_io_prefetch_stop)();
-static struct list_node active_hint_list_head;
-static int profile_handle = 0;
-
-static void *get_qcopt_handle()
-{
- char qcopt_lib_path[PATH_MAX] = {0};
- void *handle = NULL;
-
- dlerror();
-
- if (property_get("ro.vendor.extension_library", qcopt_lib_path,
- NULL)) {
- handle = dlopen(qcopt_lib_path, RTLD_NOW);
- if (!handle) {
- ALOGE("Unable to open %s: %s\n", qcopt_lib_path,
- dlerror());
- }
- }
-
- return handle;
-}
-
-static void *get_iop_handle()
-{
- char iop_lib_path[PATH_MAX] = {0};
- void *handle = NULL;
-
- dlerror();
-
- handle = dlopen("libqti-iop-client.so", RTLD_NOW | RTLD_LOCAL);
- if (!handle) {
- ALOGE("Unable to open prefetcher: %s\n", dlerror());
- }
-
- return handle;
-}
-
-static void __attribute__ ((constructor)) initialize(void)
-{
- qcopt_handle = get_qcopt_handle();
-
- if (!qcopt_handle) {
- ALOGE("Failed to get qcopt handle.\n");
- } else {
- /*
- * qc-opt handle obtained. Get the perflock acquire/release
- * function pointers.
- */
- perf_lock_acq = dlsym(qcopt_handle, "perf_lock_acq");
- if (!perf_lock_acq) {
- goto fail_qcopt;
- }
-
- perf_lock_rel = dlsym(qcopt_handle, "perf_lock_rel");
- if (!perf_lock_rel) {
- goto fail_qcopt;
- }
-
- // optional
- perf_lock_use_profile = dlsym(qcopt_handle, "perf_lock_use_profile");
- }
-
- iop_handle = get_iop_handle();
-
- if (!iop_handle) {
- ALOGE("Failed to get prefetcher handle.\n");
- } else {
- perf_io_prefetch_start = (int(*)(int, const char *))dlsym(
- iop_handle, "perf_io_prefetch_start");
- if (!perf_io_prefetch_start) {
- goto fail_iop;
- }
-
- perf_io_prefetch_stop = (int(*)())dlsym(
- iop_handle, "perf_io_prefetch_stop");
- if (!perf_io_prefetch_stop) {
- goto fail_iop;
- }
- }
- return;
-
-fail_qcopt:
- perf_lock_acq = NULL;
- perf_lock_rel = NULL;
- if (qcopt_handle) {
- dlclose(qcopt_handle);
- qcopt_handle = NULL;
- }
-
-fail_iop:
- perf_io_prefetch_start = NULL;
- perf_io_prefetch_stop = NULL;
- if (iop_handle) {
- dlclose(iop_handle);
- iop_handle = NULL;
- }
-}
-
-static void __attribute__ ((destructor)) cleanup(void)
-{
- if (qcopt_handle) {
- if (dlclose(qcopt_handle))
- ALOGE("Error occurred while closing qc-opt library.");
- }
- if (iop_handle) {
- if (dlclose(iop_handle))
- ALOGE("Error occurred while closing prefetcher library.");
- }
-}
-
-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;
-}
-
-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;
-}
-
-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;
-}
-
-int get_scaling_governor_check_cores(char governor[], int size,int core_num)
-{
- if (sysfs_read(scaling_gov_path[core_num], governor,
- size) == -1) {
- // Can't obtain the scaling governor. Return.
- return -1;
- }
-
- // Strip newline at the end.
- int len = strlen(governor);
- len--;
- while (len >= 0 && (governor[len] == '\n' || governor[len] == '\r'))
- governor[len--] = '\0';
- return 0;
-}
-
-void interaction(int duration, int num_args, int opt_list[])
-{
- static int lock_handle = 0;
-
- if (duration <= 0 || num_args < 1 || opt_list[0] == 0)
- return;
-
- if (qcopt_handle) {
- if (perf_lock_acq) {
- lock_handle = perf_lock_acq(lock_handle, duration, opt_list, num_args);
- if (lock_handle == -1)
- ALOGE("Failed to acquire lock.");
- }
- }
-}
-
-void perform_hint_action(int hint_id, int resource_values[], int num_resources)
-{
- if (qcopt_handle) {
- if (perf_lock_acq) {
- /* Acquire an indefinite lock for the requested resources. */
- int lock_handle = perf_lock_acq(0, 0, resource_values,
- num_resources);
-
- if (lock_handle == -1) {
- ALOGE("Failed to acquire lock.");
- } else {
- /* Add this handle to our internal hint-list. */
- struct hint_data *new_hint =
- (struct hint_data *)malloc(sizeof(struct hint_data));
-
- if (new_hint) {
- if (!active_hint_list_head.compare) {
- active_hint_list_head.compare =
- (int (*)(void *, void *))hint_compare;
- active_hint_list_head.dump = (void (*)(void *))hint_dump;
- }
-
- new_hint->hint_id = hint_id;
- new_hint->perflock_handle = lock_handle;
-
- if (add_list_node(&active_hint_list_head, new_hint) == NULL) {
- free(new_hint);
- /* Can't keep track of this lock. Release it. */
- if (perf_lock_rel)
- perf_lock_rel(lock_handle);
-
- ALOGE("Failed to process hint.");
- }
- } else {
- /* Can't keep track of this lock. Release it. */
- if (perf_lock_rel)
- perf_lock_rel(lock_handle);
-
- ALOGE("Failed to process hint.");
- }
- }
- }
- }
-}
-
-void undo_hint_action(int hint_id)
-{
- if (qcopt_handle) {
- if (perf_lock_rel) {
- /* Get hint-data associated with this hint-id */
- struct list_node *found_node;
- struct hint_data temp_hint_data = {
- .hint_id = hint_id
- };
-
- found_node = find_node(&active_hint_list_head,
- &temp_hint_data);
-
- if (found_node) {
- /* Release this lock. */
- struct hint_data *found_hint_data =
- (struct hint_data *)(found_node->data);
-
- if (found_hint_data) {
- if (perf_lock_rel(found_hint_data->perflock_handle) == -1)
- ALOGE("Perflock release failed.");
- }
-
- if (found_node->data) {
- /* We can free the hint-data for this node. */
- free(found_node->data);
- }
-
- remove_list_node(&active_hint_list_head, found_node);
- } else {
- ALOGE("Invalid hint ID.");
- }
- }
- }
-}
-
-/*
- * Used to release initial lock holding
- * two cores online when the display is on
- */
-void undo_initial_hint_action()
-{
- if (qcopt_handle) {
- if (perf_lock_rel) {
- perf_lock_rel(1);
- }
- }
-}
-
-/* Set a static profile */
-void set_profile(int profile)
-{
- if (qcopt_handle) {
- if (perf_lock_use_profile) {
- profile_handle = perf_lock_use_profile(profile_handle, profile);
- if (profile_handle == -1)
- ALOGE("Failed to set profile.");
- if (profile < 0)
- profile_handle = 0;
- }
- }
-}
-
-void start_prefetch(int pid, const char* packageName) {
- if (iop_handle) {
- if (perf_io_prefetch_start) {
- perf_io_prefetch_start(pid, packageName);
- }
- }
-}
-
-long long calc_timespan_us(struct timespec start, struct timespec end)
-{
- long long diff_in_us = 0;
- diff_in_us += (end.tv_sec - start.tv_sec) * USINSEC;
- diff_in_us += (end.tv_nsec - start.tv_nsec) / NSINUS;
- return diff_in_us;
-}
-
-int get_soc_id(void)
-{
- int fd;
- int soc_id = -1;
- char buf[10] = { 0 };
-
- if (!access(SOC_ID_0, F_OK))
- fd = open(SOC_ID_0, O_RDONLY);
- else
- fd = open(SOC_ID_1, O_RDONLY);
-
- if (fd >= 0) {
- if (read(fd, buf, sizeof(buf) - 1) == -1)
- ALOGW("Unable to read soc_id");
- else
- soc_id = atoi(buf);
- }
-
- close(fd);
- return soc_id;
-}