power: msm8996: Support power profiles

Author: dianlujitao <dianlujitao@lineageos.org>
Date:   Thu Jan 18 23:34:38 2018 +0800

    power: msm8996: Add support for power profiles

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

    Change-Id: I03a5229fc8b97e8fb593ba831625c001e926e1d6

Author: Zhao Wei Liew <zhaoweiliew@gmail.com>
Date:   Tue Jun 21 10:44:49 2016 +0800

    power: msm8996: Support boost and perf profile hints

    Change-Id: I010d4d1d3fb495e523b065c11ca95c4305530f9f

Author: Ricardo Cerqueira <ricardo@cyngn.com>
Date:   Sat Jul 16 02:15:14 2016 +0100

    power: 8996: Fix only sending the first pair out of every perf profile

    When acquiring the perflock, we were only passing the first pair of
    arguments out of every profile. Because...
    sizeof(*)/sizeof(int) is always 2 on a 64bit arch. There's no
    need to put the profile into a pointer anyway, just pass it directly to
    ARRAY_SIZE (and the lock)

    Change-Id: I25f2a9b059290c3a0b36fc8dc29c711da938430e

Author: dianlujitao <dianlujitao@lineageos.org>
Date:   Fri Mar 2 12:40:04 2018 +0800

    power: Don't advertise power profile when interaction boost disabled

     * Power profile is fake news without interaction boost.

    Change-Id: Iceea885e6cb176f0620e76cfc335b7da500a0c2b

Author: Zhao Wei Liew <zhaoweiliew@gmail.com>
Date:   Sun Jun 26 11:37:59 2016 +0800

    power: Use ARRAY_SIZE macro where possible

    The common macro was introduced in the commit:
            8fe35cc7dd88bbb82a7732591fac4b8ecd935970

    So use it.

    Change-Id: Ie47d0e6b91b7bba378b0fdf53a345a021b0c2d48

Author: Michael Bestas <mkbestas@lineageos.org>
Date:   Mon Mar 26 05:21:23 2018 +0300

    power: Consistent skipping of non perf profile hints

    Change-Id: I9129de9046df7b922af7b32eac94167776f820cf

Author: Michael Bestas <mkbestas@lineageos.org>
Date:   Fri May 25 21:30:28 2018 +0300

    power: Spring cleanup

    * Cleanup SoC specific files:
     - Fix code spacing and indentation
     - Remove dead code
     - Remove useless comments
     - Remove useless logs
     - Make code uniform between the files so it's easier to diff
     - Use declared enums when possible for power hints

    Change-Id: Ie1378c94c53b33299927c5eb1bfc19f1a42b8743

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: I0b58da6f840caf78e79c1a463d4211460be3c02d

1 files changed, 96 insertions, 0 deletions

diff --git a/power-8996.c b/power-8996.c
index 0ef4dfd..411f7c1 100644
--- a/power-8996.c
+++ b/power-8996.c
@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2015-2016, 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
@@ -56,6 +57,88 @@ 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, 0x2,
+    CPUS_ONLINE_MIN_LITTLE, 0x2,
+    MIN_FREQ_BIG_CORE_0, 0xFFF,
+    MIN_FREQ_LITTLE_CORE_0, 0xFFF,
+};
+
+static int profile_power_save[] = {
+    CPUS_ONLINE_MAX_BIG, 0x1,
+    MAX_FREQ_BIG_CORE_0, 0x3E8,
+    MAX_FREQ_LITTLE_CORE_0, 0x3E8,
+};
+
+static int profile_bias_power[] = {
+    MAX_FREQ_BIG_CORE_0, 0x514,
+    MAX_FREQ_LITTLE_CORE_0, 0x3E8,
+};
+
+static int profile_bias_performance[] = {
+    CPUS_ONLINE_MAX_BIG, 0x2,
+    CPUS_ONLINE_MAX_LITTLE, 0x2,
+    MIN_FREQ_BIG_CORE_0, 0x578,
+};
+// 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;
+}
+
 typedef enum {
     NORMAL_MODE = 0,
     SUSTAINED_MODE = 1,
@@ -273,6 +356,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);