mirror of
git://nv-tegra.nvidia.com/linux-nv-oot.git
synced 2025-12-22 09:11:26 +03:00
97835cded8
Bug 4165184 Change-Id: Id5d570cc4e5c3364d696271b1333e47e02e17b9e Signed-off-by: Chris Dragan <kdragan@nvidia.com> Reviewed-on: https://git-master.nvidia.com/r/c/linux-nv-oot/+/2976924 Reviewed-by: Bharat Nihalani <bnihalani@nvidia.com> GVS: Gerrit_Virtual_Submit <buildbot_gerritrpt@nvidia.com>
146 lines
3.3 KiB
C
146 lines
3.3 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/* SPDX-FileCopyrightText: Copyright (c) 2019-2023, NVIDIA CORPORATION. All rights reserved. */
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/device.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/module.h>
|
|
#include <linux/vmalloc.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <linux/debugfs.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/version.h>
|
|
#include <linux/dma-buf.h>
|
|
|
|
#include <linux/of.h>
|
|
#include <linux/of_platform.h>
|
|
#include <linux/acpi.h>
|
|
#include "mods_internal.h"
|
|
|
|
#define MODS_MAX_SMMU_DEVICES 16
|
|
static struct mods_smmu_dev mods_smmu_devs[MODS_MAX_SMMU_DEVICES];
|
|
static int mods_smmu_dev_num;
|
|
|
|
struct mods_smmu_dev *get_mods_smmu_device(u32 index)
|
|
{
|
|
struct mods_smmu_dev *pdev = NULL;
|
|
|
|
if (index < mods_smmu_dev_num)
|
|
pdev = &mods_smmu_devs[index];
|
|
else
|
|
mods_error_printk("mods smmu dev index %d error\n", index);
|
|
return pdev;
|
|
}
|
|
|
|
int get_mods_smmu_device_index(const char *name)
|
|
{
|
|
int idx;
|
|
int dev_num = mods_smmu_dev_num;
|
|
|
|
for (idx = 0; idx < dev_num; idx++) {
|
|
if (strcmp(mods_smmu_devs[idx].dev_name, name) == 0)
|
|
return idx;
|
|
}
|
|
mods_error_printk("mods smmu device %s not found\n", name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int mods_smmu_driver_probe(struct platform_device *pdev)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
const char *dev_name = NULL;
|
|
int err = 0;
|
|
int dev_idx;
|
|
|
|
LOG_ENT();
|
|
|
|
if (device_property_present(dev, "dev-names")) {
|
|
err = device_property_read_string(dev, "dev-names", &dev_name);
|
|
if (err < 0) {
|
|
mods_error_printk(
|
|
"smmu probe failed to read dev-names, ret=%d\n", err);
|
|
LOG_EXT();
|
|
return err;
|
|
}
|
|
|
|
} else {
|
|
#if KERNEL_VERSION(5, 10, 0) <= MODS_KERNEL_VERSION
|
|
dev_name = (const char *)acpi_device_get_match_data(dev);
|
|
#endif
|
|
if (!dev_name) {
|
|
mods_error_printk(
|
|
"smmu probe failed to read dev-names\n");
|
|
LOG_EXT();
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
mods_debug_printk(DEBUG_MEM, "smmu probe: dev-names=%s, dev_idx=%d\n",
|
|
dev_name,
|
|
mods_smmu_dev_num);
|
|
if (mods_smmu_dev_num < MODS_MAX_SMMU_DEVICES) {
|
|
dev_idx = mods_smmu_dev_num;
|
|
mods_smmu_dev_num++;
|
|
} else {
|
|
mods_error_printk("Max Number of MODS Smmu Device Reached\n");
|
|
LOG_EXT();
|
|
return -ENOMEM;
|
|
}
|
|
mods_smmu_devs[dev_idx].dev = &pdev->dev;
|
|
strncpy(mods_smmu_devs[dev_idx].dev_name,
|
|
dev_name,
|
|
MAX_DT_SIZE - 1);
|
|
#ifdef MODS_ENABLE_BPMP_MRQ_API
|
|
mods_smmu_devs[dev_idx].bpmp = tegra_bpmp_get(dev);
|
|
#endif
|
|
|
|
|
|
LOG_EXT();
|
|
return err;
|
|
}
|
|
|
|
static int mods_smmu_driver_remove(struct platform_device *pdev)
|
|
{
|
|
mods_smmu_dev_num = 0;
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id of_ids[] = {
|
|
{ .compatible = "nvidia,mods_smmu" },
|
|
{ }
|
|
};
|
|
|
|
#ifdef CONFIG_ACPI
|
|
static const struct acpi_device_id tegra_mods_acpi_match[] = {
|
|
{
|
|
.id = "NVDA1513",
|
|
.driver_data = (kernel_ulong_t)"mods_qspi1_dma",
|
|
},
|
|
{}
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(acpi, tegra_mods_acpi_match);
|
|
#endif
|
|
|
|
static struct platform_driver mods_smmu_driver = {
|
|
.probe = mods_smmu_driver_probe,
|
|
.remove = mods_smmu_driver_remove,
|
|
.driver = {
|
|
.name = "mods_smmu",
|
|
.owner = THIS_MODULE,
|
|
.of_match_table = of_ids,
|
|
.acpi_match_table = ACPI_PTR(tegra_mods_acpi_match),
|
|
},
|
|
};
|
|
|
|
int smmu_driver_init(void)
|
|
{
|
|
mods_smmu_dev_num = 0;
|
|
memset(&mods_smmu_devs[0], 0, sizeof(mods_smmu_devs));
|
|
return platform_driver_register(&mods_smmu_driver);
|
|
}
|
|
|
|
void smmu_driver_exit(void)
|
|
{
|
|
platform_driver_unregister(&mods_smmu_driver);
|
|
}
|