1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2019, The Linux Foundation. All rights reserved.
4 */
5
6 #include <linux/bitfield.h>
7 #include <linux/qcom_scm.h>
8
9 #include "arm-smmu.h"
10
11 struct qcom_smmu {
12 struct arm_smmu_device smmu;
13 };
14
qcom_sdm845_smmu500_cfg_probe(struct arm_smmu_device * smmu)15 static int qcom_sdm845_smmu500_cfg_probe(struct arm_smmu_device *smmu)
16 {
17 u32 s2cr;
18 u32 smr;
19 int i;
20
21 for (i = 0; i < smmu->num_mapping_groups; i++) {
22 smr = arm_smmu_gr0_read(smmu, ARM_SMMU_GR0_SMR(i));
23 s2cr = arm_smmu_gr0_read(smmu, ARM_SMMU_GR0_S2CR(i));
24
25 smmu->smrs[i].mask = FIELD_GET(SMR_MASK, smr);
26 smmu->smrs[i].id = FIELD_GET(SMR_ID, smr);
27 if (smmu->features & ARM_SMMU_FEAT_EXIDS)
28 smmu->smrs[i].valid = FIELD_GET(S2CR_EXIDVALID, s2cr);
29 else
30 smmu->smrs[i].valid = FIELD_GET(SMR_VALID, smr);
31
32 smmu->s2crs[i].group = NULL;
33 smmu->s2crs[i].count = 0;
34 smmu->s2crs[i].type = FIELD_GET(S2CR_TYPE, s2cr);
35 smmu->s2crs[i].privcfg = FIELD_GET(S2CR_PRIVCFG, s2cr);
36 smmu->s2crs[i].cbndx = FIELD_GET(S2CR_CBNDX, s2cr);
37
38 if (!smmu->smrs[i].valid)
39 continue;
40
41 smmu->s2crs[i].pinned = true;
42 bitmap_set(smmu->context_map, smmu->s2crs[i].cbndx, 1);
43 }
44
45 return 0;
46 }
47
qcom_sdm845_smmu500_reset(struct arm_smmu_device * smmu)48 static int qcom_sdm845_smmu500_reset(struct arm_smmu_device *smmu)
49 {
50 int ret;
51
52 arm_mmu500_reset(smmu);
53
54 /*
55 * To address performance degradation in non-real time clients,
56 * such as USB and UFS, turn off wait-for-safe on sdm845 based boards,
57 * such as MTP and db845, whose firmwares implement secure monitor
58 * call handlers to turn on/off the wait-for-safe logic.
59 */
60 ret = qcom_scm_qsmmu500_wait_safe_toggle(0);
61 if (ret)
62 dev_warn(smmu->dev, "Failed to turn off SAFE logic\n");
63
64 return ret;
65 }
66
67 static const struct arm_smmu_impl qcom_smmu_impl = {
68 .cfg_probe = qcom_sdm845_smmu500_cfg_probe,
69 .reset = qcom_sdm845_smmu500_reset,
70 };
71
qcom_smmu_impl_init(struct arm_smmu_device * smmu)72 struct arm_smmu_device *qcom_smmu_impl_init(struct arm_smmu_device *smmu)
73 {
74 struct qcom_smmu *qsmmu;
75
76 qsmmu = devm_kzalloc(smmu->dev, sizeof(*qsmmu), GFP_KERNEL);
77 if (!qsmmu)
78 return ERR_PTR(-ENOMEM);
79
80 qsmmu->smmu = *smmu;
81
82 qsmmu->smmu.impl = &qcom_smmu_impl;
83 devm_kfree(smmu->dev, smmu);
84
85 return &qsmmu->smmu;
86 }
87