| /* Copyright (c) 2012-2013, The Linux Foundation. All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 and |
| * only version 2 as published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| */ |
| |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/platform_device.h> |
| #include <linux/errno.h> |
| #include <linux/io.h> |
| #include <linux/interrupt.h> |
| #include <linux/list.h> |
| #include <linux/mutex.h> |
| #include <linux/slab.h> |
| #include <linux/iommu.h> |
| #include <linux/clk.h> |
| #include <linux/scatterlist.h> |
| #include <linux/of.h> |
| #include <linux/of_device.h> |
| #include <linux/kmemleak.h> |
| |
| #include <asm/sizes.h> |
| |
| #include <mach/iommu_perfmon.h> |
| #include <mach/iommu_hw-v1.h> |
| #include <mach/msm_iommu_priv.h> |
| #include <mach/iommu.h> |
| #include <mach/scm.h> |
| #include <mach/memory.h> |
| |
| /* bitmap of the page sizes currently supported */ |
| #define MSM_IOMMU_PGSIZES (SZ_4K | SZ_64K | SZ_1M | SZ_16M) |
| |
| /* commands for SCM_SVC_MP */ |
| #define IOMMU_SECURE_CFG 2 |
| #define IOMMU_SECURE_PTBL_SIZE 3 |
| #define IOMMU_SECURE_PTBL_INIT 4 |
| #define IOMMU_SECURE_MAP 6 |
| #define IOMMU_SECURE_UNMAP 7 |
| #define IOMMU_SECURE_MAP2 0x0B |
| #define IOMMU_SECURE_UNMAP2 0x0C |
| #define IOMMU_TLBINVAL_FLAG 0x00000001 |
| |
| /* commands for SCM_SVC_UTIL */ |
| #define IOMMU_DUMP_SMMU_FAULT_REGS 0X0C |
| |
| static struct iommu_access_ops *iommu_access_ops; |
| |
| struct msm_scm_paddr_list { |
| unsigned int list; |
| unsigned int list_size; |
| unsigned int size; |
| }; |
| |
| struct msm_scm_mapping_info { |
| unsigned int id; |
| unsigned int ctx_id; |
| unsigned int va; |
| unsigned int size; |
| }; |
| |
| struct msm_scm_map2_req { |
| struct msm_scm_paddr_list plist; |
| struct msm_scm_mapping_info info; |
| unsigned int flags; |
| }; |
| |
| struct msm_scm_unmap2_req { |
| struct msm_scm_mapping_info info; |
| unsigned int flags; |
| }; |
| |
| #define NUM_DUMP_REGS 14 |
| /* |
| * some space to allow the number of registers returned by the secure |
| * environment to grow |
| */ |
| #define WIGGLE_ROOM (NUM_DUMP_REGS * 2) |
| /* Each entry is a (reg_addr, reg_val) pair, hence the * 2 */ |
| #define SEC_DUMP_SIZE ((NUM_DUMP_REGS * 2) + WIGGLE_ROOM) |
| |
| struct msm_scm_fault_regs_dump { |
| uint32_t dump_size; |
| uint32_t dump_data[SEC_DUMP_SIZE]; |
| } __packed; |
| |
| void msm_iommu_sec_set_access_ops(struct iommu_access_ops *access_ops) |
| { |
| iommu_access_ops = access_ops; |
| } |
| |
| static int msm_iommu_dump_fault_regs(int smmu_id, int cb_num, |
| struct msm_scm_fault_regs_dump *regs) |
| { |
| int ret; |
| |
| struct msm_scm_fault_regs_dump_req { |
| uint32_t id; |
| uint32_t cb_num; |
| phys_addr_t buff; |
| uint32_t len; |
| } req_info; |
| int resp; |
| |
| req_info.id = smmu_id; |
| req_info.cb_num = cb_num; |
| req_info.buff = virt_to_phys(regs); |
| req_info.len = sizeof(*regs); |
| |
| ret = scm_call(SCM_SVC_UTIL, IOMMU_DUMP_SMMU_FAULT_REGS, |
| &req_info, sizeof(req_info), &resp, 1); |
| |
| invalidate_caches((unsigned long) regs, sizeof(*regs), |
| (unsigned long)virt_to_phys(regs)); |
| |
| return ret; |
| } |
| |
| #define EXTRACT_DUMP_REG_KEY(addr, ctx) (addr & ((1 << CTX_SHIFT) - 1)) |
| |
| static int msm_iommu_reg_dump_to_regs( |
| struct msm_iommu_context_reg ctx_regs[], |
| struct msm_scm_fault_regs_dump *dump, int cb_num) |
| { |
| int i, j, ret = 0; |
| const uint32_t nvals = (dump->dump_size / sizeof(uint32_t)); |
| uint32_t *it = (uint32_t *) dump->dump_data; |
| const uint32_t * const end = ((uint32_t *) dump) + nvals; |
| |
| for (i = 1; it < end; it += 2, i += 2) { |
| uint32_t addr = *it; |
| uint32_t val = *(it + 1); |
| struct msm_iommu_context_reg *reg = NULL; |
| |
| for (j = 0; j < MAX_DUMP_REGS; ++j) { |
| if (dump_regs_tbl[j].key == |
| EXTRACT_DUMP_REG_KEY(addr, cb_num)) { |
| reg = &ctx_regs[j]; |
| break; |
| } |
| } |
| |
| if (reg == NULL) { |
| pr_debug("Unknown register in secure CB dump: %x (%x)\n", |
| addr, EXTRACT_DUMP_REG_KEY(addr, cb_num)); |
| continue; |
| } |
| |
| if (reg->valid) { |
| WARN(1, "Invalid (repeated?) register in CB dump: %x\n", |
| addr); |
| continue; |
| } |
| |
| reg->val = val; |
| reg->valid = true; |
| } |
| |
| if (i != nvals) { |
| pr_err("Invalid dump! %d != %d\n", i, nvals); |
| ret = 1; |
| goto out; |
| } |
| |
| for (i = 0; i < MAX_DUMP_REGS; ++i) { |
| if (!ctx_regs[i].valid) { |
| if (dump_regs_tbl[i].must_be_present) { |
| pr_err("Register missing from dump: %s, %lx\n", |
| dump_regs_tbl[i].name, |
| dump_regs_tbl[i].key); |
| ret = 1; |
| } |
| ctx_regs[i].val = 0; |
| } |
| } |
| |
| out: |
| return ret; |
| } |
| |
| irqreturn_t msm_iommu_secure_fault_handler_v2(int irq, void *dev_id) |
| { |
| struct platform_device *pdev = dev_id; |
| struct msm_iommu_drvdata *drvdata; |
| struct msm_iommu_ctx_drvdata *ctx_drvdata; |
| struct msm_scm_fault_regs_dump *regs; |
| int tmp, ret = IRQ_HANDLED; |
| |
| iommu_access_ops->iommu_lock_acquire(0); |
| |
| BUG_ON(!pdev); |
| |
| drvdata = dev_get_drvdata(pdev->dev.parent); |
| BUG_ON(!drvdata); |
| |
| ctx_drvdata = dev_get_drvdata(&pdev->dev); |
| BUG_ON(!ctx_drvdata); |
| |
| regs = kmalloc(sizeof(*regs), GFP_KERNEL); |
| if (!regs) { |
| pr_err("%s: Couldn't allocate memory\n", __func__); |
| goto lock_release; |
| } |
| |
| if (!drvdata->ctx_attach_count) { |
| pr_err("Unexpected IOMMU page fault from secure context bank!\n"); |
| pr_err("name = %s\n", drvdata->name); |
| pr_err("Power is OFF. Unable to read page fault information\n"); |
| /* |
| * We cannot determine which context bank caused the issue so |
| * we just return handled here to ensure IRQ handler code is |
| * happy |
| */ |
| goto free_regs; |
| } |
| |
| iommu_access_ops->iommu_clk_on(drvdata); |
| tmp = msm_iommu_dump_fault_regs(drvdata->sec_id, |
| ctx_drvdata->num, regs); |
| iommu_access_ops->iommu_clk_off(drvdata); |
| |
| if (tmp) { |
| pr_err("%s: Couldn't dump fault registers (%d) %s, ctx: %d\n", |
| __func__, tmp, drvdata->name, ctx_drvdata->num); |
| goto free_regs; |
| } else { |
| struct msm_iommu_context_reg ctx_regs[MAX_DUMP_REGS]; |
| memset(ctx_regs, 0, sizeof(ctx_regs)); |
| tmp = msm_iommu_reg_dump_to_regs(ctx_regs, regs, |
| ctx_drvdata->num); |
| if (!tmp && ctx_regs[DUMP_REG_FSR].val) { |
| if (!ctx_drvdata->attached_domain) { |
| pr_err("Bad domain in interrupt handler\n"); |
| tmp = -ENOSYS; |
| } else { |
| tmp = report_iommu_fault( |
| ctx_drvdata->attached_domain, |
| &ctx_drvdata->pdev->dev, |
| COMBINE_DUMP_REG( |
| ctx_regs[DUMP_REG_FAR1].val, |
| ctx_regs[DUMP_REG_FAR0].val), |
| 0); |
| } |
| |
| /* if the fault wasn't handled by someone else: */ |
| if (tmp == -ENOSYS) { |
| pr_err("Unexpected IOMMU page fault from secure context bank!\n"); |
| pr_err("name = %s\n", drvdata->name); |
| pr_err("context = %s (%d)\n", ctx_drvdata->name, |
| ctx_drvdata->num); |
| pr_err("Interesting registers:\n"); |
| print_ctx_regs(ctx_regs); |
| } |
| } else { |
| ret = IRQ_NONE; |
| } |
| } |
| free_regs: |
| kfree(regs); |
| lock_release: |
| iommu_access_ops->iommu_lock_release(0); |
| return ret; |
| } |
| |
| static int msm_iommu_sec_ptbl_init(void) |
| { |
| struct device_node *np; |
| struct msm_scm_ptbl_init { |
| unsigned int paddr; |
| unsigned int size; |
| unsigned int spare; |
| } pinit; |
| unsigned int *buf; |
| int psize[2] = {0, 0}; |
| unsigned int spare; |
| int ret, ptbl_ret = 0; |
| |
| for_each_compatible_node(np, NULL, "qcom,msm-smmu-v1") |
| if (of_find_property(np, "qcom,iommu-secure-id", NULL)) |
| break; |
| |
| if (!np) |
| return 0; |
| |
| of_node_put(np); |
| ret = scm_call(SCM_SVC_MP, IOMMU_SECURE_PTBL_SIZE, &spare, |
| sizeof(spare), psize, sizeof(psize)); |
| if (ret) { |
| pr_err("scm call IOMMU_SECURE_PTBL_SIZE failed\n"); |
| goto fail; |
| } |
| |
| if (psize[1]) { |
| pr_err("scm call IOMMU_SECURE_PTBL_SIZE failed\n"); |
| goto fail; |
| } |
| |
| buf = kmalloc(psize[0], GFP_KERNEL); |
| if (!buf) { |
| pr_err("%s: Failed to allocate %d bytes for PTBL\n", |
| __func__, psize[0]); |
| ret = -ENOMEM; |
| goto fail; |
| } |
| |
| pinit.paddr = virt_to_phys(buf); |
| pinit.size = psize[0]; |
| |
| ret = scm_call(SCM_SVC_MP, IOMMU_SECURE_PTBL_INIT, &pinit, |
| sizeof(pinit), &ptbl_ret, sizeof(ptbl_ret)); |
| if (ret) { |
| pr_err("scm call IOMMU_SECURE_PTBL_INIT failed\n"); |
| goto fail_mem; |
| } |
| if (ptbl_ret) { |
| pr_err("scm call IOMMU_SECURE_PTBL_INIT extended ret fail\n"); |
| goto fail_mem; |
| } |
| |
| kmemleak_not_leak(buf); |
| |
| return 0; |
| |
| fail_mem: |
| kfree(buf); |
| fail: |
| return ret; |
| } |
| |
| int msm_iommu_sec_program_iommu(int sec_id) |
| { |
| struct msm_scm_sec_cfg { |
| unsigned int id; |
| unsigned int spare; |
| } cfg; |
| int ret, scm_ret = 0; |
| |
| cfg.id = sec_id; |
| |
| ret = scm_call(SCM_SVC_MP, IOMMU_SECURE_CFG, &cfg, sizeof(cfg), |
| &scm_ret, sizeof(scm_ret)); |
| if (ret || scm_ret) { |
| pr_err("scm call IOMMU_SECURE_CFG failed\n"); |
| return ret ? ret : -EINVAL; |
| } |
| |
| return ret; |
| } |
| |
| static int msm_iommu_sec_ptbl_map(struct msm_iommu_drvdata *iommu_drvdata, |
| struct msm_iommu_ctx_drvdata *ctx_drvdata, |
| unsigned long va, phys_addr_t pa, size_t len) |
| { |
| struct msm_scm_map2_req map; |
| void *flush_va; |
| phys_addr_t flush_pa; |
| int ret = 0; |
| |
| map.plist.list = virt_to_phys(&pa); |
| map.plist.list_size = 1; |
| map.plist.size = len; |
| map.info.id = iommu_drvdata->sec_id; |
| map.info.ctx_id = ctx_drvdata->num; |
| map.info.va = va; |
| map.info.size = len; |
| map.flags = IOMMU_TLBINVAL_FLAG; |
| flush_va = &pa; |
| flush_pa = virt_to_phys(&pa); |
| |
| /* |
| * Ensure that the buffer is in RAM by the time it gets to TZ |
| */ |
| clean_caches((unsigned long) flush_va, len, flush_pa); |
| |
| if (scm_call(SCM_SVC_MP, IOMMU_SECURE_MAP2, &map, sizeof(map), &ret, |
| sizeof(ret))) |
| return -EINVAL; |
| if (ret) |
| return -EINVAL; |
| |
| /* Invalidate cache since TZ touched this address range */ |
| invalidate_caches((unsigned long) flush_va, len, flush_pa); |
| |
| return 0; |
| } |
| |
| static unsigned int get_phys_addr(struct scatterlist *sg) |
| { |
| /* |
| * Try sg_dma_address first so that we can |
| * map carveout regions that do not have a |
| * struct page associated with them. |
| */ |
| unsigned int pa = sg_dma_address(sg); |
| if (pa == 0) |
| pa = sg_phys(sg); |
| return pa; |
| } |
| |
| static int msm_iommu_sec_ptbl_map_range(struct msm_iommu_drvdata *iommu_drvdata, |
| struct msm_iommu_ctx_drvdata *ctx_drvdata, |
| unsigned long va, struct scatterlist *sg, size_t len) |
| { |
| struct scatterlist *sgiter; |
| struct msm_scm_map2_req map; |
| unsigned int *pa_list = 0; |
| unsigned int pa, cnt; |
| void *flush_va; |
| unsigned int offset = 0, chunk_offset = 0; |
| int ret, scm_ret; |
| |
| map.info.id = iommu_drvdata->sec_id; |
| map.info.ctx_id = ctx_drvdata->num; |
| map.info.va = va; |
| map.info.size = len; |
| map.flags = IOMMU_TLBINVAL_FLAG; |
| |
| if (sg->length == len) { |
| pa = get_phys_addr(sg); |
| map.plist.list = virt_to_phys(&pa); |
| map.plist.list_size = 1; |
| map.plist.size = len; |
| flush_va = &pa; |
| } else { |
| sgiter = sg; |
| cnt = sg->length / SZ_1M; |
| while ((sgiter = sg_next(sgiter))) |
| cnt += sgiter->length / SZ_1M; |
| |
| pa_list = kmalloc(cnt * sizeof(*pa_list), GFP_KERNEL); |
| if (!pa_list) |
| return -ENOMEM; |
| |
| sgiter = sg; |
| cnt = 0; |
| pa = get_phys_addr(sgiter); |
| while (offset < len) { |
| pa += chunk_offset; |
| pa_list[cnt] = pa; |
| chunk_offset += SZ_1M; |
| offset += SZ_1M; |
| cnt++; |
| |
| if (chunk_offset >= sgiter->length && offset < len) { |
| chunk_offset = 0; |
| sgiter = sg_next(sgiter); |
| pa = get_phys_addr(sgiter); |
| } |
| } |
| |
| map.plist.list = virt_to_phys(pa_list); |
| map.plist.list_size = cnt; |
| map.plist.size = SZ_1M; |
| flush_va = pa_list; |
| } |
| |
| /* |
| * Ensure that the buffer is in RAM by the time it gets to TZ |
| */ |
| clean_caches((unsigned long) flush_va, |
| sizeof(unsigned long) * map.plist.list_size, |
| virt_to_phys(flush_va)); |
| |
| ret = scm_call(SCM_SVC_MP, IOMMU_SECURE_MAP2, &map, sizeof(map), |
| &scm_ret, sizeof(scm_ret)); |
| kfree(pa_list); |
| return ret; |
| } |
| |
| static int msm_iommu_sec_ptbl_unmap(struct msm_iommu_drvdata *iommu_drvdata, |
| struct msm_iommu_ctx_drvdata *ctx_drvdata, |
| unsigned long va, size_t len) |
| { |
| struct msm_scm_unmap2_req unmap; |
| int ret, scm_ret; |
| |
| unmap.info.id = iommu_drvdata->sec_id; |
| unmap.info.ctx_id = ctx_drvdata->num; |
| unmap.info.va = va; |
| unmap.info.size = len; |
| unmap.flags = IOMMU_TLBINVAL_FLAG; |
| |
| ret = scm_call(SCM_SVC_MP, IOMMU_SECURE_UNMAP2, &unmap, sizeof(unmap), |
| &scm_ret, sizeof(scm_ret)); |
| return ret; |
| } |
| |
| static int msm_iommu_domain_init(struct iommu_domain *domain, int flags) |
| { |
| struct msm_iommu_priv *priv; |
| |
| priv = kzalloc(sizeof(*priv), GFP_KERNEL); |
| if (!priv) |
| return -ENOMEM; |
| |
| INIT_LIST_HEAD(&priv->list_attached); |
| domain->priv = priv; |
| return 0; |
| } |
| |
| static void msm_iommu_domain_destroy(struct iommu_domain *domain) |
| { |
| struct msm_iommu_priv *priv; |
| |
| iommu_access_ops->iommu_lock_acquire(0); |
| priv = domain->priv; |
| domain->priv = NULL; |
| |
| kfree(priv); |
| iommu_access_ops->iommu_lock_release(0); |
| } |
| |
| static int msm_iommu_attach_dev(struct iommu_domain *domain, struct device *dev) |
| { |
| struct msm_iommu_priv *priv; |
| struct msm_iommu_drvdata *iommu_drvdata; |
| struct msm_iommu_ctx_drvdata *ctx_drvdata; |
| struct msm_iommu_ctx_drvdata *tmp_drvdata; |
| int ret = 0; |
| |
| iommu_access_ops->iommu_lock_acquire(0); |
| |
| priv = domain->priv; |
| if (!priv || !dev) { |
| ret = -EINVAL; |
| goto fail; |
| } |
| |
| iommu_drvdata = dev_get_drvdata(dev->parent); |
| ctx_drvdata = dev_get_drvdata(dev); |
| if (!iommu_drvdata || !ctx_drvdata) { |
| ret = -EINVAL; |
| goto fail; |
| } |
| |
| if (!list_empty(&ctx_drvdata->attached_elm)) { |
| ret = -EBUSY; |
| goto fail; |
| } |
| |
| list_for_each_entry(tmp_drvdata, &priv->list_attached, attached_elm) |
| if (tmp_drvdata == ctx_drvdata) { |
| ret = -EBUSY; |
| goto fail; |
| } |
| |
| ret = iommu_access_ops->iommu_power_on(iommu_drvdata); |
| if (ret) |
| goto fail; |
| |
| /* We can only do this once */ |
| if (!iommu_drvdata->ctx_attach_count) { |
| ret = iommu_access_ops->iommu_clk_on(iommu_drvdata); |
| if (ret) { |
| iommu_access_ops->iommu_power_off(iommu_drvdata); |
| goto fail; |
| } |
| |
| ret = msm_iommu_sec_program_iommu(iommu_drvdata->sec_id); |
| |
| /* bfb settings are always programmed by HLOS */ |
| program_iommu_bfb_settings(iommu_drvdata->base, |
| iommu_drvdata->bfb_settings); |
| |
| iommu_access_ops->iommu_clk_off(iommu_drvdata); |
| if (ret) { |
| iommu_access_ops->iommu_power_off(iommu_drvdata); |
| goto fail; |
| } |
| } |
| |
| list_add(&(ctx_drvdata->attached_elm), &priv->list_attached); |
| ctx_drvdata->attached_domain = domain; |
| ++iommu_drvdata->ctx_attach_count; |
| |
| iommu_access_ops->iommu_lock_release(0); |
| |
| msm_iommu_attached(dev->parent); |
| return ret; |
| fail: |
| iommu_access_ops->iommu_lock_release(0); |
| return ret; |
| } |
| |
| static void msm_iommu_detach_dev(struct iommu_domain *domain, |
| struct device *dev) |
| { |
| struct msm_iommu_drvdata *iommu_drvdata; |
| struct msm_iommu_ctx_drvdata *ctx_drvdata; |
| |
| msm_iommu_detached(dev->parent); |
| |
| iommu_access_ops->iommu_lock_acquire(0); |
| if (!dev) |
| goto fail; |
| |
| iommu_drvdata = dev_get_drvdata(dev->parent); |
| ctx_drvdata = dev_get_drvdata(dev); |
| if (!iommu_drvdata || !ctx_drvdata || !ctx_drvdata->attached_domain) |
| goto fail; |
| |
| list_del_init(&ctx_drvdata->attached_elm); |
| ctx_drvdata->attached_domain = NULL; |
| |
| iommu_access_ops->iommu_power_off(iommu_drvdata); |
| BUG_ON(iommu_drvdata->ctx_attach_count == 0); |
| --iommu_drvdata->ctx_attach_count; |
| fail: |
| iommu_access_ops->iommu_lock_release(0); |
| } |
| |
| static int get_drvdata(struct iommu_domain *domain, |
| struct msm_iommu_drvdata **iommu_drvdata, |
| struct msm_iommu_ctx_drvdata **ctx_drvdata) |
| { |
| struct msm_iommu_priv *priv = domain->priv; |
| struct msm_iommu_ctx_drvdata *ctx; |
| |
| list_for_each_entry(ctx, &priv->list_attached, attached_elm) { |
| if (ctx->attached_domain == domain) |
| break; |
| } |
| |
| if (ctx->attached_domain != domain) |
| return -EINVAL; |
| |
| *ctx_drvdata = ctx; |
| *iommu_drvdata = dev_get_drvdata(ctx->pdev->dev.parent); |
| return 0; |
| } |
| |
| static int msm_iommu_map(struct iommu_domain *domain, unsigned long va, |
| phys_addr_t pa, size_t len, int prot) |
| { |
| struct msm_iommu_drvdata *iommu_drvdata; |
| struct msm_iommu_ctx_drvdata *ctx_drvdata; |
| int ret = 0; |
| |
| iommu_access_ops->iommu_lock_acquire(0); |
| |
| ret = get_drvdata(domain, &iommu_drvdata, &ctx_drvdata); |
| if (ret) |
| goto fail; |
| |
| iommu_access_ops->iommu_clk_on(iommu_drvdata); |
| ret = msm_iommu_sec_ptbl_map(iommu_drvdata, ctx_drvdata, |
| va, pa, len); |
| iommu_access_ops->iommu_clk_off(iommu_drvdata); |
| fail: |
| iommu_access_ops->iommu_lock_release(0); |
| return ret; |
| } |
| |
| static size_t msm_iommu_unmap(struct iommu_domain *domain, unsigned long va, |
| size_t len) |
| { |
| struct msm_iommu_drvdata *iommu_drvdata; |
| struct msm_iommu_ctx_drvdata *ctx_drvdata; |
| int ret = -ENODEV; |
| |
| iommu_access_ops->iommu_lock_acquire(0); |
| |
| ret = get_drvdata(domain, &iommu_drvdata, &ctx_drvdata); |
| if (ret) |
| goto fail; |
| |
| iommu_access_ops->iommu_clk_on(iommu_drvdata); |
| ret = msm_iommu_sec_ptbl_unmap(iommu_drvdata, ctx_drvdata, |
| va, len); |
| iommu_access_ops->iommu_clk_off(iommu_drvdata); |
| fail: |
| iommu_access_ops->iommu_lock_release(0); |
| |
| /* the IOMMU API requires us to return how many bytes were unmapped */ |
| len = ret ? 0 : len; |
| return len; |
| } |
| |
| static int msm_iommu_map_range(struct iommu_domain *domain, unsigned int va, |
| struct scatterlist *sg, unsigned int len, |
| int prot) |
| { |
| int ret; |
| struct msm_iommu_drvdata *iommu_drvdata; |
| struct msm_iommu_ctx_drvdata *ctx_drvdata; |
| |
| iommu_access_ops->iommu_lock_acquire(0); |
| |
| ret = get_drvdata(domain, &iommu_drvdata, &ctx_drvdata); |
| if (ret) |
| goto fail; |
| iommu_access_ops->iommu_clk_on(iommu_drvdata); |
| ret = msm_iommu_sec_ptbl_map_range(iommu_drvdata, ctx_drvdata, |
| va, sg, len); |
| iommu_access_ops->iommu_clk_off(iommu_drvdata); |
| fail: |
| iommu_access_ops->iommu_lock_release(0); |
| return ret; |
| } |
| |
| |
| static int msm_iommu_unmap_range(struct iommu_domain *domain, unsigned int va, |
| unsigned int len) |
| { |
| struct msm_iommu_drvdata *iommu_drvdata; |
| struct msm_iommu_ctx_drvdata *ctx_drvdata; |
| int ret; |
| |
| iommu_access_ops->iommu_lock_acquire(0); |
| |
| ret = get_drvdata(domain, &iommu_drvdata, &ctx_drvdata); |
| if (ret) |
| goto fail; |
| |
| iommu_access_ops->iommu_clk_on(iommu_drvdata); |
| ret = msm_iommu_sec_ptbl_unmap(iommu_drvdata, ctx_drvdata, va, len); |
| iommu_access_ops->iommu_clk_off(iommu_drvdata); |
| |
| fail: |
| iommu_access_ops->iommu_lock_release(0); |
| return 0; |
| } |
| |
| static phys_addr_t msm_iommu_iova_to_phys(struct iommu_domain *domain, |
| unsigned long va) |
| { |
| return 0; |
| } |
| |
| static int msm_iommu_domain_has_cap(struct iommu_domain *domain, |
| unsigned long cap) |
| { |
| return 0; |
| } |
| |
| static phys_addr_t msm_iommu_get_pt_base_addr(struct iommu_domain *domain) |
| { |
| return 0; |
| } |
| |
| static struct iommu_ops msm_iommu_ops = { |
| .domain_init = msm_iommu_domain_init, |
| .domain_destroy = msm_iommu_domain_destroy, |
| .attach_dev = msm_iommu_attach_dev, |
| .detach_dev = msm_iommu_detach_dev, |
| .map = msm_iommu_map, |
| .unmap = msm_iommu_unmap, |
| .map_range = msm_iommu_map_range, |
| .unmap_range = msm_iommu_unmap_range, |
| .iova_to_phys = msm_iommu_iova_to_phys, |
| .domain_has_cap = msm_iommu_domain_has_cap, |
| .get_pt_base_addr = msm_iommu_get_pt_base_addr, |
| .pgsize_bitmap = MSM_IOMMU_PGSIZES, |
| }; |
| |
| static int __init msm_iommu_sec_init(void) |
| { |
| int ret; |
| |
| ret = bus_register(&msm_iommu_sec_bus_type); |
| if (ret) |
| goto fail; |
| |
| bus_set_iommu(&msm_iommu_sec_bus_type, &msm_iommu_ops); |
| ret = msm_iommu_sec_ptbl_init(); |
| fail: |
| return ret; |
| } |
| |
| subsys_initcall(msm_iommu_sec_init); |
| |
| MODULE_LICENSE("GPL v2"); |
| MODULE_DESCRIPTION("MSM SMMU Secure Driver"); |