[PATCH v4 06/10] drm/amd/pm: Add xgmi plpd to aldebaran pm_policy

[Lijo Lazar]

On aldebaran, allow changing xgmi plpd policy through pm_policy sysfs
interface.

Signed-off-by: Lijo Lazar <lijo.la...@amd.com>
Reviewed-by: Hawking Zhang <hawking.zh...@amd.com>
---
 .../drm/amd/pm/swsmu/smu13/aldebaran_ppt.c    | 35 +++++++++++++++++++
 1 file changed, 35 insertions(+)

diff --git a/drivers/gpu/drm/amd/pm/swsmu/smu13/aldebaran_ppt.c 
b/drivers/gpu/drm/amd/pm/swsmu/smu13/aldebaran_ppt.c
index a22eb6bbb05e..66d386ef1da9 100644
--- a/drivers/gpu/drm/amd/pm/swsmu/smu13/aldebaran_ppt.c
+++ b/drivers/gpu/drm/amd/pm/swsmu/smu13/aldebaran_ppt.c
@@ -266,9 +266,30 @@ static int aldebaran_tables_init(struct smu_context *smu)
        return 0;
 }
 
+static int aldebaran_select_plpd_policy(struct smu_context *smu, int level)
+{
+       struct amdgpu_device *adev = smu->adev;
+
+       /* The message only works on master die and NACK will be sent
+          back for other dies, only send it on master die */
+       if (adev->smuio.funcs->get_socket_id(adev) ||
+           adev->smuio.funcs->get_die_id(adev))
+               return 0;
+
+       if (level == XGMI_PLPD_DEFAULT)
+               return smu_cmn_send_smc_msg_with_param(
+                       smu, SMU_MSG_GmiPwrDnControl, 0, NULL);
+       else if (level == XGMI_PLPD_DISALLOW)
+               return smu_cmn_send_smc_msg_with_param(
+                       smu, SMU_MSG_GmiPwrDnControl, 1, NULL);
+       else
+               return -EINVAL;
+}
+
 static int aldebaran_allocate_dpm_context(struct smu_context *smu)
 {
        struct smu_dpm_context *smu_dpm = &smu->smu_dpm;
+       struct smu_dpm_policy *policy;
 
        smu_dpm->dpm_context = kzalloc(sizeof(struct smu_13_0_dpm_context),
                                       GFP_KERNEL);
@@ -276,6 +297,20 @@ static int aldebaran_allocate_dpm_context(struct 
smu_context *smu)
                return -ENOMEM;
        smu_dpm->dpm_context_size = sizeof(struct smu_13_0_dpm_context);
 
+       smu_dpm->dpm_policies =
+               kzalloc(sizeof(struct smu_dpm_policy_ctxt), GFP_KERNEL);
+
+       if (!smu_dpm->dpm_policies)
+               return -ENOMEM;
+
+       policy = &(smu_dpm->dpm_policies->policies[0]);
+       policy->policy_type = PP_PM_POLICY_XGMI_PLPD;
+       policy->level_mask = BIT(XGMI_PLPD_DISALLOW) | BIT(XGMI_PLPD_DEFAULT);
+       policy->current_level = XGMI_PLPD_DEFAULT;
+       policy->set_policy = aldebaran_select_plpd_policy;
+       smu_cmn_generic_plpd_policy_desc(policy);
+       smu_dpm->dpm_policies->policy_mask |= BIT(PP_PM_POLICY_XGMI_PLPD);
+
        return 0;
 }
 
-- 
2.25.1