mirror of
git://nv-tegra.nvidia.com/linux-nv-oot.git
synced 2025-12-22 17:25:35 +03:00
ccdd799b54
In Linux v6.11, the 'platform_driver' structure 'remove' callback was updated to return void instead of 'int'. Update the MODS drivers as necessary to fix this. Note that we can simply remove the mods_dmabuf 'remove' function because it does nothing. Bug 4749580 Change-Id: I8ac05a7b713916b9aca1694ca828682808df3287 Signed-off-by: Jon Hunter <jonathanh@nvidia.com> Reviewed-on: https://git-master.nvidia.com/r/c/linux-nv-oot/+/3235514 GVS: buildbot_gerritrpt <buildbot_gerritrpt@nvidia.com> Reviewed-by: Chris Dragan <kdragan@nvidia.com> Reviewed-by: Carl Dong <carld@nvidia.com>
140 lines
3.6 KiB
C
140 lines
3.6 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/* SPDX-FileCopyrightText: Copyright (c) 2014-2023, NVIDIA CORPORATION. All rights reserved. */
|
|
|
|
#include <linux/dma-buf.h>
|
|
#include <linux/module.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <linux/platform_device.h>
|
|
|
|
#include "mods_internal.h"
|
|
|
|
MODULE_IMPORT_NS(DMA_BUF);
|
|
|
|
static struct device *dummy_device;
|
|
|
|
static bool dummy_device_registered;
|
|
|
|
int esc_mods_dmabuf_get_phys_addr(struct mods_client *client,
|
|
struct MODS_DMABUF_GET_PHYSICAL_ADDRESS *op)
|
|
{
|
|
int err = 0;
|
|
struct dma_buf *dmabuf = NULL;
|
|
struct dma_buf_attachment *attachment = NULL;
|
|
struct sg_table *sgt = NULL;
|
|
u64 remaining_offset = op->offset;
|
|
u64 total_size = 0;
|
|
u32 total_segments = 0;
|
|
phys_addr_t physical_address = 0;
|
|
u64 segment_size = 0;
|
|
struct scatterlist *sg;
|
|
unsigned int sg_index;
|
|
|
|
LOG_ENT();
|
|
|
|
cl_debug(DEBUG_MEM_DETAILED,
|
|
"dmabuf get phys addr fd=%d offs=0x%llx\n",
|
|
op->buf_fd, (unsigned long long)op->offset);
|
|
|
|
dmabuf = dma_buf_get(op->buf_fd);
|
|
if (IS_ERR_OR_NULL(dmabuf)) {
|
|
cl_error("failed to get dma buf from fd %d\n", op->buf_fd);
|
|
LOG_EXT();
|
|
return IS_ERR(dmabuf) ? PTR_ERR(dmabuf) : -EINVAL;
|
|
}
|
|
|
|
WARN_ON(!dummy_device_registered);
|
|
attachment = dma_buf_attach(dmabuf, dummy_device);
|
|
if (IS_ERR_OR_NULL(attachment)) {
|
|
cl_error("failed to attach dma buf fd %d\n", op->buf_fd);
|
|
err = IS_ERR(attachment) ? PTR_ERR(attachment) : -EFAULT;
|
|
goto buf_attach_fail;
|
|
}
|
|
|
|
sgt = dma_buf_map_attachment(attachment, DMA_BIDIRECTIONAL);
|
|
if (IS_ERR_OR_NULL(sgt)) {
|
|
cl_error("failed to map dma buf fd %d\n", op->buf_fd);
|
|
err = IS_ERR(sgt) ? PTR_ERR(sgt) : -EFAULT;
|
|
goto buf_map_fail;
|
|
}
|
|
|
|
for_each_sg(sgt->sgl, sg, sgt->nents, sg_index) {
|
|
total_size += sg->length;
|
|
++total_segments;
|
|
if (remaining_offset >= sg->length) {
|
|
/* haven't reached segment yet, or empty sg */
|
|
remaining_offset -= sg->length;
|
|
} else if (segment_size == 0) {
|
|
/* first sg in segment */
|
|
physical_address = sg_phys(sg) + remaining_offset;
|
|
segment_size = sg->length - remaining_offset;
|
|
remaining_offset = 0;
|
|
} else if (sg_phys(sg) == physical_address + segment_size) {
|
|
/* contiguous sg; append to segment */
|
|
segment_size += sg->length;
|
|
} else {
|
|
/* discontiguous sg; end segment */
|
|
break;
|
|
}
|
|
}
|
|
|
|
cl_debug(DEBUG_MEM_DETAILED, "traversed %u segments, 0x%llx size\n",
|
|
total_segments,
|
|
(unsigned long long)total_size);
|
|
|
|
if (segment_size == 0) {
|
|
cl_error(
|
|
"offset 0x%llx exceeds allocation size 0x%llx, fd %d\n",
|
|
(unsigned long long)op->offset,
|
|
(unsigned long long)total_size,
|
|
op->buf_fd);
|
|
err = -EINVAL;
|
|
} else {
|
|
op->physical_address = physical_address;
|
|
op->segment_size = segment_size;
|
|
}
|
|
|
|
dma_buf_unmap_attachment(attachment, sgt, DMA_BIDIRECTIONAL);
|
|
|
|
buf_map_fail:
|
|
dma_buf_detach(dmabuf, attachment);
|
|
|
|
buf_attach_fail:
|
|
dma_buf_put(dmabuf);
|
|
|
|
LOG_EXT();
|
|
return err;
|
|
}
|
|
|
|
static int mods_dmabuf_probe(struct platform_device *pdev)
|
|
{
|
|
dma_set_mask(&pdev->dev, DMA_BIT_MASK(39));
|
|
dummy_device = &pdev->dev;
|
|
|
|
dummy_device_registered = true;
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id of_ids[] = {
|
|
{ .compatible = "nvidia,mods_test" },
|
|
{ }
|
|
};
|
|
|
|
static struct platform_driver mods_dummy_driver = {
|
|
.probe = mods_dmabuf_probe,
|
|
.driver = {
|
|
.name = "nvidia_mods_dummy_driver",
|
|
.owner = THIS_MODULE,
|
|
.of_match_table = of_ids,
|
|
},
|
|
};
|
|
|
|
int mods_init_dmabuf(void)
|
|
{
|
|
return platform_driver_register(&mods_dummy_driver);
|
|
}
|
|
|
|
void mods_exit_dmabuf(void)
|
|
{
|
|
platform_driver_unregister(&mods_dummy_driver);
|
|
}
|