// SPDX-License-Identifier: GPL-2.0-only /* * Copyright (c) 2019, The Linux Foundation. All rights reserved. */ #include #include #include "arm-smmu.h" struct qcom_smmu { struct arm_smmu_device smmu; }; static int qcom_sdm845_smmu500_cfg_probe(struct arm_smmu_device *smmu) { u32 s2cr; u32 smr; int i; for (i = 0; i < smmu->num_mapping_groups; i++) { smr = arm_smmu_gr0_read(smmu, ARM_SMMU_GR0_SMR(i)); s2cr = arm_smmu_gr0_read(smmu, ARM_SMMU_GR0_S2CR(i)); smmu->smrs[i].mask = FIELD_GET(SMR_MASK, smr); smmu->smrs[i].id = FIELD_GET(SMR_ID, smr); if (smmu->features & ARM_SMMU_FEAT_EXIDS) smmu->smrs[i].valid = FIELD_GET(S2CR_EXIDVALID, s2cr); else smmu->smrs[i].valid = FIELD_GET(SMR_VALID, smr); smmu->s2crs[i].group = NULL; smmu->s2crs[i].count = 0; smmu->s2crs[i].type = FIELD_GET(S2CR_TYPE, s2cr); smmu->s2crs[i].privcfg = FIELD_GET(S2CR_PRIVCFG, s2cr); smmu->s2crs[i].cbndx = FIELD_GET(S2CR_CBNDX, s2cr); if (!smmu->smrs[i].valid) continue; smmu->s2crs[i].pinned = true; bitmap_set(smmu->context_map, smmu->s2crs[i].cbndx, 1); } return 0; } static int qcom_sdm845_smmu500_reset(struct arm_smmu_device *smmu) { int ret; arm_mmu500_reset(smmu); /* * To address performance degradation in non-real time clients, * such as USB and UFS, turn off wait-for-safe on sdm845 based boards, * such as MTP and db845, whose firmwares implement secure monitor * call handlers to turn on/off the wait-for-safe logic. */ ret = qcom_scm_qsmmu500_wait_safe_toggle(0); if (ret) dev_warn(smmu->dev, "Failed to turn off SAFE logic\n"); return ret; } static const struct arm_smmu_impl qcom_smmu_impl = { .cfg_probe = qcom_sdm845_smmu500_cfg_probe, .reset = qcom_sdm845_smmu500_reset, }; struct arm_smmu_device *qcom_smmu_impl_init(struct arm_smmu_device *smmu) { struct qcom_smmu *qsmmu; qsmmu = devm_kzalloc(smmu->dev, sizeof(*qsmmu), GFP_KERNEL); if (!qsmmu) return ERR_PTR(-ENOMEM); qsmmu->smmu = *smmu; qsmmu->smmu.impl = &qcom_smmu_impl; devm_kfree(smmu->dev, smmu); return &qsmmu->smmu; }