LXR linux/drivers/gpu/drm/msm/msm

   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * Copyright (C) 2013 Red Hat
   4 * Author: Rob Clark <robdclark@gmail.com>
   5 */
   6
   7#include "msm_drv.h"
   8#include "msm_mmu.h"
   9
  10struct msm_iommu {
  11        struct msm_mmu base;
  12        struct iommu_domain *domain;
  13};
  14#define to_msm_iommu(x) container_of(x, struct msm_iommu, base)
  15
  16static int msm_fault_handler(struct iommu_domain *domain, struct device *dev,
  17                unsigned long iova, int flags, void *arg)
  18{
  19        struct msm_iommu *iommu = arg;
  20        if (iommu->base.handler)
  21                return iommu->base.handler(iommu->base.arg, iova, flags);
  22        pr_warn_ratelimited("*** fault: iova=%16lx, flags=%d\n", iova, flags);
  23        return 0;
  24}
  25
  26static void msm_iommu_detach(struct msm_mmu *mmu)
  27{
  28        struct msm_iommu *iommu = to_msm_iommu(mmu);
  29
  30        iommu_detach_device(iommu->domain, mmu->dev);
  31}
  32
  33static int msm_iommu_map(struct msm_mmu *mmu, uint64_t iova,
  34                struct sg_table *sgt, size_t len, int prot)
  35{
  36        struct msm_iommu *iommu = to_msm_iommu(mmu);
  37        size_t ret;
  38
  39        ret = iommu_map_sg(iommu->domain, iova, sgt->sgl, sgt->nents, prot);
  40        WARN_ON(!ret);
  41
  42        return (ret == len) ? 0 : -EINVAL;
  43}
  44
  45static int msm_iommu_unmap(struct msm_mmu *mmu, uint64_t iova, size_t len)
  46{
  47        struct msm_iommu *iommu = to_msm_iommu(mmu);
  48
  49        iommu_unmap(iommu->domain, iova, len);
  50
  51        return 0;
  52}
  53
  54static void msm_iommu_destroy(struct msm_mmu *mmu)
  55{
  56        struct msm_iommu *iommu = to_msm_iommu(mmu);
  57        iommu_domain_free(iommu->domain);
  58        kfree(iommu);
  59}
  60
  61static const struct msm_mmu_funcs funcs = {
  62                .detach = msm_iommu_detach,
  63                .map = msm_iommu_map,
  64                .unmap = msm_iommu_unmap,
  65                .destroy = msm_iommu_destroy,
  66};
  67
  68struct msm_mmu *msm_iommu_new(struct device *dev, struct iommu_domain *domain)
  69{
  70        struct msm_iommu *iommu;
  71        int ret;
  72
  73        if (!domain)
  74                return ERR_PTR(-ENODEV);
  75
  76        iommu = kzalloc(sizeof(*iommu), GFP_KERNEL);
  77        if (!iommu)
  78                return ERR_PTR(-ENOMEM);
  79
  80        iommu->domain = domain;
  81        msm_mmu_init(&iommu->base, dev, &funcs);
  82        iommu_set_fault_handler(domain, msm_fault_handler, iommu);
  83
  84        ret = iommu_attach_device(iommu->domain, dev);
  85        if (ret) {
  86                kfree(iommu);
  87                return ERR_PTR(ret);
  88        }
  89
  90        return &iommu->base;
  91}
  92