From 4faf8fcdfb0f0b2b9705d9d8c75f1045e8b04026 Mon Sep 17 00:00:00 2001 From: Chanwoo Choi Date: Wed, 2 Mar 2022 14:30:40 +0900 Subject: power-generic: Add hal-backend-power-generic hal backend Change-Id: I80578a371af061bd125102a814094f6dafaf4bf5 Signed-off-by: Chanwoo Choi --- CMakeLists.txt | 32 ++ LICENSE | 203 +++++++ packaging/hal-backend-power-generic.manifest | 5 + packaging/hal-backend-power-generic.spec | 58 ++ scripts/pass-hal.conf | 42 ++ src/hal-backend-power.c | 775 +++++++++++++++++++++++++++ src/sysfs.c | 129 +++++ src/sysfs.h | 6 + 8 files changed, 1250 insertions(+) create mode 100644 CMakeLists.txt create mode 100644 LICENSE create mode 100644 packaging/hal-backend-power-generic.manifest create mode 100644 packaging/hal-backend-power-generic.spec create mode 100644 scripts/pass-hal.conf create mode 100644 src/hal-backend-power.c create mode 100644 src/sysfs.c create mode 100644 src/sysfs.h diff --git a/CMakeLists.txt b/CMakeLists.txt new file mode 100644 index 0000000..c503869 --- /dev/null +++ b/CMakeLists.txt @@ -0,0 +1,32 @@ +CMAKE_MINIMUM_REQUIRED(VERSION 2.6) +PROJECT(hal-backend-power-generic C) + +SET(LIBRARY_NAME "hal-backend-power") +SET(CMAKE_VERBOSE_MAKEFILE ON) +SET(PREFIX ${CMAKE_INSTALL_PREFIX}) +SET(HAL_LIBDIR ${CMAKE_HAL_LIBDIR_PREFIX}) +SET(HAL_LICENSEDIR ${CMAKE_HAL_LICENSEDIR_PREFIX}) + +INCLUDE(FindPkgConfig) +pkg_check_modules(pkgs REQUIRED + hal-api-common + hal-api-power +) + +FOREACH(flag ${pkgs_CFLAGS}) + SET(EXTRA_CFLAGS "${EXTRA_CFLAGS} ${flag}") +ENDFOREACH(flag) +SET(CMAKE_C_FLAGS "${CMAKE_CFLAGS} ${EXTRA_CFLAGS}") + +INCLUDE_DIRECTORIES(${PROJECT_SOURCE_DIR}/include) + +SET(SRCS + ${PROJECT_SOURCE_DIR}/src/${LIBRARY_NAME}.c + ${PROJECT_SOURCE_DIR}/src/sysfs.c) + +ADD_LIBRARY(${LIBRARY_NAME} SHARED ${SRCS}) +TARGET_LINK_LIBRARIES(${LIBRARY_NAME} ${pkgs_LDFLAGS} -ldl) + +INSTALL(FILES ${CMAKE_CURRENT_SOURCE_DIR}/scripts/pass-hal.conf DESTINATION /hal/lib/tmpfiles.d) +INSTALL(FILES ${CMAKE_CURRENT_SOURCE_DIR}/LICENSE DESTINATION ${HAL_LICENSEDIR}/${PROJECT_NAME}) +INSTALL(TARGETS ${LIBRARY_NAME} DESTINATION ${HAL_LIBDIR} COMPONENT RuntimeLibraries) diff --git a/LICENSE b/LICENSE new file mode 100644 index 0000000..247c97d --- /dev/null +++ b/LICENSE @@ -0,0 +1,203 @@ +Copyright (c) 2000 - 2011 Samsung Electronics Co., Ltd. All rights reserved. + + Apache License + Version 2.0, January 2004 + http://www.apache.org/licenses/ + + TERMS AND CONDITIONS FOR USE, REPRODUCTION, AND DISTRIBUTION + + 1. Definitions. + + "License" shall mean the terms and conditions for use, reproduction, + and distribution as defined by Sections 1 through 9 of this document. + + "Licensor" shall mean the copyright owner or entity authorized by + the copyright owner that is granting the License. + + "Legal Entity" shall mean the union of the acting entity and all + other entities that control, are controlled by, or are under common + control with that entity. For the purposes of this definition, + "control" means (i) the power, direct or indirect, to cause the + direction or management of such entity, whether by contract or + otherwise, or (ii) ownership of fifty percent (50%) or more of the + outstanding shares, or (iii) beneficial ownership of such entity. + + "You" (or "Your") shall mean an individual or Legal Entity + exercising permissions granted by this License. + + "Source" form shall mean the preferred form for making modifications, + including but not limited to software source code, documentation + source, and configuration files. + + "Object" form shall mean any form resulting from mechanical + transformation or translation of a Source form, including but + not limited to compiled object code, generated documentation, + and conversions to other media types. + + "Work" shall mean the work of authorship, whether in Source or + Object form, made available under the License, as indicated by a + copyright notice that is included in or attached to the work + (an example is provided in the Appendix below). + + "Derivative Works" shall mean any work, whether in Source or Object + form, that is based on (or derived from) the Work and for which the + editorial revisions, annotations, elaborations, or other modifications + represent, as a whole, an original work of authorship. For the purposes + of this License, Derivative Works shall not include works that remain + separable from, or merely link (or bind by name) to the interfaces of, + the Work and Derivative Works thereof. + + "Contribution" shall mean any work of authorship, including + the original version of the Work and any modifications or additions + to that Work or Derivative Works thereof, that is intentionally + submitted to Licensor for inclusion in the Work by the copyright owner + or by an individual or Legal Entity authorized to submit on behalf of + the copyright owner. For the purposes of this definition, "submitted" + means any form of electronic, verbal, or written communication sent + to the Licensor or its representatives, including but not limited to + communication on electronic mailing lists, source code control systems, + and issue tracking systems that are managed by, or on behalf of, the + Licensor for the purpose of discussing and improving the Work, but + excluding communication that is conspicuously marked or otherwise + designated in writing by the copyright owner as "Not a Contribution." + + "Contributor" shall mean Licensor and any individual or Legal Entity + on behalf of whom a Contribution has been received by Licensor and + subsequently incorporated within the Work. + + 2. Grant of Copyright License. Subject to the terms and conditions of + this License, each Contributor hereby grants to You a perpetual, + worldwide, non-exclusive, no-charge, royalty-free, irrevocable + copyright license to reproduce, prepare Derivative Works of, + publicly display, publicly perform, sublicense, and distribute the + Work and such Derivative Works in Source or Object form. + + 3. Grant of Patent License. Subject to the terms and conditions of + this License, each Contributor hereby grants to You a perpetual, + worldwide, non-exclusive, no-charge, royalty-free, irrevocable + (except as stated in this section) patent license to make, have made, + use, offer to sell, sell, import, and otherwise transfer the Work, + where such license applies only to those patent claims licensable + by such Contributor that are necessarily infringed by their + Contribution(s) alone or by combination of their Contribution(s) + with the Work to which such Contribution(s) was submitted. If You + institute patent litigation against any entity (including a + cross-claim or counterclaim in a lawsuit) alleging that the Work + or a Contribution incorporated within the Work constitutes direct + or contributory patent infringement, then any patent licenses + granted to You under this License for that Work shall terminate + as of the date such litigation is filed. + + 4. Redistribution. You may reproduce and distribute copies of the + Work or Derivative Works thereof in any medium, with or without + modifications, and in Source or Object form, provided that You + meet the following conditions: + + (a) You must give any other recipients of the Work or + Derivative Works a copy of this License; and + + (b) You must cause any modified files to carry prominent notices + stating that You changed the files; and + + (c) You must retain, in the Source form of any Derivative Works + that You distribute, all copyright, patent, trademark, and + attribution notices from the Source form of the Work, + excluding those notices that do not pertain to any part of + the Derivative Works; and + + (d) If the Work includes a "NOTICE" text file as part of its + distribution, then any Derivative Works that You distribute must + include a readable copy of the attribution notices contained + within such NOTICE file, excluding those notices that do not + pertain to any part of the Derivative Works, in at least one + of the following places: within a NOTICE text file distributed + as part of the Derivative Works; within the Source form or + documentation, if provided along with the Derivative Works; or, + within a display generated by the Derivative Works, if and + wherever such third-party notices normally appear. The contents + of the NOTICE file are for informational purposes only and + do not modify the License. You may add Your own attribution + notices within Derivative Works that You distribute, alongside + or as an addendum to the NOTICE text from the Work, provided + that such additional attribution notices cannot be construed + as modifying the License. + + You may add Your own copyright statement to Your modifications and + may provide additional or different license terms and conditions + for use, reproduction, or distribution of Your modifications, or + for any such Derivative Works as a whole, provided Your use, + reproduction, and distribution of the Work otherwise complies with + the conditions stated in this License. + + 5. Submission of Contributions. Unless You explicitly state otherwise, + any Contribution intentionally submitted for inclusion in the Work + by You to the Licensor shall be under the terms and conditions of + this License, without any additional terms or conditions. + Notwithstanding the above, nothing herein shall supersede or modify + the terms of any separate license agreement you may have executed + with Licensor regarding such Contributions. + + 6. Trademarks. This License does not grant permission to use the trade + names, trademarks, service marks, or product names of the Licensor, + except as required for reasonable and customary use in describing the + origin of the Work and reproducing the content of the NOTICE file. + + 7. Disclaimer of Warranty. Unless required by applicable law or + agreed to in writing, Licensor provides the Work (and each + Contributor provides its Contributions) on an "AS IS" BASIS, + WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or + implied, including, without limitation, any warranties or conditions + of TITLE, NON-INFRINGEMENT, MERCHANTABILITY, or FITNESS FOR A + PARTICULAR PURPOSE. You are solely responsible for determining the + appropriateness of using or redistributing the Work and assume any + risks associated with Your exercise of permissions under this License. + + 8. Limitation of Liability. In no event and under no legal theory, + whether in tort (including negligence), contract, or otherwise, + unless required by applicable law (such as deliberate and grossly + negligent acts) or agreed to in writing, shall any Contributor be + liable to You for damages, including any direct, indirect, special, + incidental, or consequential damages of any character arising as a + result of this License or out of the use or inability to use the + Work (including but not limited to damages for loss of goodwill, + work stoppage, computer failure or malfunction, or any and all + other commercial damages or losses), even if such Contributor + has been advised of the possibility of such damages. + + 9. Accepting Warranty or Additional Liability. While redistributing + the Work or Derivative Works thereof, You may choose to offer, + and charge a fee for, acceptance of support, warranty, indemnity, + or other liability obligations and/or rights consistent with this + License. However, in accepting such obligations, You may act only + on Your own behalf and on Your sole responsibility, not on behalf + of any other Contributor, and only if You agree to indemnify, + defend, and hold each Contributor harmless for any liability + incurred by, or claims asserted against, such Contributor by reason + of your accepting any such warranty or additional liability. + + END OF TERMS AND CONDITIONS + + APPENDIX: How to apply the Apache License to your work. + + To apply the Apache License to your work, attach the following + boilerplate notice, with the fields enclosed by brackets "[]" + replaced with your own identifying information. (Don't include + the brackets!) The text should be enclosed in the appropriate + comment syntax for the file format. We also recommend that a + file or class name and description of purpose be included on the + same "printed page" as the copyright notice for easier + identification within third-party archives. + + Copyright [yyyy] [name of copyright owner] + + 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. diff --git a/packaging/hal-backend-power-generic.manifest b/packaging/hal-backend-power-generic.manifest new file mode 100644 index 0000000..75b0fa5 --- /dev/null +++ b/packaging/hal-backend-power-generic.manifest @@ -0,0 +1,5 @@ + + + + + diff --git a/packaging/hal-backend-power-generic.spec b/packaging/hal-backend-power-generic.spec new file mode 100644 index 0000000..8dba3cf --- /dev/null +++ b/packaging/hal-backend-power-generic.spec @@ -0,0 +1,58 @@ +%define version 1.1.0 +%define release 1 + +Name: hal-backend-power-generic +Summary: Power HAL for standard linux interface +Version: %{version} +Release: %{release} +Group: System/Hardware Adaptation +License: Apache-2.0 +Source0: %{name}-%{version}.tar.gz +Source1: %{name}.manifest + +Requires(post): /sbin/ldconfig +Requires(post): /bin/systemctl +Requires(post): security-config +Requires(postun): /sbin/ldconfig +Requires(postun): /bin/systemctl +BuildRequires: cmake +BuildRequires: pkgconfig(hal-api-common) +BuildRequires: pkgconfig(hal-api-power) + +%description +PASS standard hal + +%prep +%setup -q +cp %{SOURCE1} . + +%build +%cmake . -DCMAKE_INSTALL_PREFIX=%{_prefix} \ + -DCMAKE_HAL_LIBDIR_PREFIX=%{_hal_libdir} \ + -DCMAKE_HAL_LICENSEDIR_PREFIX=%{_hal_licensedir} \ + +make %{?jobs:-j%jobs} + +%install +rm -rf %{buildroot} + +%make_install + +%post +/sbin/ldconfig +systemd-tmpfiles /hal/lib/tmpfiles.d/pass-hal.conf --create +if [ -f %{_unitdir}/pass.service ]; then + systemctl try-restart pass.service +fi + +%postun +/sbin/ldconfig +if [ -f %{_unitdir}/pass.service ]; then + systemctl try-restart pass.service +fi + +%files +%manifest %{name}.manifest +%{_hal_licensedir}/%{name}/LICENSE +%{_hal_libdir}/*.so +/hal/lib/tmpfiles.d/pass-hal.conf diff --git a/scripts/pass-hal.conf b/scripts/pass-hal.conf new file mode 100644 index 0000000..04be8cd --- /dev/null +++ b/scripts/pass-hal.conf @@ -0,0 +1,42 @@ +z /sys/devices/system/cpu/*/online 0660 root system_fw - +t /sys/devices/system/cpu/*/online - - - - security.SMACK64="System::Shared" +z /sys/devices/system/cpu/*/cpufreq/scaling_available_governors 0440 root system_fw - +t /sys/devices/system/cpu/*/cpufreq/scaling_available_governors - - - - security.SMACK64="System::Shared" +z /sys/devices/system/cpu/*/cpufreq/cpuinfo_cur_freq 0440 root system_fw - +t /sys/devices/system/cpu/*/cpufreq/cpuinfo_cur_freq - - - - security.SMACK64="System::Shared" +z /sys/devices/system/cpu/*/cpufreq/cpuinfo_min_freq 0440 root system_fw - +t /sys/devices/system/cpu/*/cpufreq/cpuinfo_min_freq - - - - security.SMACK64="System::Shared" +z /sys/devices/system/cpu/*/cpufreq/cpuinfo_max_freq 0440 root system_fw - +t /sys/devices/system/cpu/*/cpufreq/cpuinfo_max_freq - - - - security.SMACK64="System::Shared" +z /sys/devices/system/cpu/*/cpufreq/scaling_governor 0660 root system_fw - +t /sys/devices/system/cpu/*/cpufreq/scaling_governor - - - - security.SMACK64="System::Shared" +z /sys/devices/system/cpu/*/cpufreq/scaling_min_freq 0660 root system_fw - +t /sys/devices/system/cpu/*/cpufreq/scaling_min_freq - - - - security.SMACK64="System::Shared" +z /sys/devices/system/cpu/*/cpufreq/scaling_max_freq 0660 root system_fw - +t /sys/devices/system/cpu/*/cpufreq/scaling_max_freq - - - - security.SMACK64="System::Shared" +z /sys/devices/system/cpu/*/cpufreq/ondemand/up_threshold 0660 root system_fw - +t /sys/devices/system/cpu/*/cpufreq/ondemand/up_threshold - - - - security.SMACK64="System::Shared" +z /sys/devices/system/cpu/*/cpufreq/ondemand/sampling_rate 0660 root system_fw - +t /sys/devices/system/cpu/*/cpufreq/ondemand/sampling_rate - - - - security.SMACK64="System::Shared" +z /sys/class/thermal/*/temp 0440 root system_fw - +t /sys/class/thermal/*/temp - - - - security.SMACK64="System::Shared" +z /sys/class/thermal/*/policy 0440 root system_fw - +t /sys/class/thermal/*/policy - - - - security.SMACK64="System::Shared" +z /sys/kernel/debug/cpufreq/*/load_table 0440 root system_fw - +t /sys/kernel/debug/cpufreq/*/load_table - - - - security.SMACK64="System::Shared" +z /sys/kernel/debug/cpufreq/*/load_table 0440 root system_fw - +t /sys/kernel/debug/cpufreq/*/load_table - - - - security.SMACK64="System::Shared" +z /sys/devices/platform/soc/*/devfreq/*/cur_freq 0440 root system_fw - +t /sys/devices/platform/soc/*/devfreq/*/cur_freq - - - - security.SMACK64="System::Shared" +z /sys/devices/platform/soc/*/devfreq/*/governor 0660 root system_fw - +t /sys/devices/platform/soc/*/devfreq/*/governor - - - - security.SMACK64="System::Shared" +z /sys/devices/platform/soc/*/devfreq/*/min_freq 0660 root system_fw - +t /sys/devices/platform/soc/*/devfreq/*/min_freq - - - - security.SMACK64="System::Shared" +z /sys/devices/platform/soc/*/devfreq/*/max_freq 0660 root system_fw - +t /sys/devices/platform/soc/*/devfreq/*/max_freq - - - - security.SMACK64="System::Shared" +z /sys/devices/platform/soc/*/devfreq/*/polling_interval 0660 root system_fw - +t /sys/devices/platform/soc/*/devfreq/*/polling_interval - - - - security.SMACK64="System::Shared" +z /sys/devices/platform/soc/*/devfreq/*/available_frequencies 0440 root system_fw - +t /sys/devices/platform/soc/*/devfreq/*/available_frequencies - - - - security.SMACK64="System::Shared" +z /sys/kernel/debug/fault_around_bytes 0660 root system_fw - +t /sys/kernel/debug/fault_around_bytes - - - - security.SMACK64="System::Shared" diff --git a/src/hal-backend-power.c b/src/hal-backend-power.c new file mode 100644 index 0000000..c4f52ad --- /dev/null +++ b/src/hal-backend-power.c @@ -0,0 +1,775 @@ +/* + * HAL backend for hal-api-power which is used for PASS daemon + * + * Copyright (c) 2021 Samsung Electronics Co., Ltd. + * + * 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 + +#include + +#include "sysfs.h" + +#define BUFF_MAX 255 + +/************************* + * H/W Resource Defintions + */ +#define CPUFREQ_PATH_PREFIX "/sys/devices/system/cpu/" +#define CPUFREQ_CURR_GOVERNOR_PATH_SUFFIX "/cpufreq/scaling_governor" +#define CPUFREQ_AVAIL_GOVERNOR_PATH_SUFFIX "/cpufreq/scaling_available_governors" + +/* + * The cpuinfo_cur_freq indicates the actual operating CPU freqeuncy + * and scaling_cur_freq is the CPU frequency set by the CPUFREQ policy. + */ +#define CPUFREQ_CURR_FREQ_PATH_SUFFIX "/cpufreq/cpuinfo_cur_freq" +#define CPUFREQ_AVAILABLE_MIN_FREQ_PATH_SUFFIX "/cpufreq/cpuinfo_min_freq" +#define CPUFREQ_AVAILABLE_MAX_FREQ_PATH_SUFFIX "/cpufreq/cpuinfo_max_freq" +#define CPUFREQ_MIN_FREQ_PATH_SUFFIX "/cpufreq/scaling_min_freq" +#define CPUFREQ_MAX_FREQ_PATH_SUFFIX "/cpufreq/scaling_max_freq" +#define CPUFREQ_UP_THRESHOLD_PATH_SUFFIX "/cpufreq/ondemand/up_threshold" + +#define CPU_ONLINE_PATH_PREFIX "/sys/devices/system/cpu/cpu" +#define CPU_ONLINE_PATH_SUFFIX "/online" +#define CPU_ONLINE_STATE_ON 1 +#define CPU_ONLINE_STATE_OFF 0 + +#define TMU_PATH_PREFIX "/sys/class/thermal/" +#define TMU_TEMP_PATH_SUFFIX "/temp" +#define TMU_POLICY_PATH_SUFFIX "/policy" +#define TMU_MAX_TEMP_MASK 0xFFFFF + +#define DEVFREQ_BUS_PATH_PREFIX "/sys/class/devfreq/" +#define DEVFREQ_BUS_CURR_GOVERNOR_PATH_SUFFIX "/governor" +#define DEVFREQ_BUS_CURR_FREQ_PATH_SUFFIX "/cur_freq" +#define DEVFREQ_BUS_MIN_FREQ_PATH_SUFFIX "/min_freq" +#define DEVFREQ_BUS_MAX_FREQ_PATH_SUFFIX "/max_freq" +#define DEVFREQ_BUS_AVAILABLE_FREQ_PATH_SUFFIX "/available_frequencies" + +#define FAULT_AROUND_BYTES_PATH "/sys/kernel/debug/fault_around_bytes" + +/************************************************* + * HAL backend implementation for CPU H/W Resource + */ +static int cpufreq_dvfs_get_curr_governor(char *res_name, char *governor) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name) || (!governor)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_CURR_GOVERNOR_PATH_SUFFIX); + + ret = sysfs_read_str(path, governor, BUFF_MAX); + if (ret < 0) + return ret; + + return 0; +} + +static int cpufreq_dvfs_set_curr_governor(char *res_name, char *governor) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name) || (!governor)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_CURR_GOVERNOR_PATH_SUFFIX); + + ret = sysfs_write_str(path, governor); + if (ret < 0) + return ret; + + return 0; +} + +static int cpufreq_dvfs_get_curr_freq(char *res_name) +{ + char path[PATH_MAX]; + int freq, ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_CURR_FREQ_PATH_SUFFIX); + + ret = sysfs_read_int(path, &freq); + if (ret < 0) + return ret; + + return freq; +} + +static int cpufreq_dvfs_get_min_freq(char *res_name) +{ + char path[PATH_MAX]; + int freq, ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_MIN_FREQ_PATH_SUFFIX); + + ret = sysfs_read_int(path, &freq); + if (ret < 0) + return ret; + + return freq; +} + +static int cpufreq_dvfs_set_min_freq(char *res_name, int freq) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name) || (freq < 0)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_MIN_FREQ_PATH_SUFFIX); + + ret = sysfs_write_int(path, freq); + if (ret < 0) + return ret; + + return 0; +} + +static int cpufreq_dvfs_get_max_freq(char *res_name) +{ + char path[PATH_MAX]; + int freq, ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_MAX_FREQ_PATH_SUFFIX); + + ret = sysfs_read_int(path, &freq); + if (ret < 0) + return ret; + + return freq; +} + +static int cpufreq_dvfs_set_max_freq(char *res_name, int freq) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name) || (freq < 0)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_MAX_FREQ_PATH_SUFFIX); + + ret = sysfs_write_int(path, freq); + if (ret < 0) + return ret; + return 0; +} + +static int cpufreq_dvfs_get_available_min_freq(char *res_name) +{ + char path[PATH_MAX]; + int val, ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_AVAILABLE_MIN_FREQ_PATH_SUFFIX); + + ret = sysfs_read_int(path, &val); + if (ret < 0) + return ret; + + return val; +} + + +static int cpufreq_dvfs_get_available_max_freq(char *res_name) +{ + char path[PATH_MAX]; + int val, ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_AVAILABLE_MAX_FREQ_PATH_SUFFIX); + + ret = sysfs_read_int(path, &val); + if (ret < 0) + return ret; + + return val; +} + +static int cpufreq_dvfs_get_up_threshold(char *res_name) +{ + char path[PATH_MAX]; + int val, ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_UP_THRESHOLD_PATH_SUFFIX); + + ret = sysfs_read_int(path, &val); + if (ret < 0) + return ret; + + return val; +} + +static int cpufreq_dvfs_set_up_threshold(char *res_name, int up_threshold) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name) || (up_threshold < 0)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + CPUFREQ_PATH_PREFIX, + res_name, + CPUFREQ_UP_THRESHOLD_PATH_SUFFIX); + + ret = sysfs_write_int(path, up_threshold); + if (ret < 0) + return ret; + + return 0; +} + +static struct pass_resource_dvfs_ops cpufreq_dvfs_ops = { + .get_curr_governor = cpufreq_dvfs_get_curr_governor, + .set_curr_governor = cpufreq_dvfs_set_curr_governor, + .get_curr_freq = cpufreq_dvfs_get_curr_freq, + .get_min_freq = cpufreq_dvfs_get_min_freq, + .set_min_freq = cpufreq_dvfs_set_min_freq, + .get_max_freq = cpufreq_dvfs_get_max_freq, + .set_max_freq = cpufreq_dvfs_set_max_freq, + .get_available_min_freq = cpufreq_dvfs_get_available_min_freq, + .get_available_max_freq = cpufreq_dvfs_get_available_max_freq, + .get_up_threshold = cpufreq_dvfs_get_up_threshold, + .set_up_threshold = cpufreq_dvfs_set_up_threshold, +}; + +static int cpu_hotplug_get_online_state(char *res_name, int cpu) +{ + char path[PATH_MAX]; + int ret, online; + + if ((!res_name)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%d%s", + CPU_ONLINE_PATH_PREFIX, + cpu, + CPU_ONLINE_PATH_SUFFIX); + + ret = sysfs_read_int(path, &online); + if (ret < 0) + return ret; + + return online; +} + +static int cpu_hotplug_set_online_state(char *res_name, int cpu, int on) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name)) + return -EINVAL; + if ((on != CPU_ONLINE_STATE_ON) && (on != CPU_ONLINE_STATE_OFF)) + return -EINVAL; + + /* + * NOTE: Exynos SoC series cannot turn off the CPU0 + * because of h/w design. To prevent the critical problem, + * if someone try to turn off the CPU0, just return without any + * opertaion. + */ + if (on == 0 && cpu == 0) { + return 0; + } + + snprintf(path, PATH_MAX, "%s%d%s", + CPU_ONLINE_PATH_PREFIX, + cpu, + CPU_ONLINE_PATH_SUFFIX); + + ret = sysfs_write_int(path, on); + if (ret < 0) + return ret; + + return 0; +} + +static struct pass_resource_hotplug_ops cpu_hotplus_ops = { + .get_online_state = cpu_hotplug_get_online_state, + .set_online_state = cpu_hotplug_set_online_state, + .get_online_min_num = NULL, + .set_online_min_num = NULL, + .get_online_max_num = NULL, + .set_online_max_num = NULL, +}; + +static int tmu_get_temp(char *res_thermal_name) +{ + char path[PATH_MAX]; + int temp, ret; + + if (!res_thermal_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + TMU_PATH_PREFIX, + res_thermal_name, + TMU_TEMP_PATH_SUFFIX); + + ret = sysfs_read_int(path, &temp); + if (ret < 0) + return ret; + + /* + * Thermal framework provides the current temperature + * as five digits interger like 54430 when temperature is 54.430 + * degrees centigrade. But, Thermal Monitor in Tizen usually + * use two digits interger without decimal point. + * So that round temperature value. It constraints the maximume + * temperature as 1048 degrees centigrade for preventing integer + * overflow. Usually, the embedded device never over 1000 degrees + * centigrade. + */ + return (((temp & TMU_MAX_TEMP_MASK) + 500) / 1000); +} + +static int tmu_get_policy(char *res_thermal_name, char *policy) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_thermal_name) || (!policy)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + TMU_PATH_PREFIX, + res_thermal_name, + TMU_POLICY_PATH_SUFFIX); + + ret = sysfs_read_str(path, policy, BUFF_MAX); + if (ret < 0) + return ret; + + return 0; +} + +static struct pass_resource_tmu_ops tmu_ops = { + .get_temp = tmu_get_temp, + .get_policy = tmu_get_policy, +}; + +/***************************************************** + * HAL backend implementation for BUS/GPU H/W Resource + */ +static int devfreq_dvfs_get_curr_governor(char *res_name, char *governor) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name) || (!governor)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + DEVFREQ_BUS_PATH_PREFIX, + res_name, + DEVFREQ_BUS_CURR_GOVERNOR_PATH_SUFFIX); + + ret = sysfs_read_str(path, governor, BUFF_MAX); + if (ret < 0) + return ret; + + return 0; +} + +static int devfreq_dvfs_set_curr_governor(char *res_name, char *governor) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name) || (!governor)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + DEVFREQ_BUS_PATH_PREFIX, + res_name, + DEVFREQ_BUS_CURR_GOVERNOR_PATH_SUFFIX); + + ret = sysfs_write_str(path, governor); + if (ret < 0) + return ret; + + return 0; +} + +static int devfreq_dvfs_get_curr_freq(char *res_name) +{ + char path[PATH_MAX]; + int freq, ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + DEVFREQ_BUS_PATH_PREFIX, + res_name, + DEVFREQ_BUS_CURR_FREQ_PATH_SUFFIX); + + ret = sysfs_read_int(path, &freq); + if (ret < 0) + return ret; + + return freq; +} + +static int devfreq_dvfs_get_min_freq(char *res_name) +{ + char path[PATH_MAX]; + int freq, ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + DEVFREQ_BUS_PATH_PREFIX, + res_name, + DEVFREQ_BUS_MIN_FREQ_PATH_SUFFIX); + + ret = sysfs_read_int(path, &freq); + if (ret < 0) + return ret; + + return freq; +} + +static int devfreq_dvfs_set_min_freq(char *res_name, int freq) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name) || (freq < 0)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + DEVFREQ_BUS_PATH_PREFIX, + res_name, + DEVFREQ_BUS_MIN_FREQ_PATH_SUFFIX); + + ret = sysfs_write_int(path, freq); + if (ret < 0) + return ret; + + return 0; +} + +static int devfreq_dvfs_get_max_freq(char *res_name) +{ + char path[PATH_MAX]; + int freq, ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + DEVFREQ_BUS_PATH_PREFIX, + res_name, + DEVFREQ_BUS_MAX_FREQ_PATH_SUFFIX); + + ret = sysfs_read_int(path, &freq); + if (ret < 0) + return ret; + + return freq; +} + +static int devfreq_dvfs_set_max_freq(char *res_name, int freq) +{ + char path[PATH_MAX]; + int ret; + + if ((!res_name) || (freq < 0)) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + DEVFREQ_BUS_PATH_PREFIX, + res_name, + DEVFREQ_BUS_MAX_FREQ_PATH_SUFFIX); + + ret = sysfs_write_int(path, freq); + if (ret < 0) + return ret; + return 0; +} + +static int devfreq_dvfs_get_available_min_freq(char *res_name) +{ + char path[PATH_MAX]; + char buf[MAX_BUF_SIZE + 1]; + char *p; + int ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + DEVFREQ_BUS_PATH_PREFIX, + res_name, + DEVFREQ_BUS_AVAILABLE_FREQ_PATH_SUFFIX); + + ret = sysfs_read_str(path, buf, MAX_BUF_SIZE); + if (ret < 0) + return ret; + + p = strchr(buf, ' '); + if (p) + *p = '\0'; + + ret = strtoul(buf, NULL, 10); + if (!ret) + return -EINVAL; + + return ret; +} + +static int devfreq_dvfs_get_available_max_freq(char *res_name) +{ + char path[PATH_MAX]; + char buf[MAX_BUF_SIZE + 1]; + char *p; + int ret; + + if (!res_name) + return -EINVAL; + + snprintf(path, PATH_MAX, "%s%s%s", + DEVFREQ_BUS_PATH_PREFIX, + res_name, + DEVFREQ_BUS_AVAILABLE_FREQ_PATH_SUFFIX); + + ret = sysfs_read_str(path, buf, MAX_BUF_SIZE); + if (ret < 0) + return ret; + + p = strrchr(buf, ' '); + p = p ? p + 1 : buf; + + ret = strtoul(p, NULL, 10); + if (!ret) + return -EINVAL; + + return ret; +} + +static struct pass_resource_dvfs_ops devfreq_dvfs_ops = { + .get_curr_governor = devfreq_dvfs_get_curr_governor, + .set_curr_governor = devfreq_dvfs_set_curr_governor, + .get_curr_freq = devfreq_dvfs_get_curr_freq, + .get_min_freq = devfreq_dvfs_get_min_freq, + .set_min_freq = devfreq_dvfs_set_min_freq, + .get_max_freq = devfreq_dvfs_get_max_freq, + .set_max_freq = devfreq_dvfs_set_max_freq, + .get_available_min_freq = devfreq_dvfs_get_available_min_freq, + .get_available_max_freq = devfreq_dvfs_get_available_max_freq, +}; + +/**************************************************** + * HAL backend implementation for Memory H/W Resource + */ +static int memory_get_fault_around_bytes(char *res_name) +{ + int ret, fault_around_bytes; + + if (!res_name) + return -EINVAL; + + ret = sysfs_read_int(FAULT_AROUND_BYTES_PATH, &fault_around_bytes); + if (ret < 0) + return ret; + + return fault_around_bytes; +} + +static int memory_set_fault_around_bytes(char *res_name, + int fault_around_bytes) +{ + int ret; + + if ((!res_name) || (fault_around_bytes <= 0)) + return -EINVAL; + + ret = sysfs_write_int(FAULT_AROUND_BYTES_PATH, fault_around_bytes); + if (ret < 0) + return ret; + + return 0; +} + +/************************ + * HAL backend power data + */ +static int power_init(void **data) +{ + hal_backend_power_funcs *power_funcs = NULL; + struct pass_resource_cpu *cpu = NULL; + struct pass_resource_bus *bus = NULL; + struct pass_resource_gpu *gpu = NULL; + struct pass_resource_memory *memory = NULL; + int ret; + + /* Allocate memory */ + power_funcs = calloc(1, sizeof(hal_backend_power_funcs)); + if (!power_funcs) + return -ENOMEM; + + cpu = calloc(1, sizeof(struct pass_resource_cpu)); + if (!cpu) { + ret = -ENOMEM; + goto err_funcs; + } + + bus = calloc(1, sizeof(struct pass_resource_bus)); + if (!bus) { + ret = -ENOMEM; + goto err_cpu; + } + + gpu = calloc(1, sizeof(struct pass_resource_gpu)); + if (!gpu) { + ret = -ENOMEM; + goto err_bus; + } + + memory = calloc(1, sizeof(struct pass_resource_memory)); + if (!memory) { + ret = -ENOMEM; + goto err_gpu; + } + + /* Initialize each h/w resource */ + cpu->dvfs = cpufreq_dvfs_ops; + cpu->hotplug = cpu_hotplus_ops; + cpu->tmu = tmu_ops; + + bus->dvfs = devfreq_dvfs_ops; + bus->tmu = tmu_ops; + + gpu->dvfs = devfreq_dvfs_ops; + gpu->tmu = tmu_ops; + + memory->get_fault_around_bytes = memory_get_fault_around_bytes; + memory->set_fault_around_bytes = memory_set_fault_around_bytes; + + /* Initialize hal_backend_power_funcs */ + power_funcs->cpu = cpu; + power_funcs->bus = bus; + power_funcs->gpu = gpu; + power_funcs->memory = memory; + + *data = (void *)power_funcs; + + return 0; + +err_gpu: + if (gpu) + free(gpu); +err_bus: + if (bus) + free(bus); +err_cpu: + if (cpu) + free(cpu); +err_funcs: + free(power_funcs); + + return ret; +} + +static int power_exit(void *data) +{ + hal_backend_power_funcs *funcs; + + if (!data) + return -EINVAL; + + funcs = (hal_backend_power_funcs *)data; + + if (funcs->cpu) + free(funcs->cpu); + if (funcs->bus) + free(funcs->bus); + if (funcs->gpu) + free(funcs->gpu); + if (funcs->memory) + free(funcs->memory); + + free(funcs); + + return 0; +} + +hal_backend hal_backend_power_data = { + .name = "power-cpu", + .vendor = "", + .abi_version = HAL_ABI_VERSION_TIZEN_6_5, + .init = power_init, + .exit = power_exit, +}; diff --git a/src/sysfs.c b/src/sysfs.c new file mode 100644 index 0000000..23768ce --- /dev/null +++ b/src/sysfs.c @@ -0,0 +1,129 @@ +/* + * PASS (Power Aware System Service) + * + * Copyright (c) 2017 Samsung Electronics Co., Ltd. + * + * 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 +#include + +#include "sysfs.h" + +static int sysfs_read_buf(char *path, char *buf, int len) +{ + int r, fd; + + if ((!path) || (!buf) || (len < 0)) + return -EINVAL; + + fd = open(path, O_RDONLY); + if (fd == -1) + return -ENOENT; + + r = read(fd, buf, len); + close(fd); + + if (r < 0) + return r; + if (r > len) + return -EIO; + + buf[r] = '\0'; + + return 0; +} + +static int sysfs_write_buf(char *path, char *buf) +{ + int w, fd; + + if ((!path) || (!buf)) + return -EINVAL; + + fd = open(path, O_WRONLY); + if (fd == -1) + return -ENOENT; + + w = write(fd, buf, strlen(buf)); + close(fd); + + if (w < 0) + return w; + + return 0; +} + +int sysfs_read_int(char *path, int *val) +{ + char buf[MAX_BUF_SIZE + 1]; + int r; + + if ((!path) || (!val)) + return -EINVAL; + + r = sysfs_read_buf(path, buf, MAX_BUF_SIZE); + if (r < 0) + return r; + + *val = atoi(buf); + return 0; +} + +int sysfs_read_str(char *path, char *str, int len) +{ + int r; + + if ((!path) || (!str) || (len <= 0)) + return -EINVAL; + + r = sysfs_read_buf(path, str, len); + if (r < 0) + return r; + + return 0; +} + +int sysfs_write_int(char *path, int val) +{ + char buf[MAX_BUF_SIZE + 1]; + int w; + + if (!path) + return -EINVAL; + + snprintf(buf, MAX_BUF_SIZE, "%d", val); + w = sysfs_write_buf(path, buf); + if (w < 0) + return w; + + return 0; +} + +int sysfs_write_str(char *path, char *str) +{ + int w; + + if ((!path) || (!str)) + return -EINVAL; + + w = sysfs_write_buf(path, str); + if (w < 0) + return w; + + return 0; +} diff --git a/src/sysfs.h b/src/sysfs.h new file mode 100644 index 0000000..174804f --- /dev/null +++ b/src/sysfs.h @@ -0,0 +1,6 @@ +#define MAX_BUF_SIZE 255 + +int sysfs_read_int(char *path, int *val); +int sysfs_read_str(char *path, char *str, int len); +int sysfs_write_int(char *path, int val); +int sysfs_write_str(char *path, char *str); -- cgit v1.2.3