162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Nintendo Wii and Wii U OTP driver
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * This is a driver exposing the OTP of a Nintendo Wii or Wii U console.
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * This memory contains common and per-console keys, signatures and
862306a36Sopenharmony_ci * related data required to access peripherals.
962306a36Sopenharmony_ci *
1062306a36Sopenharmony_ci * Based on reversed documentation from https://wiiubrew.org/wiki/Hardware/OTP
1162306a36Sopenharmony_ci *
1262306a36Sopenharmony_ci * Copyright (C) 2021 Emmanuel Gil Peyrot <linkmauve@linkmauve.fr>
1362306a36Sopenharmony_ci */
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#include <linux/device.h>
1662306a36Sopenharmony_ci#include <linux/io.h>
1762306a36Sopenharmony_ci#include <linux/module.h>
1862306a36Sopenharmony_ci#include <linux/mod_devicetable.h>
1962306a36Sopenharmony_ci#include <linux/nvmem-provider.h>
2062306a36Sopenharmony_ci#include <linux/of_device.h>
2162306a36Sopenharmony_ci#include <linux/platform_device.h>
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci#define HW_OTPCMD  0
2462306a36Sopenharmony_ci#define HW_OTPDATA 4
2562306a36Sopenharmony_ci#define OTP_READ   0x80000000
2662306a36Sopenharmony_ci#define BANK_SIZE  128
2762306a36Sopenharmony_ci#define WORD_SIZE  4
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_cistruct nintendo_otp_priv {
3062306a36Sopenharmony_ci	void __iomem *regs;
3162306a36Sopenharmony_ci};
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_cistruct nintendo_otp_devtype_data {
3462306a36Sopenharmony_ci	const char *name;
3562306a36Sopenharmony_ci	unsigned int num_banks;
3662306a36Sopenharmony_ci};
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_cistatic const struct nintendo_otp_devtype_data hollywood_otp_data = {
3962306a36Sopenharmony_ci	.name = "wii-otp",
4062306a36Sopenharmony_ci	.num_banks = 1,
4162306a36Sopenharmony_ci};
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_cistatic const struct nintendo_otp_devtype_data latte_otp_data = {
4462306a36Sopenharmony_ci	.name = "wiiu-otp",
4562306a36Sopenharmony_ci	.num_banks = 8,
4662306a36Sopenharmony_ci};
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_cistatic int nintendo_otp_reg_read(void *context,
4962306a36Sopenharmony_ci				 unsigned int reg, void *_val, size_t bytes)
5062306a36Sopenharmony_ci{
5162306a36Sopenharmony_ci	struct nintendo_otp_priv *priv = context;
5262306a36Sopenharmony_ci	u32 *val = _val;
5362306a36Sopenharmony_ci	int words = bytes / WORD_SIZE;
5462306a36Sopenharmony_ci	u32 bank, addr;
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_ci	while (words--) {
5762306a36Sopenharmony_ci		bank = (reg / BANK_SIZE) << 8;
5862306a36Sopenharmony_ci		addr = (reg / WORD_SIZE) % (BANK_SIZE / WORD_SIZE);
5962306a36Sopenharmony_ci		iowrite32be(OTP_READ | bank | addr, priv->regs + HW_OTPCMD);
6062306a36Sopenharmony_ci		*val++ = ioread32be(priv->regs + HW_OTPDATA);
6162306a36Sopenharmony_ci		reg += WORD_SIZE;
6262306a36Sopenharmony_ci	}
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	return 0;
6562306a36Sopenharmony_ci}
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_cistatic const struct of_device_id nintendo_otp_of_table[] = {
6862306a36Sopenharmony_ci	{ .compatible = "nintendo,hollywood-otp", .data = &hollywood_otp_data },
6962306a36Sopenharmony_ci	{ .compatible = "nintendo,latte-otp", .data = &latte_otp_data },
7062306a36Sopenharmony_ci	{/* sentinel */},
7162306a36Sopenharmony_ci};
7262306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, nintendo_otp_of_table);
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_cistatic int nintendo_otp_probe(struct platform_device *pdev)
7562306a36Sopenharmony_ci{
7662306a36Sopenharmony_ci	struct device *dev = &pdev->dev;
7762306a36Sopenharmony_ci	const struct of_device_id *of_id =
7862306a36Sopenharmony_ci		of_match_device(nintendo_otp_of_table, dev);
7962306a36Sopenharmony_ci	struct nvmem_device *nvmem;
8062306a36Sopenharmony_ci	struct nintendo_otp_priv *priv;
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci	struct nvmem_config config = {
8362306a36Sopenharmony_ci		.stride = WORD_SIZE,
8462306a36Sopenharmony_ci		.word_size = WORD_SIZE,
8562306a36Sopenharmony_ci		.reg_read = nintendo_otp_reg_read,
8662306a36Sopenharmony_ci		.read_only = true,
8762306a36Sopenharmony_ci		.root_only = true,
8862306a36Sopenharmony_ci	};
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
9162306a36Sopenharmony_ci	if (!priv)
9262306a36Sopenharmony_ci		return -ENOMEM;
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci	priv->regs = devm_platform_ioremap_resource(pdev, 0);
9562306a36Sopenharmony_ci	if (IS_ERR(priv->regs))
9662306a36Sopenharmony_ci		return PTR_ERR(priv->regs);
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_ci	if (of_id->data) {
9962306a36Sopenharmony_ci		const struct nintendo_otp_devtype_data *data = of_id->data;
10062306a36Sopenharmony_ci		config.name = data->name;
10162306a36Sopenharmony_ci		config.size = data->num_banks * BANK_SIZE;
10262306a36Sopenharmony_ci	}
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	config.dev = dev;
10562306a36Sopenharmony_ci	config.priv = priv;
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci	nvmem = devm_nvmem_register(dev, &config);
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	return PTR_ERR_OR_ZERO(nvmem);
11062306a36Sopenharmony_ci}
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_cistatic struct platform_driver nintendo_otp_driver = {
11362306a36Sopenharmony_ci	.probe = nintendo_otp_probe,
11462306a36Sopenharmony_ci	.driver = {
11562306a36Sopenharmony_ci		.name = "nintendo-otp",
11662306a36Sopenharmony_ci		.of_match_table = nintendo_otp_of_table,
11762306a36Sopenharmony_ci	},
11862306a36Sopenharmony_ci};
11962306a36Sopenharmony_cimodule_platform_driver(nintendo_otp_driver);
12062306a36Sopenharmony_ciMODULE_AUTHOR("Emmanuel Gil Peyrot <linkmauve@linkmauve.fr>");
12162306a36Sopenharmony_ciMODULE_DESCRIPTION("Nintendo Wii and Wii U OTP driver");
12262306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
123