1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright (c) 2019, The Linux Foundation. All rights reserved.
6 #include <linux/acpi.h>
7 #include <linux/adreno-smmu-priv.h>
8 #include <linux/delay.h>
9 #include <linux/of_device.h>
10 #include <linux/firmware/qcom/qcom_scm.h>
13 #include "arm-smmu-qcom.h"
15 #define QCOM_DUMMY_VAL -1
17 static struct qcom_smmu *to_qcom_smmu(struct arm_smmu_device *smmu)
19 return container_of(smmu, struct qcom_smmu, smmu);
22 static void qcom_smmu_tlb_sync(struct arm_smmu_device *smmu, int page,
25 unsigned int spin_cnt, delay;
28 arm_smmu_writel(smmu, page, sync, QCOM_DUMMY_VAL);
29 for (delay = 1; delay < TLB_LOOP_TIMEOUT; delay *= 2) {
30 for (spin_cnt = TLB_SPIN_COUNT; spin_cnt > 0; spin_cnt--) {
31 reg = arm_smmu_readl(smmu, page, status);
32 if (!(reg & ARM_SMMU_sTLBGSTATUS_GSACTIVE))
39 qcom_smmu_tlb_sync_debug(smmu);
42 static void qcom_adreno_smmu_write_sctlr(struct arm_smmu_device *smmu, int idx,
45 struct qcom_smmu *qsmmu = to_qcom_smmu(smmu);
48 * On the GPU device we want to process subsequent transactions after a
49 * fault to keep the GPU from hanging
51 reg |= ARM_SMMU_SCTLR_HUPCF;
53 if (qsmmu->stall_enabled & BIT(idx))
54 reg |= ARM_SMMU_SCTLR_CFCFG;
56 arm_smmu_cb_write(smmu, idx, ARM_SMMU_CB_SCTLR, reg);
59 static void qcom_adreno_smmu_get_fault_info(const void *cookie,
60 struct adreno_smmu_fault_info *info)
62 struct arm_smmu_domain *smmu_domain = (void *)cookie;
63 struct arm_smmu_cfg *cfg = &smmu_domain->cfg;
64 struct arm_smmu_device *smmu = smmu_domain->smmu;
66 info->fsr = arm_smmu_cb_read(smmu, cfg->cbndx, ARM_SMMU_CB_FSR);
67 info->fsynr0 = arm_smmu_cb_read(smmu, cfg->cbndx, ARM_SMMU_CB_FSYNR0);
68 info->fsynr1 = arm_smmu_cb_read(smmu, cfg->cbndx, ARM_SMMU_CB_FSYNR1);
69 info->far = arm_smmu_cb_readq(smmu, cfg->cbndx, ARM_SMMU_CB_FAR);
70 info->cbfrsynra = arm_smmu_gr1_read(smmu, ARM_SMMU_GR1_CBFRSYNRA(cfg->cbndx));
71 info->ttbr0 = arm_smmu_cb_readq(smmu, cfg->cbndx, ARM_SMMU_CB_TTBR0);
72 info->contextidr = arm_smmu_cb_read(smmu, cfg->cbndx, ARM_SMMU_CB_CONTEXTIDR);
75 static void qcom_adreno_smmu_set_stall(const void *cookie, bool enabled)
77 struct arm_smmu_domain *smmu_domain = (void *)cookie;
78 struct arm_smmu_cfg *cfg = &smmu_domain->cfg;
79 struct qcom_smmu *qsmmu = to_qcom_smmu(smmu_domain->smmu);
82 qsmmu->stall_enabled |= BIT(cfg->cbndx);
84 qsmmu->stall_enabled &= ~BIT(cfg->cbndx);
87 static void qcom_adreno_smmu_resume_translation(const void *cookie, bool terminate)
89 struct arm_smmu_domain *smmu_domain = (void *)cookie;
90 struct arm_smmu_cfg *cfg = &smmu_domain->cfg;
91 struct arm_smmu_device *smmu = smmu_domain->smmu;
95 reg |= ARM_SMMU_RESUME_TERMINATE;
97 arm_smmu_cb_write(smmu, cfg->cbndx, ARM_SMMU_CB_RESUME, reg);
100 #define QCOM_ADRENO_SMMU_GPU_SID 0
102 static bool qcom_adreno_smmu_is_gpu_device(struct device *dev)
104 struct iommu_fwspec *fwspec = dev_iommu_fwspec_get(dev);
108 * The GPU will always use SID 0 so that is a handy way to uniquely
109 * identify it and configure it for per-instance pagetables
111 for (i = 0; i < fwspec->num_ids; i++) {
112 u16 sid = FIELD_GET(ARM_SMMU_SMR_ID, fwspec->ids[i]);
114 if (sid == QCOM_ADRENO_SMMU_GPU_SID)
121 static const struct io_pgtable_cfg *qcom_adreno_smmu_get_ttbr1_cfg(
124 struct arm_smmu_domain *smmu_domain = (void *)cookie;
125 struct io_pgtable *pgtable =
126 io_pgtable_ops_to_pgtable(smmu_domain->pgtbl_ops);
127 return &pgtable->cfg;
131 * Local implementation to configure TTBR0 with the specified pagetable config.
132 * The GPU driver will call this to enable TTBR0 when per-instance pagetables
136 static int qcom_adreno_smmu_set_ttbr0_cfg(const void *cookie,
137 const struct io_pgtable_cfg *pgtbl_cfg)
139 struct arm_smmu_domain *smmu_domain = (void *)cookie;
140 struct io_pgtable *pgtable = io_pgtable_ops_to_pgtable(smmu_domain->pgtbl_ops);
141 struct arm_smmu_cfg *cfg = &smmu_domain->cfg;
142 struct arm_smmu_cb *cb = &smmu_domain->smmu->cbs[cfg->cbndx];
144 /* The domain must have split pagetables already enabled */
145 if (cb->tcr[0] & ARM_SMMU_TCR_EPD1)
148 /* If the pagetable config is NULL, disable TTBR0 */
150 /* Do nothing if it is already disabled */
151 if ((cb->tcr[0] & ARM_SMMU_TCR_EPD0))
154 /* Set TCR to the original configuration */
155 cb->tcr[0] = arm_smmu_lpae_tcr(&pgtable->cfg);
156 cb->ttbr[0] = FIELD_PREP(ARM_SMMU_TTBRn_ASID, cb->cfg->asid);
158 u32 tcr = cb->tcr[0];
160 /* Don't call this again if TTBR0 is already enabled */
161 if (!(cb->tcr[0] & ARM_SMMU_TCR_EPD0))
164 tcr |= arm_smmu_lpae_tcr(pgtbl_cfg);
165 tcr &= ~(ARM_SMMU_TCR_EPD0 | ARM_SMMU_TCR_EPD1);
168 cb->ttbr[0] = pgtbl_cfg->arm_lpae_s1_cfg.ttbr;
169 cb->ttbr[0] |= FIELD_PREP(ARM_SMMU_TTBRn_ASID, cb->cfg->asid);
172 arm_smmu_write_context_bank(smmu_domain->smmu, cb->cfg->cbndx);
177 static int qcom_adreno_smmu_alloc_context_bank(struct arm_smmu_domain *smmu_domain,
178 struct arm_smmu_device *smmu,
179 struct device *dev, int start)
184 * Assign context bank 0 to the GPU device so the GPU hardware can
187 if (qcom_adreno_smmu_is_gpu_device(dev)) {
192 count = smmu->num_context_banks;
195 return __arm_smmu_alloc_bitmap(smmu->context_map, start, count);
198 static bool qcom_adreno_can_do_ttbr1(struct arm_smmu_device *smmu)
200 const struct device_node *np = smmu->dev->of_node;
202 if (of_device_is_compatible(np, "qcom,msm8996-smmu-v2"))
208 static int qcom_adreno_smmu_init_context(struct arm_smmu_domain *smmu_domain,
209 struct io_pgtable_cfg *pgtbl_cfg, struct device *dev)
211 struct adreno_smmu_priv *priv;
213 smmu_domain->cfg.flush_walk_prefer_tlbiasid = true;
215 /* Only enable split pagetables for the GPU device (SID 0) */
216 if (!qcom_adreno_smmu_is_gpu_device(dev))
220 * All targets that use the qcom,adreno-smmu compatible string *should*
221 * be AARCH64 stage 1 but double check because the arm-smmu code assumes
222 * that is the case when the TTBR1 quirk is enabled
224 if (qcom_adreno_can_do_ttbr1(smmu_domain->smmu) &&
225 (smmu_domain->stage == ARM_SMMU_DOMAIN_S1) &&
226 (smmu_domain->cfg.fmt == ARM_SMMU_CTX_FMT_AARCH64))
227 pgtbl_cfg->quirks |= IO_PGTABLE_QUIRK_ARM_TTBR1;
230 * Initialize private interface with GPU:
233 priv = dev_get_drvdata(dev);
234 priv->cookie = smmu_domain;
235 priv->get_ttbr1_cfg = qcom_adreno_smmu_get_ttbr1_cfg;
236 priv->set_ttbr0_cfg = qcom_adreno_smmu_set_ttbr0_cfg;
237 priv->get_fault_info = qcom_adreno_smmu_get_fault_info;
238 priv->set_stall = qcom_adreno_smmu_set_stall;
239 priv->resume_translation = qcom_adreno_smmu_resume_translation;
244 static const struct of_device_id qcom_smmu_client_of_match[] __maybe_unused = {
245 { .compatible = "qcom,adreno" },
246 { .compatible = "qcom,mdp4" },
247 { .compatible = "qcom,mdss" },
248 { .compatible = "qcom,sc7180-mdss" },
249 { .compatible = "qcom,sc7180-mss-pil" },
250 { .compatible = "qcom,sc7280-mdss" },
251 { .compatible = "qcom,sc7280-mss-pil" },
252 { .compatible = "qcom,sc8180x-mdss" },
253 { .compatible = "qcom,sc8280xp-mdss" },
254 { .compatible = "qcom,sm8150-mdss" },
255 { .compatible = "qcom,sm8250-mdss" },
256 { .compatible = "qcom,sdm845-mdss" },
257 { .compatible = "qcom,sdm845-mss-pil" },
261 static int qcom_smmu_init_context(struct arm_smmu_domain *smmu_domain,
262 struct io_pgtable_cfg *pgtbl_cfg, struct device *dev)
264 smmu_domain->cfg.flush_walk_prefer_tlbiasid = true;
269 static int qcom_smmu_cfg_probe(struct arm_smmu_device *smmu)
271 unsigned int last_s2cr = ARM_SMMU_GR0_S2CR(smmu->num_mapping_groups - 1);
272 struct qcom_smmu *qsmmu = to_qcom_smmu(smmu);
278 * With some firmware versions writes to S2CR of type FAULT are
279 * ignored, and writing BYPASS will end up written as FAULT in the
280 * register. Perform a write to S2CR to detect if this is the case and
281 * if so reserve a context bank to emulate bypass streams.
283 reg = FIELD_PREP(ARM_SMMU_S2CR_TYPE, S2CR_TYPE_BYPASS) |
284 FIELD_PREP(ARM_SMMU_S2CR_CBNDX, 0xff) |
285 FIELD_PREP(ARM_SMMU_S2CR_PRIVCFG, S2CR_PRIVCFG_DEFAULT);
286 arm_smmu_gr0_write(smmu, last_s2cr, reg);
287 reg = arm_smmu_gr0_read(smmu, last_s2cr);
288 if (FIELD_GET(ARM_SMMU_S2CR_TYPE, reg) != S2CR_TYPE_BYPASS) {
289 qsmmu->bypass_quirk = true;
290 qsmmu->bypass_cbndx = smmu->num_context_banks - 1;
292 set_bit(qsmmu->bypass_cbndx, smmu->context_map);
294 arm_smmu_cb_write(smmu, qsmmu->bypass_cbndx, ARM_SMMU_CB_SCTLR, 0);
296 reg = FIELD_PREP(ARM_SMMU_CBAR_TYPE, CBAR_TYPE_S1_TRANS_S2_BYPASS);
297 arm_smmu_gr1_write(smmu, ARM_SMMU_GR1_CBAR(qsmmu->bypass_cbndx), reg);
300 for (i = 0; i < smmu->num_mapping_groups; i++) {
301 smr = arm_smmu_gr0_read(smmu, ARM_SMMU_GR0_SMR(i));
303 if (FIELD_GET(ARM_SMMU_SMR_VALID, smr)) {
304 /* Ignore valid bit for SMR mask extraction. */
305 smr &= ~ARM_SMMU_SMR_VALID;
306 smmu->smrs[i].id = FIELD_GET(ARM_SMMU_SMR_ID, smr);
307 smmu->smrs[i].mask = FIELD_GET(ARM_SMMU_SMR_MASK, smr);
308 smmu->smrs[i].valid = true;
310 smmu->s2crs[i].type = S2CR_TYPE_BYPASS;
311 smmu->s2crs[i].privcfg = S2CR_PRIVCFG_DEFAULT;
312 smmu->s2crs[i].cbndx = 0xff;
319 static void qcom_smmu_write_s2cr(struct arm_smmu_device *smmu, int idx)
321 struct arm_smmu_s2cr *s2cr = smmu->s2crs + idx;
322 struct qcom_smmu *qsmmu = to_qcom_smmu(smmu);
323 u32 cbndx = s2cr->cbndx;
324 u32 type = s2cr->type;
327 if (qsmmu->bypass_quirk) {
328 if (type == S2CR_TYPE_BYPASS) {
330 * Firmware with quirky S2CR handling will substitute
331 * BYPASS writes with FAULT, so point the stream to the
332 * reserved context bank and ask for translation on the
335 type = S2CR_TYPE_TRANS;
336 cbndx = qsmmu->bypass_cbndx;
337 } else if (type == S2CR_TYPE_FAULT) {
339 * Firmware with quirky S2CR handling will ignore FAULT
340 * writes, so trick it to write FAULT by asking for a
343 type = S2CR_TYPE_BYPASS;
348 reg = FIELD_PREP(ARM_SMMU_S2CR_TYPE, type) |
349 FIELD_PREP(ARM_SMMU_S2CR_CBNDX, cbndx) |
350 FIELD_PREP(ARM_SMMU_S2CR_PRIVCFG, s2cr->privcfg);
351 arm_smmu_gr0_write(smmu, ARM_SMMU_GR0_S2CR(idx), reg);
354 static int qcom_smmu_def_domain_type(struct device *dev)
356 const struct of_device_id *match =
357 of_match_device(qcom_smmu_client_of_match, dev);
359 return match ? IOMMU_DOMAIN_IDENTITY : 0;
362 static int qcom_sdm845_smmu500_reset(struct arm_smmu_device *smmu)
366 arm_mmu500_reset(smmu);
369 * To address performance degradation in non-real time clients,
370 * such as USB and UFS, turn off wait-for-safe on sdm845 based boards,
371 * such as MTP and db845, whose firmwares implement secure monitor
372 * call handlers to turn on/off the wait-for-safe logic.
374 ret = qcom_scm_qsmmu500_wait_safe_toggle(0);
376 dev_warn(smmu->dev, "Failed to turn off SAFE logic\n");
381 static const struct arm_smmu_impl qcom_smmu_v2_impl = {
382 .init_context = qcom_smmu_init_context,
383 .cfg_probe = qcom_smmu_cfg_probe,
384 .def_domain_type = qcom_smmu_def_domain_type,
385 .write_s2cr = qcom_smmu_write_s2cr,
386 .tlb_sync = qcom_smmu_tlb_sync,
389 static const struct arm_smmu_impl qcom_smmu_500_impl = {
390 .init_context = qcom_smmu_init_context,
391 .cfg_probe = qcom_smmu_cfg_probe,
392 .def_domain_type = qcom_smmu_def_domain_type,
393 .reset = arm_mmu500_reset,
394 .write_s2cr = qcom_smmu_write_s2cr,
395 .tlb_sync = qcom_smmu_tlb_sync,
398 static const struct arm_smmu_impl sdm845_smmu_500_impl = {
399 .init_context = qcom_smmu_init_context,
400 .cfg_probe = qcom_smmu_cfg_probe,
401 .def_domain_type = qcom_smmu_def_domain_type,
402 .reset = qcom_sdm845_smmu500_reset,
403 .write_s2cr = qcom_smmu_write_s2cr,
404 .tlb_sync = qcom_smmu_tlb_sync,
407 static const struct arm_smmu_impl qcom_adreno_smmu_v2_impl = {
408 .init_context = qcom_adreno_smmu_init_context,
409 .def_domain_type = qcom_smmu_def_domain_type,
410 .alloc_context_bank = qcom_adreno_smmu_alloc_context_bank,
411 .write_sctlr = qcom_adreno_smmu_write_sctlr,
412 .tlb_sync = qcom_smmu_tlb_sync,
415 static const struct arm_smmu_impl qcom_adreno_smmu_500_impl = {
416 .init_context = qcom_adreno_smmu_init_context,
417 .def_domain_type = qcom_smmu_def_domain_type,
418 .reset = arm_mmu500_reset,
419 .alloc_context_bank = qcom_adreno_smmu_alloc_context_bank,
420 .write_sctlr = qcom_adreno_smmu_write_sctlr,
421 .tlb_sync = qcom_smmu_tlb_sync,
424 static struct arm_smmu_device *qcom_smmu_create(struct arm_smmu_device *smmu,
425 const struct qcom_smmu_match_data *data)
427 const struct device_node *np = smmu->dev->of_node;
428 const struct arm_smmu_impl *impl;
429 struct qcom_smmu *qsmmu;
432 return ERR_PTR(-EINVAL);
434 if (np && of_device_is_compatible(np, "qcom,adreno-smmu"))
435 impl = data->adreno_impl;
442 /* Check to make sure qcom_scm has finished probing */
443 if (!qcom_scm_is_available())
444 return ERR_PTR(-EPROBE_DEFER);
446 qsmmu = devm_krealloc(smmu->dev, smmu, sizeof(*qsmmu), GFP_KERNEL);
448 return ERR_PTR(-ENOMEM);
450 qsmmu->smmu.impl = impl;
451 qsmmu->cfg = data->cfg;
456 /* Implementation Defined Register Space 0 register offsets */
457 static const u32 qcom_smmu_impl0_reg_offset[] = {
458 [QCOM_SMMU_TBU_PWR_STATUS] = 0x2204,
459 [QCOM_SMMU_STATS_SYNC_INV_TBU_ACK] = 0x25dc,
460 [QCOM_SMMU_MMU2QSS_AND_SAFE_WAIT_CNTR] = 0x2670,
463 static const struct qcom_smmu_config qcom_smmu_impl0_cfg = {
464 .reg_offset = qcom_smmu_impl0_reg_offset,
468 * It is not yet possible to use MDP SMMU with the bypass quirk on the msm8996,
469 * there are not enough context banks.
471 static const struct qcom_smmu_match_data msm8996_smmu_data = {
473 .adreno_impl = &qcom_adreno_smmu_v2_impl,
476 static const struct qcom_smmu_match_data qcom_smmu_v2_data = {
477 .impl = &qcom_smmu_v2_impl,
478 .adreno_impl = &qcom_adreno_smmu_v2_impl,
481 static const struct qcom_smmu_match_data sdm845_smmu_500_data = {
482 .impl = &sdm845_smmu_500_impl,
484 * No need for adreno impl here. On sdm845 the Adreno SMMU is handled
485 * by the separate sdm845-smmu-v2 device.
487 /* Also no debug configuration. */
490 static const struct qcom_smmu_match_data qcom_smmu_500_impl0_data = {
491 .impl = &qcom_smmu_500_impl,
492 .adreno_impl = &qcom_adreno_smmu_500_impl,
493 .cfg = &qcom_smmu_impl0_cfg,
497 * Do not add any more qcom,SOC-smmu-500 entries to this list, unless they need
498 * special handling and can not be covered by the qcom,smmu-500 entry.
500 static const struct of_device_id __maybe_unused qcom_smmu_impl_of_match[] = {
501 { .compatible = "qcom,msm8996-smmu-v2", .data = &msm8996_smmu_data },
502 { .compatible = "qcom,msm8998-smmu-v2", .data = &qcom_smmu_v2_data },
503 { .compatible = "qcom,qcm2290-smmu-500", .data = &qcom_smmu_500_impl0_data },
504 { .compatible = "qcom,qdu1000-smmu-500", .data = &qcom_smmu_500_impl0_data },
505 { .compatible = "qcom,sc7180-smmu-500", .data = &qcom_smmu_500_impl0_data },
506 { .compatible = "qcom,sc7280-smmu-500", .data = &qcom_smmu_500_impl0_data },
507 { .compatible = "qcom,sc8180x-smmu-500", .data = &qcom_smmu_500_impl0_data },
508 { .compatible = "qcom,sc8280xp-smmu-500", .data = &qcom_smmu_500_impl0_data },
509 { .compatible = "qcom,sdm630-smmu-v2", .data = &qcom_smmu_v2_data },
510 { .compatible = "qcom,sdm845-smmu-v2", .data = &qcom_smmu_v2_data },
511 { .compatible = "qcom,sdm845-smmu-500", .data = &sdm845_smmu_500_data },
512 { .compatible = "qcom,sm6115-smmu-500", .data = &qcom_smmu_500_impl0_data},
513 { .compatible = "qcom,sm6125-smmu-500", .data = &qcom_smmu_500_impl0_data },
514 { .compatible = "qcom,sm6350-smmu-v2", .data = &qcom_smmu_v2_data },
515 { .compatible = "qcom,sm6350-smmu-500", .data = &qcom_smmu_500_impl0_data },
516 { .compatible = "qcom,sm6375-smmu-500", .data = &qcom_smmu_500_impl0_data },
517 { .compatible = "qcom,sm8150-smmu-500", .data = &qcom_smmu_500_impl0_data },
518 { .compatible = "qcom,sm8250-smmu-500", .data = &qcom_smmu_500_impl0_data },
519 { .compatible = "qcom,sm8350-smmu-500", .data = &qcom_smmu_500_impl0_data },
520 { .compatible = "qcom,sm8450-smmu-500", .data = &qcom_smmu_500_impl0_data },
521 { .compatible = "qcom,smmu-500", .data = &qcom_smmu_500_impl0_data },
526 static struct acpi_platform_list qcom_acpi_platlist[] = {
527 { "LENOVO", "CB-01 ", 0x8180, ACPI_SIG_IORT, equal, "QCOM SMMU" },
528 { "QCOM ", "QCOMEDK2", 0x8180, ACPI_SIG_IORT, equal, "QCOM SMMU" },
533 struct arm_smmu_device *qcom_smmu_impl_init(struct arm_smmu_device *smmu)
535 const struct device_node *np = smmu->dev->of_node;
536 const struct of_device_id *match;
540 /* Match platform for ACPI boot */
541 if (acpi_match_platform_list(qcom_acpi_platlist) >= 0)
542 return qcom_smmu_create(smmu, &qcom_smmu_500_impl0_data);
546 match = of_match_node(qcom_smmu_impl_of_match, np);
548 return qcom_smmu_create(smmu, match->data);