// 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);