cregit-Linux how code gets into the kernel

Release 4.14 drivers/nvmem/sunxi_sid.c

Directory: drivers/nvmem
/*
 * Allwinner sunXi SoCs Security ID support.
 *
 * Copyright (c) 2013 Oliver Schinagl <oliver@schinagl.nl>
 * Copyright (C) 2014 Maxime Ripard <maxime.ripard@free-electrons.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <linux/device.h>
#include <linux/io.h>
#include <linux/iopoll.h>
#include <linux/module.h>
#include <linux/nvmem-provider.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/random.h>

/* Registers and special values for doing register-based SID readout on H3 */

#define SUN8I_SID_PRCTL		0x40

#define SUN8I_SID_RDKEY		0x60


#define SUN8I_SID_OFFSET_MASK	0x1FF

#define SUN8I_SID_OFFSET_SHIFT	16

#define SUN8I_SID_OP_LOCK	(0xAC << 8)

#define SUN8I_SID_READ		BIT(1)


static struct nvmem_config econfig = {
	.name = "sunxi-sid",
	.read_only = true,
	.stride = 4,
	.word_size = 1,
	.owner = THIS_MODULE,
};


struct sunxi_sid_cfg {
	
u32	value_offset;
	
u32	size;
	
bool	need_register_readout;
};


struct sunxi_sid {
	
void __iomem		*base;
	
u32			value_offset;
};

/* We read the entire key, due to a 32 bit read alignment requirement. Since we
 * want to return the requested byte, this results in somewhat slower code and
 * uses 4 times more reads as needed but keeps code simpler. Since the SID is
 * only very rarely probed, this is not really an issue.
 */

static u8 sunxi_sid_read_byte(const struct sunxi_sid *sid, const unsigned int offset) { u32 sid_key; sid_key = ioread32be(sid->base + round_down(offset, 4)); sid_key >>= (offset % 4) * 8; return sid_key; /* Only return the last byte */ }

Contributors

PersonTokensPropCommitsCommitProp
Oliver Schinagl4692.00%150.00%
Maxime Ripard48.00%150.00%
Total50100.00%2100.00%


static int sunxi_sid_read(void *context, unsigned int offset, void *val, size_t bytes) { struct sunxi_sid *sid = context; u8 *buf = val; /* Offset the read operation to the real position of SID */ offset += sid->value_offset; while (bytes--) *buf++ = sunxi_sid_read_byte(sid, offset++); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Maxime Ripard2540.98%125.00%
Oliver Schinagl2236.07%125.00%
Icenowy Zheng711.48%125.00%
Srinivas Kandagatla711.48%125.00%
Total61100.00%4100.00%


static int sun8i_sid_register_readout(const struct sunxi_sid *sid, const unsigned int word) { u32 reg_val; int ret; /* Set word, lock access, and set read command */ reg_val = (word & SUN8I_SID_OFFSET_MASK) << SUN8I_SID_OFFSET_SHIFT; reg_val |= SUN8I_SID_OP_LOCK | SUN8I_SID_READ; writel(reg_val, sid->base + SUN8I_SID_PRCTL); ret = readl_poll_timeout(sid->base + SUN8I_SID_PRCTL, reg_val, !(reg_val & SUN8I_SID_READ), 100, 250000); if (ret) return ret; writel(0, sid->base + SUN8I_SID_PRCTL); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Icenowy Zheng96100.00%1100.00%
Total96100.00%1100.00%


static int sunxi_sid_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; struct resource *res; struct nvmem_device *nvmem; struct sunxi_sid *sid; int ret, i, size; char *randomness; const struct sunxi_sid_cfg *cfg; sid = devm_kzalloc(dev, sizeof(*sid), GFP_KERNEL); if (!sid) return -ENOMEM; cfg = of_device_get_match_data(dev); if (!cfg) return -EINVAL; sid->value_offset = cfg->value_offset; res = platform_get_resource(pdev, IORESOURCE_MEM, 0); sid->base = devm_ioremap_resource(dev, res); if (IS_ERR(sid->base)) return PTR_ERR(sid->base); size = cfg->size; if (cfg->need_register_readout) { /* * H3's SID controller have a bug that the value at 0x200 * offset is not the correct value when the hardware is reseted. * However, after doing a register-based read operation, the * value become right. * Do a full read operation here, but ignore its value * (as it's more fast to read by direct MMIO value than * with registers) */ for (i = 0; i < (size >> 2); i++) { ret = sun8i_sid_register_readout(sid, i); if (ret) return ret; } } econfig.size = size; econfig.dev = dev; econfig.reg_read = sunxi_sid_read; econfig.priv = sid; nvmem = nvmem_register(&econfig); if (IS_ERR(nvmem)) return PTR_ERR(nvmem); randomness = kzalloc(sizeof(u8) * (size), GFP_KERNEL); if (!randomness) { ret = -EINVAL; goto err_unreg_nvmem; } for (i = 0; i < size; i++) randomness[i] = sunxi_sid_read_byte(sid, i); add_device_randomness(randomness, size); kfree(randomness); platform_set_drvdata(pdev, nvmem); return 0; err_unreg_nvmem: nvmem_unregister(nvmem); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Oliver Schinagl14243.96%114.29%
Maxime Ripard8827.24%228.57%
Icenowy Zheng7824.15%228.57%
Srinivas Kandagatla134.02%114.29%
Caesar Wang20.62%114.29%
Total323100.00%7100.00%


static int sunxi_sid_remove(struct platform_device *pdev) { struct nvmem_device *nvmem = platform_get_drvdata(pdev); return nvmem_unregister(nvmem); }

Contributors

PersonTokensPropCommitsCommitProp
Maxime Ripard27100.00%1100.00%
Total27100.00%1100.00%

static const struct sunxi_sid_cfg sun4i_a10_cfg = { .size = 0x10, }; static const struct sunxi_sid_cfg sun7i_a20_cfg = { .size = 0x200, }; static const struct sunxi_sid_cfg sun8i_h3_cfg = { .value_offset = 0x200, .size = 0x100, .need_register_readout = true, }; static const struct of_device_id sunxi_sid_of_match[] = { { .compatible = "allwinner,sun4i-a10-sid", .data = &sun4i_a10_cfg }, { .compatible = "allwinner,sun7i-a20-sid", .data = &sun7i_a20_cfg }, { .compatible = "allwinner,sun8i-h3-sid", .data = &sun8i_h3_cfg }, {/* sentinel */}, }; MODULE_DEVICE_TABLE(of, sunxi_sid_of_match); static struct platform_driver sunxi_sid_driver = { .probe = sunxi_sid_probe, .remove = sunxi_sid_remove, .driver = { .name = "eeprom-sunxi-sid", .of_match_table = sunxi_sid_of_match, }, }; module_platform_driver(sunxi_sid_driver); MODULE_AUTHOR("Oliver Schinagl <oliver@schinagl.nl>"); MODULE_DESCRIPTION("Allwinner sunxi security id driver"); MODULE_LICENSE("GPL");

Overall Contributors

PersonTokensPropCommitsCommitProp
Icenowy Zheng30336.37%228.57%
Oliver Schinagl29034.81%114.29%
Maxime Ripard20724.85%228.57%
Srinivas Kandagatla303.60%114.29%
Caesar Wang30.36%114.29%
Total833100.00%7100.00%
Directory: drivers/nvmem
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.