60 lines
1.3 KiB
C
60 lines
1.3 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
|
/*
|
||
|
|
* Copyright (c) 2020, NVIDIA CORPORATION. All rights reserved.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/of_reserved_mem.h>
|
||
|
|
|
||
|
|
#include "tegra210-emc.h"
|
||
|
|
|
||
|
|
#define TEGRA_EMC_MAX_FREQS 16
|
||
|
|
|
||
|
|
static int tegra210_emc_table_device_init(struct reserved_mem *rmem,
|
||
|
|
struct device *dev)
|
||
|
|
{
|
||
|
|
struct tegra210_emc *emc = dev_get_drvdata(dev);
|
||
|
|
unsigned int i;
|
||
|
|
|
||
|
|
emc->timings = memremap(rmem->base, rmem->size, MEMREMAP_WB);
|
||
|
|
if (!emc->timings) {
|
||
|
|
dev_err(dev, "failed to map EMC table\n");
|
||
|
|
return -ENOMEM;
|
||
|
|
}
|
||
|
|
|
||
|
|
emc->num_timings = 0;
|
||
|
|
|
||
|
|
for (i = 0; i < TEGRA_EMC_MAX_FREQS; i++) {
|
||
|
|
if (emc->timings[i].revision == 0)
|
||
|
|
break;
|
||
|
|
|
||
|
|
emc->num_timings++;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void tegra210_emc_table_device_release(struct reserved_mem *rmem,
|
||
|
|
struct device *dev)
|
||
|
|
{
|
||
|
|
struct tegra210_emc *emc = dev_get_drvdata(dev);
|
||
|
|
|
||
|
|
memunmap(emc->timings);
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct reserved_mem_ops tegra210_emc_table_ops = {
|
||
|
|
.device_init = tegra210_emc_table_device_init,
|
||
|
|
.device_release = tegra210_emc_table_device_release,
|
||
|
|
};
|
||
|
|
|
||
|
|
static int tegra210_emc_table_init(struct reserved_mem *rmem)
|
||
|
|
{
|
||
|
|
pr_debug("Tegra210 EMC table at %pa, size %lu bytes\n", &rmem->base,
|
||
|
|
(unsigned long)rmem->size);
|
||
|
|
|
||
|
|
rmem->ops = &tegra210_emc_table_ops;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
RESERVEDMEM_OF_DECLARE(tegra210_emc_table, "nvidia,tegra210-emc-table",
|
||
|
|
tegra210_emc_table_init);
|