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