191 lines · 4.8 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0-only/* Copyright 2024-2025 Tomeu Vizoso <tomeu@tomeuvizoso.net> */ #include <drm/drm_device.h>#include <drm/drm_print.h>#include <drm/drm_utils.h>#include <drm/rocket_accel.h>#include <linux/dma-mapping.h>#include <linux/iommu.h> #include "rocket_drv.h"#include "rocket_gem.h" static void rocket_gem_bo_free(struct drm_gem_object *obj){	struct rocket_gem_object *bo = to_rocket_bo(obj);	struct rocket_file_priv *rocket_priv = bo->driver_priv;	size_t unmapped; 	drm_WARN_ON(obj->dev, refcount_read(&bo->base.pages_use_count) > 1); 	unmapped = iommu_unmap(bo->domain->domain, bo->mm.start, bo->size);	drm_WARN_ON(obj->dev, unmapped != bo->size); 	mutex_lock(&rocket_priv->mm_lock);	drm_mm_remove_node(&bo->mm);	mutex_unlock(&rocket_priv->mm_lock); 	rocket_iommu_domain_put(bo->domain);	bo->domain = NULL; 	drm_gem_shmem_free(&bo->base);} static const struct drm_gem_object_funcs rocket_gem_funcs = {	.free = rocket_gem_bo_free,	.print_info = drm_gem_shmem_object_print_info,	.pin = drm_gem_shmem_object_pin,	.unpin = drm_gem_shmem_object_unpin,	.get_sg_table = drm_gem_shmem_object_get_sg_table,	.vmap = drm_gem_shmem_object_vmap,	.vunmap = drm_gem_shmem_object_vunmap,	.mmap = drm_gem_shmem_object_mmap,	.vm_ops = &drm_gem_shmem_vm_ops,}; struct drm_gem_object *rocket_gem_create_object(struct drm_device *dev, size_t size){	struct rocket_gem_object *obj; 	obj = kzalloc_obj(*obj);	if (!obj)		return ERR_PTR(-ENOMEM); 	obj->base.base.funcs = &rocket_gem_funcs; 	return &obj->base.base;} int rocket_ioctl_create_bo(struct drm_device *dev, void *data, struct drm_file *file){	struct rocket_file_priv *rocket_priv = file->driver_priv;	struct drm_rocket_create_bo *args = data;	struct drm_gem_shmem_object *shmem_obj;	struct rocket_gem_object *rkt_obj;	struct drm_gem_object *gem_obj;	struct sg_table *sgt;	int ret; 	shmem_obj = drm_gem_shmem_create(dev, args->size);	if (IS_ERR(shmem_obj))		return PTR_ERR(shmem_obj); 	gem_obj = &shmem_obj->base;	rkt_obj = to_rocket_bo(gem_obj); 	rkt_obj->driver_priv = rocket_priv;	rkt_obj->domain = rocket_iommu_domain_get(rocket_priv);	rkt_obj->size = args->size;	rkt_obj->offset = 0; 	sgt = drm_gem_shmem_get_pages_sgt(shmem_obj);	if (IS_ERR(sgt)) {		ret = PTR_ERR(sgt);		goto err;	} 	mutex_lock(&rocket_priv->mm_lock);	ret = drm_mm_insert_node_generic(&rocket_priv->mm, &rkt_obj->mm,					 rkt_obj->size, PAGE_SIZE,					 0, 0);	mutex_unlock(&rocket_priv->mm_lock);	if (ret)		goto err; 	ret = iommu_map_sgtable(rocket_priv->domain->domain,				rkt_obj->mm.start,				shmem_obj->sgt,				IOMMU_READ | IOMMU_WRITE);	if (ret < 0 || ret < args->size) {		drm_err(dev, "failed to map buffer: size=%d request_size=%u\n",			ret, args->size);		ret = -ENOMEM;		goto err_remove_node;	} 	/* iommu_map_sgtable might have aligned the size */	rkt_obj->size = ret;	args->offset = drm_vma_node_offset_addr(&gem_obj->vma_node);	args->dma_address = rkt_obj->mm.start; 	ret = drm_gem_handle_create(file, gem_obj, &args->handle);	if (ret)		goto err_unmap; 	drm_gem_object_put(gem_obj); 	return 0; err_unmap:	iommu_unmap(rocket_priv->domain->domain,		    rkt_obj->mm.start, rkt_obj->size); err_remove_node:	mutex_lock(&rocket_priv->mm_lock);	drm_mm_remove_node(&rkt_obj->mm);	mutex_unlock(&rocket_priv->mm_lock); err:	drm_gem_shmem_object_free(gem_obj); 	return ret;} int rocket_ioctl_prep_bo(struct drm_device *dev, void *data, struct drm_file *file){	struct drm_rocket_prep_bo *args = data;	unsigned long timeout = drm_timeout_abs_to_jiffies(args->timeout_ns);	struct drm_gem_object *gem_obj;	struct drm_gem_shmem_object *shmem_obj;	long ret = 0; 	if (args->reserved != 0) {		drm_dbg(dev, "Reserved field in drm_rocket_prep_bo struct should be 0.\n");		return -EINVAL;	} 	gem_obj = drm_gem_object_lookup(file, args->handle);	if (!gem_obj)		return -ENOENT; 	ret = dma_resv_wait_timeout(gem_obj->resv, DMA_RESV_USAGE_WRITE, true, timeout);	if (!ret)		ret = timeout ? -ETIMEDOUT : -EBUSY;	else if (ret > 0)		ret = 0; 	shmem_obj = &to_rocket_bo(gem_obj)->base; 	dma_sync_sgtable_for_cpu(dev->dev, shmem_obj->sgt, DMA_BIDIRECTIONAL); 	drm_gem_object_put(gem_obj); 	return ret;} int rocket_ioctl_fini_bo(struct drm_device *dev, void *data, struct drm_file *file){	struct drm_rocket_fini_bo *args = data;	struct drm_gem_shmem_object *shmem_obj;	struct rocket_gem_object *rkt_obj;	struct drm_gem_object *gem_obj; 	if (args->reserved != 0) {		drm_dbg(dev, "Reserved field in drm_rocket_fini_bo struct should be 0.\n");		return -EINVAL;	} 	gem_obj = drm_gem_object_lookup(file, args->handle);	if (!gem_obj)		return -ENOENT; 	rkt_obj = to_rocket_bo(gem_obj);	shmem_obj = &rkt_obj->base; 	dma_sync_sgtable_for_device(dev->dev, shmem_obj->sgt, DMA_BIDIRECTIONAL); 	drm_gem_object_put(gem_obj); 	return 0;}