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