162306a36Sopenharmony_ci/*
262306a36Sopenharmony_ci * RNG driver for Intel RNGs
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci * Copyright 2005 (c) MontaVista Software, Inc.
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci * with the majority of the code coming from:
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * Hardware driver for the Intel/AMD/VIA Random Number Generators (RNG)
962306a36Sopenharmony_ci * (c) Copyright 2003 Red Hat Inc <jgarzik@redhat.com>
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci * derived from
1262306a36Sopenharmony_ci *
1362306a36Sopenharmony_ci * Hardware driver for the AMD 768 Random Number Generator (RNG)
1462306a36Sopenharmony_ci * (c) Copyright 2001 Red Hat Inc
1562306a36Sopenharmony_ci *
1662306a36Sopenharmony_ci * derived from
1762306a36Sopenharmony_ci *
1862306a36Sopenharmony_ci * Hardware driver for Intel i810 Random Number Generator (RNG)
1962306a36Sopenharmony_ci * Copyright 2000,2001 Jeff Garzik <jgarzik@pobox.com>
2062306a36Sopenharmony_ci * Copyright 2000,2001 Philipp Rumpf <prumpf@mandrakesoft.com>
2162306a36Sopenharmony_ci *
2262306a36Sopenharmony_ci * This file is licensed under  the terms of the GNU General Public
2362306a36Sopenharmony_ci * License version 2. This program is licensed "as is" without any
2462306a36Sopenharmony_ci * warranty of any kind, whether express or implied.
2562306a36Sopenharmony_ci */
2662306a36Sopenharmony_ci
2762306a36Sopenharmony_ci#include <linux/hw_random.h>
2862306a36Sopenharmony_ci#include <linux/io.h>
2962306a36Sopenharmony_ci#include <linux/kernel.h>
3062306a36Sopenharmony_ci#include <linux/module.h>
3162306a36Sopenharmony_ci#include <linux/pci.h>
3262306a36Sopenharmony_ci#include <linux/stop_machine.h>
3362306a36Sopenharmony_ci#include <linux/delay.h>
3462306a36Sopenharmony_ci#include <linux/slab.h>
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_ci#define PFX	KBUILD_MODNAME ": "
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci/*
4062306a36Sopenharmony_ci * RNG registers
4162306a36Sopenharmony_ci */
4262306a36Sopenharmony_ci#define INTEL_RNG_HW_STATUS			0
4362306a36Sopenharmony_ci#define         INTEL_RNG_PRESENT		0x40
4462306a36Sopenharmony_ci#define         INTEL_RNG_ENABLED		0x01
4562306a36Sopenharmony_ci#define INTEL_RNG_STATUS			1
4662306a36Sopenharmony_ci#define         INTEL_RNG_DATA_PRESENT		0x01
4762306a36Sopenharmony_ci#define INTEL_RNG_DATA				2
4862306a36Sopenharmony_ci
4962306a36Sopenharmony_ci/*
5062306a36Sopenharmony_ci * Magic address at which Intel PCI bridges locate the RNG
5162306a36Sopenharmony_ci */
5262306a36Sopenharmony_ci#define INTEL_RNG_ADDR				0xFFBC015F
5362306a36Sopenharmony_ci#define INTEL_RNG_ADDR_LEN			3
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci/*
5662306a36Sopenharmony_ci * LPC bridge PCI config space registers
5762306a36Sopenharmony_ci */
5862306a36Sopenharmony_ci#define FWH_DEC_EN1_REG_OLD			0xe3
5962306a36Sopenharmony_ci#define FWH_DEC_EN1_REG_NEW			0xd9 /* high byte of 16-bit register */
6062306a36Sopenharmony_ci#define FWH_F8_EN_MASK				0x80
6162306a36Sopenharmony_ci
6262306a36Sopenharmony_ci#define BIOS_CNTL_REG_OLD			0x4e
6362306a36Sopenharmony_ci#define BIOS_CNTL_REG_NEW			0xdc
6462306a36Sopenharmony_ci#define BIOS_CNTL_WRITE_ENABLE_MASK		0x01
6562306a36Sopenharmony_ci#define BIOS_CNTL_LOCK_ENABLE_MASK		0x02
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_ci/*
6862306a36Sopenharmony_ci * Magic address at which Intel Firmware Hubs get accessed
6962306a36Sopenharmony_ci */
7062306a36Sopenharmony_ci#define INTEL_FWH_ADDR				0xffff0000
7162306a36Sopenharmony_ci#define INTEL_FWH_ADDR_LEN			2
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_ci/*
7462306a36Sopenharmony_ci * Intel Firmware Hub command codes (write to any address inside the device)
7562306a36Sopenharmony_ci */
7662306a36Sopenharmony_ci#define INTEL_FWH_RESET_CMD			0xff /* aka READ_ARRAY */
7762306a36Sopenharmony_ci#define INTEL_FWH_READ_ID_CMD			0x90
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_ci/*
8062306a36Sopenharmony_ci * Intel Firmware Hub Read ID command result addresses
8162306a36Sopenharmony_ci */
8262306a36Sopenharmony_ci#define INTEL_FWH_MANUFACTURER_CODE_ADDRESS	0x000000
8362306a36Sopenharmony_ci#define INTEL_FWH_DEVICE_CODE_ADDRESS		0x000001
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci/*
8662306a36Sopenharmony_ci * Intel Firmware Hub Read ID command result values
8762306a36Sopenharmony_ci */
8862306a36Sopenharmony_ci#define INTEL_FWH_MANUFACTURER_CODE		0x89
8962306a36Sopenharmony_ci#define INTEL_FWH_DEVICE_CODE_8M		0xac
9062306a36Sopenharmony_ci#define INTEL_FWH_DEVICE_CODE_4M		0xad
9162306a36Sopenharmony_ci
9262306a36Sopenharmony_ci/*
9362306a36Sopenharmony_ci * Data for PCI driver interface
9462306a36Sopenharmony_ci *
9562306a36Sopenharmony_ci * This data only exists for exporting the supported
9662306a36Sopenharmony_ci * PCI ids via MODULE_DEVICE_TABLE.  We do not actually
9762306a36Sopenharmony_ci * register a pci_driver, because someone else might one day
9862306a36Sopenharmony_ci * want to register another driver on the same PCI id.
9962306a36Sopenharmony_ci */
10062306a36Sopenharmony_cistatic const struct pci_device_id pci_tbl[] = {
10162306a36Sopenharmony_ci/* AA
10262306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2418) }, */
10362306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2410) }, /* AA */
10462306a36Sopenharmony_ci/* AB
10562306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2428) }, */
10662306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2420) }, /* AB */
10762306a36Sopenharmony_ci/* ??
10862306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2430) }, */
10962306a36Sopenharmony_ci/* BAM, CAM, DBM, FBM, GxM
11062306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2448) }, */
11162306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x244c) }, /* BAM */
11262306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x248c) }, /* CAM */
11362306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x24cc) }, /* DBM */
11462306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2641) }, /* FBM */
11562306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x27b9) }, /* GxM */
11662306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x27bd) }, /* GxM DH */
11762306a36Sopenharmony_ci/* BA, CA, DB, Ex, 6300, Fx, 631x/632x, Gx
11862306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x244e) }, */
11962306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2440) }, /* BA */
12062306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2480) }, /* CA */
12162306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x24c0) }, /* DB */
12262306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x24d0) }, /* Ex */
12362306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x25a1) }, /* 6300 */
12462306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2640) }, /* Fx */
12562306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2670) }, /* 631x/632x */
12662306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2671) }, /* 631x/632x */
12762306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2672) }, /* 631x/632x */
12862306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2673) }, /* 631x/632x */
12962306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2674) }, /* 631x/632x */
13062306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2675) }, /* 631x/632x */
13162306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2676) }, /* 631x/632x */
13262306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2677) }, /* 631x/632x */
13362306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2678) }, /* 631x/632x */
13462306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2679) }, /* 631x/632x */
13562306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x267a) }, /* 631x/632x */
13662306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x267b) }, /* 631x/632x */
13762306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x267c) }, /* 631x/632x */
13862306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x267d) }, /* 631x/632x */
13962306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x267e) }, /* 631x/632x */
14062306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x267f) }, /* 631x/632x */
14162306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x27b8) }, /* Gx */
14262306a36Sopenharmony_ci/* E
14362306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x245e) }, */
14462306a36Sopenharmony_ci	{ PCI_DEVICE(0x8086, 0x2450) }, /* E  */
14562306a36Sopenharmony_ci	{ 0, },	/* terminate list */
14662306a36Sopenharmony_ci};
14762306a36Sopenharmony_ciMODULE_DEVICE_TABLE(pci, pci_tbl);
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_cistatic __initdata int no_fwh_detect;
15062306a36Sopenharmony_cimodule_param(no_fwh_detect, int, 0);
15162306a36Sopenharmony_ciMODULE_PARM_DESC(no_fwh_detect, "Skip FWH detection:\n"
15262306a36Sopenharmony_ci                                " positive value - skip if FWH space locked read-only\n"
15362306a36Sopenharmony_ci                                " negative value - skip always");
15462306a36Sopenharmony_ci
15562306a36Sopenharmony_cistatic inline u8 hwstatus_get(void __iomem *mem)
15662306a36Sopenharmony_ci{
15762306a36Sopenharmony_ci	return readb(mem + INTEL_RNG_HW_STATUS);
15862306a36Sopenharmony_ci}
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_cistatic inline u8 hwstatus_set(void __iomem *mem,
16162306a36Sopenharmony_ci			      u8 hw_status)
16262306a36Sopenharmony_ci{
16362306a36Sopenharmony_ci	writeb(hw_status, mem + INTEL_RNG_HW_STATUS);
16462306a36Sopenharmony_ci	return hwstatus_get(mem);
16562306a36Sopenharmony_ci}
16662306a36Sopenharmony_ci
16762306a36Sopenharmony_cistatic int intel_rng_data_present(struct hwrng *rng, int wait)
16862306a36Sopenharmony_ci{
16962306a36Sopenharmony_ci	void __iomem *mem = (void __iomem *)rng->priv;
17062306a36Sopenharmony_ci	int data, i;
17162306a36Sopenharmony_ci
17262306a36Sopenharmony_ci	for (i = 0; i < 20; i++) {
17362306a36Sopenharmony_ci		data = !!(readb(mem + INTEL_RNG_STATUS) &
17462306a36Sopenharmony_ci			  INTEL_RNG_DATA_PRESENT);
17562306a36Sopenharmony_ci		if (data || !wait)
17662306a36Sopenharmony_ci			break;
17762306a36Sopenharmony_ci		udelay(10);
17862306a36Sopenharmony_ci	}
17962306a36Sopenharmony_ci	return data;
18062306a36Sopenharmony_ci}
18162306a36Sopenharmony_ci
18262306a36Sopenharmony_cistatic int intel_rng_data_read(struct hwrng *rng, u32 *data)
18362306a36Sopenharmony_ci{
18462306a36Sopenharmony_ci	void __iomem *mem = (void __iomem *)rng->priv;
18562306a36Sopenharmony_ci
18662306a36Sopenharmony_ci	*data = readb(mem + INTEL_RNG_DATA);
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci	return 1;
18962306a36Sopenharmony_ci}
19062306a36Sopenharmony_ci
19162306a36Sopenharmony_cistatic int intel_rng_init(struct hwrng *rng)
19262306a36Sopenharmony_ci{
19362306a36Sopenharmony_ci	void __iomem *mem = (void __iomem *)rng->priv;
19462306a36Sopenharmony_ci	u8 hw_status;
19562306a36Sopenharmony_ci	int err = -EIO;
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci	hw_status = hwstatus_get(mem);
19862306a36Sopenharmony_ci	/* turn RNG h/w on, if it's off */
19962306a36Sopenharmony_ci	if ((hw_status & INTEL_RNG_ENABLED) == 0)
20062306a36Sopenharmony_ci		hw_status = hwstatus_set(mem, hw_status | INTEL_RNG_ENABLED);
20162306a36Sopenharmony_ci	if ((hw_status & INTEL_RNG_ENABLED) == 0) {
20262306a36Sopenharmony_ci		pr_err(PFX "cannot enable RNG, aborting\n");
20362306a36Sopenharmony_ci		goto out;
20462306a36Sopenharmony_ci	}
20562306a36Sopenharmony_ci	err = 0;
20662306a36Sopenharmony_ciout:
20762306a36Sopenharmony_ci	return err;
20862306a36Sopenharmony_ci}
20962306a36Sopenharmony_ci
21062306a36Sopenharmony_cistatic void intel_rng_cleanup(struct hwrng *rng)
21162306a36Sopenharmony_ci{
21262306a36Sopenharmony_ci	void __iomem *mem = (void __iomem *)rng->priv;
21362306a36Sopenharmony_ci	u8 hw_status;
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	hw_status = hwstatus_get(mem);
21662306a36Sopenharmony_ci	if (hw_status & INTEL_RNG_ENABLED)
21762306a36Sopenharmony_ci		hwstatus_set(mem, hw_status & ~INTEL_RNG_ENABLED);
21862306a36Sopenharmony_ci	else
21962306a36Sopenharmony_ci		pr_warn(PFX "unusual: RNG already disabled\n");
22062306a36Sopenharmony_ci}
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_cistatic struct hwrng intel_rng = {
22462306a36Sopenharmony_ci	.name		= "intel",
22562306a36Sopenharmony_ci	.init		= intel_rng_init,
22662306a36Sopenharmony_ci	.cleanup	= intel_rng_cleanup,
22762306a36Sopenharmony_ci	.data_present	= intel_rng_data_present,
22862306a36Sopenharmony_ci	.data_read	= intel_rng_data_read,
22962306a36Sopenharmony_ci};
23062306a36Sopenharmony_ci
23162306a36Sopenharmony_cistruct intel_rng_hw {
23262306a36Sopenharmony_ci	struct pci_dev *dev;
23362306a36Sopenharmony_ci	void __iomem *mem;
23462306a36Sopenharmony_ci	u8 bios_cntl_off;
23562306a36Sopenharmony_ci	u8 bios_cntl_val;
23662306a36Sopenharmony_ci	u8 fwh_dec_en1_off;
23762306a36Sopenharmony_ci	u8 fwh_dec_en1_val;
23862306a36Sopenharmony_ci};
23962306a36Sopenharmony_ci
24062306a36Sopenharmony_cistatic int __init intel_rng_hw_init(void *_intel_rng_hw)
24162306a36Sopenharmony_ci{
24262306a36Sopenharmony_ci	struct intel_rng_hw *intel_rng_hw = _intel_rng_hw;
24362306a36Sopenharmony_ci	u8 mfc, dvc;
24462306a36Sopenharmony_ci
24562306a36Sopenharmony_ci	/* interrupts disabled in stop_machine call */
24662306a36Sopenharmony_ci
24762306a36Sopenharmony_ci	if (!(intel_rng_hw->fwh_dec_en1_val & FWH_F8_EN_MASK))
24862306a36Sopenharmony_ci		pci_write_config_byte(intel_rng_hw->dev,
24962306a36Sopenharmony_ci		                      intel_rng_hw->fwh_dec_en1_off,
25062306a36Sopenharmony_ci		                      intel_rng_hw->fwh_dec_en1_val |
25162306a36Sopenharmony_ci				      FWH_F8_EN_MASK);
25262306a36Sopenharmony_ci	if (!(intel_rng_hw->bios_cntl_val & BIOS_CNTL_WRITE_ENABLE_MASK))
25362306a36Sopenharmony_ci		pci_write_config_byte(intel_rng_hw->dev,
25462306a36Sopenharmony_ci		                      intel_rng_hw->bios_cntl_off,
25562306a36Sopenharmony_ci		                      intel_rng_hw->bios_cntl_val |
25662306a36Sopenharmony_ci				      BIOS_CNTL_WRITE_ENABLE_MASK);
25762306a36Sopenharmony_ci
25862306a36Sopenharmony_ci	writeb(INTEL_FWH_RESET_CMD, intel_rng_hw->mem);
25962306a36Sopenharmony_ci	writeb(INTEL_FWH_READ_ID_CMD, intel_rng_hw->mem);
26062306a36Sopenharmony_ci	mfc = readb(intel_rng_hw->mem + INTEL_FWH_MANUFACTURER_CODE_ADDRESS);
26162306a36Sopenharmony_ci	dvc = readb(intel_rng_hw->mem + INTEL_FWH_DEVICE_CODE_ADDRESS);
26262306a36Sopenharmony_ci	writeb(INTEL_FWH_RESET_CMD, intel_rng_hw->mem);
26362306a36Sopenharmony_ci
26462306a36Sopenharmony_ci	if (!(intel_rng_hw->bios_cntl_val &
26562306a36Sopenharmony_ci	      (BIOS_CNTL_LOCK_ENABLE_MASK|BIOS_CNTL_WRITE_ENABLE_MASK)))
26662306a36Sopenharmony_ci		pci_write_config_byte(intel_rng_hw->dev,
26762306a36Sopenharmony_ci				      intel_rng_hw->bios_cntl_off,
26862306a36Sopenharmony_ci				      intel_rng_hw->bios_cntl_val);
26962306a36Sopenharmony_ci	if (!(intel_rng_hw->fwh_dec_en1_val & FWH_F8_EN_MASK))
27062306a36Sopenharmony_ci		pci_write_config_byte(intel_rng_hw->dev,
27162306a36Sopenharmony_ci				      intel_rng_hw->fwh_dec_en1_off,
27262306a36Sopenharmony_ci				      intel_rng_hw->fwh_dec_en1_val);
27362306a36Sopenharmony_ci
27462306a36Sopenharmony_ci	if (mfc != INTEL_FWH_MANUFACTURER_CODE ||
27562306a36Sopenharmony_ci	    (dvc != INTEL_FWH_DEVICE_CODE_8M &&
27662306a36Sopenharmony_ci	     dvc != INTEL_FWH_DEVICE_CODE_4M)) {
27762306a36Sopenharmony_ci		pr_notice(PFX "FWH not detected\n");
27862306a36Sopenharmony_ci		return -ENODEV;
27962306a36Sopenharmony_ci	}
28062306a36Sopenharmony_ci
28162306a36Sopenharmony_ci	return 0;
28262306a36Sopenharmony_ci}
28362306a36Sopenharmony_ci
28462306a36Sopenharmony_cistatic int __init intel_init_hw_struct(struct intel_rng_hw *intel_rng_hw,
28562306a36Sopenharmony_ci					struct pci_dev *dev)
28662306a36Sopenharmony_ci{
28762306a36Sopenharmony_ci	intel_rng_hw->bios_cntl_val = 0xff;
28862306a36Sopenharmony_ci	intel_rng_hw->fwh_dec_en1_val = 0xff;
28962306a36Sopenharmony_ci	intel_rng_hw->dev = dev;
29062306a36Sopenharmony_ci
29162306a36Sopenharmony_ci	/* Check for Intel 82802 */
29262306a36Sopenharmony_ci	if (dev->device < 0x2640) {
29362306a36Sopenharmony_ci		intel_rng_hw->fwh_dec_en1_off = FWH_DEC_EN1_REG_OLD;
29462306a36Sopenharmony_ci		intel_rng_hw->bios_cntl_off = BIOS_CNTL_REG_OLD;
29562306a36Sopenharmony_ci	} else {
29662306a36Sopenharmony_ci		intel_rng_hw->fwh_dec_en1_off = FWH_DEC_EN1_REG_NEW;
29762306a36Sopenharmony_ci		intel_rng_hw->bios_cntl_off = BIOS_CNTL_REG_NEW;
29862306a36Sopenharmony_ci	}
29962306a36Sopenharmony_ci
30062306a36Sopenharmony_ci	pci_read_config_byte(dev, intel_rng_hw->fwh_dec_en1_off,
30162306a36Sopenharmony_ci			     &intel_rng_hw->fwh_dec_en1_val);
30262306a36Sopenharmony_ci	pci_read_config_byte(dev, intel_rng_hw->bios_cntl_off,
30362306a36Sopenharmony_ci			     &intel_rng_hw->bios_cntl_val);
30462306a36Sopenharmony_ci
30562306a36Sopenharmony_ci	if ((intel_rng_hw->bios_cntl_val &
30662306a36Sopenharmony_ci	     (BIOS_CNTL_LOCK_ENABLE_MASK|BIOS_CNTL_WRITE_ENABLE_MASK))
30762306a36Sopenharmony_ci	    == BIOS_CNTL_LOCK_ENABLE_MASK) {
30862306a36Sopenharmony_ci		static __initdata /*const*/ char warning[] =
30962306a36Sopenharmony_ciPFX "Firmware space is locked read-only. If you can't or\n"
31062306a36Sopenharmony_ciPFX "don't want to disable this in firmware setup, and if\n"
31162306a36Sopenharmony_ciPFX "you are certain that your system has a functional\n"
31262306a36Sopenharmony_ciPFX "RNG, try using the 'no_fwh_detect' option.\n";
31362306a36Sopenharmony_ci
31462306a36Sopenharmony_ci		if (no_fwh_detect)
31562306a36Sopenharmony_ci			return -ENODEV;
31662306a36Sopenharmony_ci		pr_warn("%s", warning);
31762306a36Sopenharmony_ci		return -EBUSY;
31862306a36Sopenharmony_ci	}
31962306a36Sopenharmony_ci
32062306a36Sopenharmony_ci	intel_rng_hw->mem = ioremap(INTEL_FWH_ADDR, INTEL_FWH_ADDR_LEN);
32162306a36Sopenharmony_ci	if (intel_rng_hw->mem == NULL)
32262306a36Sopenharmony_ci		return -EBUSY;
32362306a36Sopenharmony_ci
32462306a36Sopenharmony_ci	return 0;
32562306a36Sopenharmony_ci}
32662306a36Sopenharmony_ci
32762306a36Sopenharmony_ci
32862306a36Sopenharmony_cistatic int __init intel_rng_mod_init(void)
32962306a36Sopenharmony_ci{
33062306a36Sopenharmony_ci	int err = -ENODEV;
33162306a36Sopenharmony_ci	int i;
33262306a36Sopenharmony_ci	struct pci_dev *dev = NULL;
33362306a36Sopenharmony_ci	void __iomem *mem;
33462306a36Sopenharmony_ci	u8 hw_status;
33562306a36Sopenharmony_ci	struct intel_rng_hw *intel_rng_hw;
33662306a36Sopenharmony_ci
33762306a36Sopenharmony_ci	for (i = 0; !dev && pci_tbl[i].vendor; ++i)
33862306a36Sopenharmony_ci		dev = pci_get_device(pci_tbl[i].vendor, pci_tbl[i].device,
33962306a36Sopenharmony_ci				     NULL);
34062306a36Sopenharmony_ci
34162306a36Sopenharmony_ci	if (!dev)
34262306a36Sopenharmony_ci		goto out; /* Device not found. */
34362306a36Sopenharmony_ci
34462306a36Sopenharmony_ci	if (no_fwh_detect < 0) {
34562306a36Sopenharmony_ci		pci_dev_put(dev);
34662306a36Sopenharmony_ci		goto fwh_done;
34762306a36Sopenharmony_ci	}
34862306a36Sopenharmony_ci
34962306a36Sopenharmony_ci	intel_rng_hw = kmalloc(sizeof(*intel_rng_hw), GFP_KERNEL);
35062306a36Sopenharmony_ci	if (!intel_rng_hw) {
35162306a36Sopenharmony_ci		pci_dev_put(dev);
35262306a36Sopenharmony_ci		goto out;
35362306a36Sopenharmony_ci	}
35462306a36Sopenharmony_ci
35562306a36Sopenharmony_ci	err = intel_init_hw_struct(intel_rng_hw, dev);
35662306a36Sopenharmony_ci	if (err) {
35762306a36Sopenharmony_ci		pci_dev_put(dev);
35862306a36Sopenharmony_ci		kfree(intel_rng_hw);
35962306a36Sopenharmony_ci		if (err == -ENODEV)
36062306a36Sopenharmony_ci			goto fwh_done;
36162306a36Sopenharmony_ci		goto out;
36262306a36Sopenharmony_ci	}
36362306a36Sopenharmony_ci
36462306a36Sopenharmony_ci	/*
36562306a36Sopenharmony_ci	 * Since the BIOS code/data is going to disappear from its normal
36662306a36Sopenharmony_ci	 * location with the Read ID command, all activity on the system
36762306a36Sopenharmony_ci	 * must be stopped until the state is back to normal.
36862306a36Sopenharmony_ci	 *
36962306a36Sopenharmony_ci	 * Use stop_machine because IPIs can be blocked by disabling
37062306a36Sopenharmony_ci	 * interrupts.
37162306a36Sopenharmony_ci	 */
37262306a36Sopenharmony_ci	err = stop_machine(intel_rng_hw_init, intel_rng_hw, NULL);
37362306a36Sopenharmony_ci	pci_dev_put(dev);
37462306a36Sopenharmony_ci	iounmap(intel_rng_hw->mem);
37562306a36Sopenharmony_ci	kfree(intel_rng_hw);
37662306a36Sopenharmony_ci	if (err)
37762306a36Sopenharmony_ci		goto out;
37862306a36Sopenharmony_ci
37962306a36Sopenharmony_cifwh_done:
38062306a36Sopenharmony_ci	err = -ENOMEM;
38162306a36Sopenharmony_ci	mem = ioremap(INTEL_RNG_ADDR, INTEL_RNG_ADDR_LEN);
38262306a36Sopenharmony_ci	if (!mem)
38362306a36Sopenharmony_ci		goto out;
38462306a36Sopenharmony_ci	intel_rng.priv = (unsigned long)mem;
38562306a36Sopenharmony_ci
38662306a36Sopenharmony_ci	/* Check for Random Number Generator */
38762306a36Sopenharmony_ci	err = -ENODEV;
38862306a36Sopenharmony_ci	hw_status = hwstatus_get(mem);
38962306a36Sopenharmony_ci	if ((hw_status & INTEL_RNG_PRESENT) == 0) {
39062306a36Sopenharmony_ci		iounmap(mem);
39162306a36Sopenharmony_ci		goto out;
39262306a36Sopenharmony_ci	}
39362306a36Sopenharmony_ci
39462306a36Sopenharmony_ci	pr_info("Intel 82802 RNG detected\n");
39562306a36Sopenharmony_ci	err = hwrng_register(&intel_rng);
39662306a36Sopenharmony_ci	if (err) {
39762306a36Sopenharmony_ci		pr_err(PFX "RNG registering failed (%d)\n",
39862306a36Sopenharmony_ci		       err);
39962306a36Sopenharmony_ci		iounmap(mem);
40062306a36Sopenharmony_ci	}
40162306a36Sopenharmony_ciout:
40262306a36Sopenharmony_ci	return err;
40362306a36Sopenharmony_ci
40462306a36Sopenharmony_ci}
40562306a36Sopenharmony_ci
40662306a36Sopenharmony_cistatic void __exit intel_rng_mod_exit(void)
40762306a36Sopenharmony_ci{
40862306a36Sopenharmony_ci	void __iomem *mem = (void __iomem *)intel_rng.priv;
40962306a36Sopenharmony_ci
41062306a36Sopenharmony_ci	hwrng_unregister(&intel_rng);
41162306a36Sopenharmony_ci	iounmap(mem);
41262306a36Sopenharmony_ci}
41362306a36Sopenharmony_ci
41462306a36Sopenharmony_cimodule_init(intel_rng_mod_init);
41562306a36Sopenharmony_cimodule_exit(intel_rng_mod_exit);
41662306a36Sopenharmony_ci
41762306a36Sopenharmony_ciMODULE_DESCRIPTION("H/W RNG driver for Intel chipsets");
41862306a36Sopenharmony_ciMODULE_LICENSE("GPL");
419