power: msm8953: Support power profiles

Author: Michael Bestas <mkbestas@lineageos.org>
Date:   Fri May 25 22:57:04 2018 +0300

    power: msm8953: Add support for power profiles

    * Based on legacy HAL implementation
    * We no longer handle POWER_HINT_INTERACTION and POWER_HINT_LAUNCH,
      they're now supported directly by Qualcomm mp-ctl.

    Change-Id: If5b239a6fa1880e2e650f0e5c50c1357e8e3ac1a

Author: Corinna Vinschen <xda@vinschen.de>
Date:   Sun Aug 26 22:11:49 2018 +0200

    power: set_power_profile: handle errors

    * Make sure current_power_profile reflects actual setting.
    * Propagate error condition up to caller.
    * Handle error from set_power_profile in power_hint_override.

    Change-Id: I8518d921a94c912c75f59fbf993a8f44116bdca9
    Signed-off-by: Corinna Vinschen <xda@vinschen.de>

Author: dianlujitao <dianlujitao@lineageos.org>
Date:   Thu Sep 6 21:43:14 2018 +0800

    power: Clean up hint IDs

     * Group MPCTL v3 opcodes according to major type.
     * Remove some unused/dead opcodes.
     * Rename some misleading/inconsistency names.

    Change-Id: I3a06930c8fff18a50f77cb230951dbd43d62fed3

Author: dianlujitao <dianlujitao@lineageos.org>
Date:   Sat Feb 23 20:24:57 2019 +0800

    power: Pass NULL parameter in powerHint if data is zero

     * This restores the behavior in AOSP and CAF power HAL to avoid
       confusion.

    Change-Id: I72f5bb9286e2f57121e39eea82d2fe8854989393

Change-Id: I991bb6e3b20a0e6c8674136b309561af491d277f

1 files changed, 99 insertions, 0 deletions

diff --git a/power-8953.c b/power-8953.c
index 3d76c6b..7862ee0 100644
--- a/power-8953.c
+++ b/power-8953.c
@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2016, 2018, The Linux Foundation. All rights reserved.
+ * Copyright (C) 2018-2019 The LineageOS Project
  *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions are
@@ -59,6 +60,91 @@ const int kMinInteractiveDuration = 500;  /* ms */
 const int kMaxInteractiveDuration = 5000; /* ms */
 const int kMaxLaunchDuration = 5000;      /* ms */
 
+static int current_power_profile = PROFILE_BALANCED;
+
+// clang-format off
+static int profile_high_performance[] = {
+    SCHED_BOOST_ON_V3, 0x1,
+    ALL_CPUS_PWR_CLPS_DIS_V3, 0x1,
+    CPUS_ONLINE_MIN_BIG, 0x4,
+    MIN_FREQ_BIG_CORE_0, 0xFFF,
+    MIN_FREQ_LITTLE_CORE_0, 0xFFF,
+    GPU_MIN_POWER_LEVEL, 0x1,
+    SCHED_PREFER_IDLE_DIS_V3, 0x1,
+    SCHED_SMALL_TASK, 0x1,
+    SCHED_MOSTLY_IDLE_NR_RUN, 0x1,
+    SCHED_MOSTLY_IDLE_LOAD, 0x1,
+};
+
+static int profile_power_save[] = {
+    CPUS_ONLINE_MAX_BIG, 0x1,
+    MAX_FREQ_BIG_CORE_0, 0x3bf,
+    MAX_FREQ_LITTLE_CORE_0, 0x300,
+};
+
+static int profile_bias_power[] = {
+    MAX_FREQ_BIG_CORE_0, 0x4B0,
+    MAX_FREQ_LITTLE_CORE_0, 0x300,
+};
+
+static int profile_bias_performance[] = {
+    CPUS_ONLINE_MAX_BIG, 0x4,
+    MIN_FREQ_BIG_CORE_0, 0x540,
+};
+// clang-format on
+
+#ifdef INTERACTION_BOOST
+int get_number_of_profiles() {
+    return 5;
+}
+#endif
+
+static int set_power_profile(void* data) {
+    int profile = data ? *((int*)data) : 0;
+    int ret = -EINVAL;
+    const char* profile_name = NULL;
+
+    if (profile == current_power_profile) return 0;
+
+    ALOGV("%s: Profile=%d", __func__, profile);
+
+    if (current_power_profile != PROFILE_BALANCED) {
+        undo_hint_action(DEFAULT_PROFILE_HINT_ID);
+        ALOGV("%s: Hint undone", __func__);
+        current_power_profile = PROFILE_BALANCED;
+    }
+
+    if (profile == PROFILE_POWER_SAVE) {
+        ret = perform_hint_action(DEFAULT_PROFILE_HINT_ID, profile_power_save,
+                                  ARRAY_SIZE(profile_power_save));
+        profile_name = "powersave";
+
+    } else if (profile == PROFILE_HIGH_PERFORMANCE) {
+        ret = perform_hint_action(DEFAULT_PROFILE_HINT_ID, profile_high_performance,
+                                  ARRAY_SIZE(profile_high_performance));
+        profile_name = "performance";
+
+    } else if (profile == PROFILE_BIAS_POWER) {
+        ret = perform_hint_action(DEFAULT_PROFILE_HINT_ID, profile_bias_power,
+                                  ARRAY_SIZE(profile_bias_power));
+        profile_name = "bias power";
+
+    } else if (profile == PROFILE_BIAS_PERFORMANCE) {
+        ret = perform_hint_action(DEFAULT_PROFILE_HINT_ID, profile_bias_performance,
+                                  ARRAY_SIZE(profile_bias_performance));
+        profile_name = "bias perf";
+    } else if (profile == PROFILE_BALANCED) {
+        ret = 0;
+        profile_name = "balanced";
+    }
+
+    if (ret == 0) {
+        current_power_profile = profile;
+        ALOGD("%s: Set %s mode", __func__, profile_name);
+    }
+    return ret;
+}
+
 /**
  * Returns true if the target is SDM632.
  */
@@ -215,6 +301,19 @@ static int process_activity_launch_hint(void* data) {
 
 int power_hint_override(power_hint_t hint, void* data) {
     int ret_val = HINT_NONE;
+
+    if (hint == POWER_HINT_SET_PROFILE) {
+        if (set_power_profile(data) < 0)
+            ALOGE("Setting power profile failed. perf HAL not started?");
+        return HINT_HANDLED;
+    }
+
+    // Skip other hints in high/low power modes
+    if (current_power_profile == PROFILE_POWER_SAVE ||
+        current_power_profile == PROFILE_HIGH_PERFORMANCE) {
+        return HINT_HANDLED;
+    }
+
     switch (hint) {
         case POWER_HINT_VIDEO_ENCODE:
             ret_val = process_video_encode_hint(data);