// SPDX-License-Identifier: GPL-2.0-only /* SPDX-FileCopyrightText: Copyright (c) 2019-2023, NVIDIA CORPORATION. All rights reserved. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #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); }