@@ -181,6 +181,7 @@ config QCOM_Q6V5_ADSP
depends on QCOM_SYSMON || QCOM_SYSMON=n
depends on RPMSG_QCOM_GLINK || RPMSG_QCOM_GLINK=n
depends on QCOM_AOSS_QMP || QCOM_AOSS_QMP=n
+ depends on QCOM_PD_MAPPER || QCOM_PD_MAPPER=n
select MFD_SYSCON
select QCOM_PIL_INFO
select QCOM_MDT_LOADER
@@ -23,6 +23,7 @@
#include <linux/remoteproc.h>
#include <linux/reset.h>
#include <linux/soc/qcom/mdt_loader.h>
+#include <linux/soc/qcom/pd_mapper.h>
#include <linux/soc/qcom/smem.h>
#include <linux/soc/qcom/smem_state.h>
@@ -76,6 +77,9 @@ struct adsp_pil_data {
int num_clks;
const char **proxy_pd_names;
const char *load_state;
+
+ size_t num_domains;
+ const struct qcom_pdm_domain_data * const *domains;
};
struct qcom_adsp {
@@ -118,6 +122,9 @@ struct qcom_adsp {
struct qcom_sysmon *sysmon;
int (*shutdown)(struct qcom_adsp *adsp);
+
+ size_t num_domains;
+ const struct qcom_pdm_domain_data * const *domains;
};
static int qcom_rproc_pds_attach(struct device *dev, struct qcom_adsp *adsp,
@@ -382,6 +389,7 @@ static int adsp_start(struct rproc *rproc)
struct qcom_adsp *adsp = rproc->priv;
int ret;
unsigned int val;
+ int i;
ret = qcom_q6v5_prepare(&adsp->q6v5);
if (ret)
@@ -443,8 +451,18 @@ static int adsp_start(struct rproc *rproc)
goto disable_adsp_clks;
}
+ for (i = 0; i < adsp->num_domains; i++) {
+ ret = qcom_pdm_add_domain(adsp->domains[i]);
+ if (ret)
+ goto err_domains;
+ }
+
return 0;
+err_domains:
+ while (--i >= 0)
+ qcom_pdm_del_domain(adsp->domains[i]);
+
disable_adsp_clks:
clk_bulk_disable_unprepare(adsp->num_clks, adsp->clks);
disable_power_domain:
@@ -472,6 +490,10 @@ static int adsp_stop(struct rproc *rproc)
struct qcom_adsp *adsp = rproc->priv;
int handover;
int ret;
+ int i;
+
+ for (i = 0; i < adsp->num_domains; i++)
+ qcom_pdm_del_domain(adsp->domains[i]);
ret = qcom_q6v5_request_stop(&adsp->q6v5, adsp->sysmon);
if (ret == -ETIMEDOUT)
@@ -699,6 +721,8 @@ static int adsp_probe(struct platform_device *pdev)
adsp->rproc = rproc;
adsp->info_name = desc->sysmon_name;
adsp->has_iommu = desc->has_iommu;
+ adsp->num_domains = desc->num_domains;
+ adsp->domains = desc->domains;
platform_set_drvdata(pdev, adsp);
@@ -775,6 +799,45 @@ static void adsp_remove(struct platform_device *pdev)
rproc_free(adsp->rproc);
}
+static const struct qcom_pdm_domain_data adsp_audio_pd = {
+ .domain = "msm/adsp/audio_pd",
+ .instance_id = 74,
+ .services = {
+ "avs/audio",
+ NULL,
+ },
+};
+
+static const struct qcom_pdm_domain_data adsp_charger_pd = {
+ .domain = "msm/adsp/charger_pd",
+ .instance_id = 74,
+ .services = { NULL },
+};
+
+static const struct qcom_pdm_domain_data adsp_root_pd = {
+ .domain = "msm/adsp/root_pd",
+ .instance_id = 74,
+ .services = { NULL },
+};
+
+static const struct qcom_pdm_domain_data adsp_sensor_pd = {
+ .domain = "msm/adsp/sensor_pd",
+ .instance_id = 74,
+ .services = { NULL },
+};
+
+static const struct qcom_pdm_domain_data *sc7280_adsp_domains[] = {
+ &adsp_audio_pd,
+ &adsp_root_pd,
+ &adsp_charger_pd,
+ &adsp_sensor_pd
+};
+
+static const struct qcom_pdm_domain_data *sdm845_adsp_domains[] = {
+ &adsp_audio_pd,
+ &adsp_root_pd,
+};
+
static const struct adsp_pil_data adsp_resource_init = {
.crash_reason_smem = 423,
.firmware_name = "adsp.mdt",
@@ -791,6 +854,8 @@ static const struct adsp_pil_data adsp_resource_init = {
.proxy_pd_names = (const char*[]) {
"cx", NULL
},
+ .num_domains = ARRAY_SIZE(sdm845_adsp_domains),
+ .domains = sdm845_adsp_domains,
};
static const struct adsp_pil_data adsp_sc7280_resource_init = {
@@ -806,6 +871,8 @@ static const struct adsp_pil_data adsp_sc7280_resource_init = {
"gcc_cfg_noc_lpass", NULL
},
.num_clks = 1,
+ .num_domains = ARRAY_SIZE(sc7280_adsp_domains),
+ .domains = sc7280_adsp_domains,
};
static const struct adsp_pil_data cdsp_resource_init = {
Add domain / service configuration for the in-kernel protection domain mapper service. Signed-off-by: Dmitry Baryshkov <dmitry.baryshkov@linaro.org> --- drivers/remoteproc/Kconfig | 1 + drivers/remoteproc/qcom_q6v5_adsp.c | 67 +++++++++++++++++++++++++++++ 2 files changed, 68 insertions(+)