5 files changed, 293 insertions, 98 deletions

diff --git a/drivers/char/hw_random/Kconfig b/drivers/char/hw_random/Kconfig
index 5f3acd8e64b8..7cda04b33534 100644
--- a/drivers/char/hw_random/Kconfig
+++ b/drivers/char/hw_random/Kconfig
@@ -91,3 +91,17 @@ config HW_RANDOM_OMAP
           module will be called omap-rng.
 
           If unsure, say Y.
+
+config HW_RANDOM_PASEMI
+        tristate "PA Semi HW Random Number Generator support"
+        depends on HW_RANDOM && PPC_PASEMI
+        default HW_RANDOM
+        ---help---
+          This driver provides kernel-side support for the Random Number
+          Generator hardware found on PA6T-1682M processor.
+
+          To compile this driver as a module, choose M here: the
+          module will be called pasemi-rng.
+
+          If unsure, say Y.
+
diff --git a/drivers/char/hw_random/Makefile b/drivers/char/hw_random/Makefile
index c41fa19454e3..c8b7300e2fb1 100644
--- a/drivers/char/hw_random/Makefile
+++ b/drivers/char/hw_random/Makefile
@@ -10,3 +10,4 @@ obj-$(CONFIG_HW_RANDOM_GEODE) += geode-rng.o
 obj-$(CONFIG_HW_RANDOM_VIA) += via-rng.o
 obj-$(CONFIG_HW_RANDOM_IXP4XX) += ixp4xx-rng.o
 obj-$(CONFIG_HW_RANDOM_OMAP) += omap-rng.o
+obj-$(CONFIG_HW_RANDOM_PASEMI) += pasemi-rng.o
diff --git a/drivers/char/hw_random/intel-rng.c b/drivers/char/hw_random/intel-rng.c
index cc1046e6ee02..4ae9811d1a6c 100644
--- a/drivers/char/hw_random/intel-rng.c
+++ b/drivers/char/hw_random/intel-rng.c
@@ -24,10 +24,11 @@
  * warranty of any kind, whether express or implied.
  */
 
-#include <linux/module.h>
+#include <linux/hw_random.h>
 #include <linux/kernel.h>
+#include <linux/module.h>
 #include <linux/pci.h>
-#include <linux/hw_random.h>
+#include <linux/stop_machine.h>
 #include <asm/io.h>
 
 
@@ -217,30 +218,117 @@ static struct hwrng intel_rng = {
         .data_read      = intel_rng_data_read,
 };
 
+struct intel_rng_hw {
+        struct pci_dev *dev;
+        void __iomem *mem;
+        u8 bios_cntl_off;
+        u8 bios_cntl_val;
+        u8 fwh_dec_en1_off;
+        u8 fwh_dec_en1_val;
+};
 
-#ifdef CONFIG_SMP
-static char __initdata waitflag;
+static int __init intel_rng_hw_init(void *_intel_rng_hw)
+{
+        struct intel_rng_hw *intel_rng_hw = _intel_rng_hw;
+        u8 mfc, dvc;
+
+        /* interrupts disabled in stop_machine_run call */
+
+        if (!(intel_rng_hw->fwh_dec_en1_val & FWH_F8_EN_MASK))
+                pci_write_config_byte(intel_rng_hw->dev,
+                                      intel_rng_hw->fwh_dec_en1_off,
+                                      intel_rng_hw->fwh_dec_en1_val |
+                                      FWH_F8_EN_MASK);
+        if (!(intel_rng_hw->bios_cntl_val & BIOS_CNTL_WRITE_ENABLE_MASK))
+                pci_write_config_byte(intel_rng_hw->dev,
+                                      intel_rng_hw->bios_cntl_off,
+                                      intel_rng_hw->bios_cntl_val |
+                                      BIOS_CNTL_WRITE_ENABLE_MASK);
+
+        writeb(INTEL_FWH_RESET_CMD, intel_rng_hw->mem);
+        writeb(INTEL_FWH_READ_ID_CMD, intel_rng_hw->mem);
+        mfc = readb(intel_rng_hw->mem + INTEL_FWH_MANUFACTURER_CODE_ADDRESS);
+        dvc = readb(intel_rng_hw->mem + INTEL_FWH_DEVICE_CODE_ADDRESS);
+        writeb(INTEL_FWH_RESET_CMD, intel_rng_hw->mem);
+
+        if (!(intel_rng_hw->bios_cntl_val &
+              (BIOS_CNTL_LOCK_ENABLE_MASK|BIOS_CNTL_WRITE_ENABLE_MASK)))
+                pci_write_config_byte(intel_rng_hw->dev,
+                                      intel_rng_hw->bios_cntl_off,
+                                      intel_rng_hw->bios_cntl_val);
+        if (!(intel_rng_hw->fwh_dec_en1_val & FWH_F8_EN_MASK))
+                pci_write_config_byte(intel_rng_hw->dev,
+                                      intel_rng_hw->fwh_dec_en1_off,
+                                      intel_rng_hw->fwh_dec_en1_val);
 
-static void __init intel_init_wait(void *unused)
+        if (mfc != INTEL_FWH_MANUFACTURER_CODE ||
+            (dvc != INTEL_FWH_DEVICE_CODE_8M &&
+             dvc != INTEL_FWH_DEVICE_CODE_4M)) {
+                printk(KERN_ERR PFX "FWH not detected\n");
+                return -ENODEV;
+        }
+
+        return 0;
+}
+
+static int __init intel_init_hw_struct(struct intel_rng_hw *intel_rng_hw,
+                                        struct pci_dev *dev)
 {
-        while (waitflag)
-                cpu_relax();
+        intel_rng_hw->bios_cntl_val = 0xff;
+        intel_rng_hw->fwh_dec_en1_val = 0xff;
+        intel_rng_hw->dev = dev;
+
+        /* Check for Intel 82802 */
+        if (dev->device < 0x2640) {
+                intel_rng_hw->fwh_dec_en1_off = FWH_DEC_EN1_REG_OLD;
+                intel_rng_hw->bios_cntl_off = BIOS_CNTL_REG_OLD;
+        } else {
+                intel_rng_hw->fwh_dec_en1_off = FWH_DEC_EN1_REG_NEW;
+                intel_rng_hw->bios_cntl_off = BIOS_CNTL_REG_NEW;
+        }
+
+        pci_read_config_byte(dev, intel_rng_hw->fwh_dec_en1_off,
+                             &intel_rng_hw->fwh_dec_en1_val);
+        pci_read_config_byte(dev, intel_rng_hw->bios_cntl_off,
+                             &intel_rng_hw->bios_cntl_val);
+
+        if ((intel_rng_hw->bios_cntl_val &
+             (BIOS_CNTL_LOCK_ENABLE_MASK|BIOS_CNTL_WRITE_ENABLE_MASK))
+            == BIOS_CNTL_LOCK_ENABLE_MASK) {
+                static __initdata /*const*/ char warning[] =
+                        KERN_WARNING PFX "Firmware space is locked read-only. "
+                        KERN_WARNING PFX "If you can't or\n don't want to "
+                        KERN_WARNING PFX "disable this in firmware setup, and "
+                        KERN_WARNING PFX "if\n you are certain that your "
+                        KERN_WARNING PFX "system has a functional\n RNG, try"
+                        KERN_WARNING PFX "using the 'no_fwh_detect' option.\n";
+
+                if (no_fwh_detect)
+                        return -ENODEV;
+                printk(warning);
+                return -EBUSY;
+        }
+
+        intel_rng_hw->mem = ioremap_nocache(INTEL_FWH_ADDR, INTEL_FWH_ADDR_LEN);
+        if (intel_rng_hw->mem == NULL)
+                return -EBUSY;
+
+        return 0;
 }
-#endif
+
 
 static int __init mod_init(void)
 {
         int err = -ENODEV;
-        unsigned i;
+        int i;
         struct pci_dev *dev = NULL;
-        void __iomem *mem;
-        unsigned long flags;
-        u8 bios_cntl_off, fwh_dec_en1_off;
-        u8 bios_cntl_val = 0xff, fwh_dec_en1_val = 0xff;
-        u8 hw_status, mfc, dvc;
+        void __iomem *mem = mem;
+        u8 hw_status;
+        struct intel_rng_hw *intel_rng_hw;
 
         for (i = 0; !dev && pci_tbl[i].vendor; ++i)
-                dev = pci_get_device(pci_tbl[i].vendor, pci_tbl[i].device, NULL);
+                dev = pci_get_device(pci_tbl[i].vendor, pci_tbl[i].device,
+                                     NULL);
 
         if (!dev)
                 goto out; /* Device not found. */
@@ -250,39 +338,18 @@ static int __init mod_init(void)
                 goto fwh_done;
         }
 
-        /* Check for Intel 82802 */
-        if (dev->device < 0x2640) {
-                fwh_dec_en1_off = FWH_DEC_EN1_REG_OLD;
-                bios_cntl_off = BIOS_CNTL_REG_OLD;
-        } else {
-                fwh_dec_en1_off = FWH_DEC_EN1_REG_NEW;
-                bios_cntl_off = BIOS_CNTL_REG_NEW;
-        }
-
-        pci_read_config_byte(dev, fwh_dec_en1_off, &fwh_dec_en1_val);
-        pci_read_config_byte(dev, bios_cntl_off, &bios_cntl_val);
-
-        if ((bios_cntl_val &
-             (BIOS_CNTL_LOCK_ENABLE_MASK|BIOS_CNTL_WRITE_ENABLE_MASK))
-            == BIOS_CNTL_LOCK_ENABLE_MASK) {
-                static __initdata /*const*/ char warning[] =
-                        KERN_WARNING PFX "Firmware space is locked read-only. If you can't or\n"
-                        KERN_WARNING PFX "don't want to disable this in firmware setup, and if\n"
-                        KERN_WARNING PFX "you are certain that your system has a functional\n"
-                        KERN_WARNING PFX "RNG, try using the 'no_fwh_detect' option.\n";
-
+        intel_rng_hw = kmalloc(sizeof(*intel_rng_hw), GFP_KERNEL);
+        if (!intel_rng_hw) {
                 pci_dev_put(dev);
-                if (no_fwh_detect)
-                        goto fwh_done;
-                printk(warning);
-                err = -EBUSY;
                 goto out;
         }
 
-        mem = ioremap_nocache(INTEL_FWH_ADDR, INTEL_FWH_ADDR_LEN);
-        if (mem == NULL) {
+        err = intel_init_hw_struct(intel_rng_hw, dev);
+        if (err) {
                 pci_dev_put(dev);
-                err = -EBUSY;
+                kfree(intel_rng_hw);
+                if (err == -ENODEV)
+                        goto fwh_done;
                 goto out;
         }
 
@@ -290,59 +357,18 @@ static int __init mod_init(void)
          * Since the BIOS code/data is going to disappear from its normal
          * location with the Read ID command, all activity on the system
          * must be stopped until the state is back to normal.
+         *
+         * Use stop_machine_run because IPIs can be blocked by disabling
+         * interrupts.
          */
-#ifdef CONFIG_SMP
-        set_mb(waitflag, 1);
-        if (smp_call_function(intel_init_wait, NULL, 1, 0) != 0) {
-                set_mb(waitflag, 0);
-                pci_dev_put(dev);
-                printk(KERN_ERR PFX "cannot run on all processors\n");
-                err = -EAGAIN;
-                goto err_unmap;
-        }
-#endif
-        local_irq_save(flags);
-
-        if (!(fwh_dec_en1_val & FWH_F8_EN_MASK))
-                pci_write_config_byte(dev,
-                                      fwh_dec_en1_off,
-                                      fwh_dec_en1_val | FWH_F8_EN_MASK);
-        if (!(bios_cntl_val & BIOS_CNTL_WRITE_ENABLE_MASK))
-                pci_write_config_byte(dev,
-                                      bios_cntl_off,
-                                      bios_cntl_val | BIOS_CNTL_WRITE_ENABLE_MASK);
-
-        writeb(INTEL_FWH_RESET_CMD, mem);
-        writeb(INTEL_FWH_READ_ID_CMD, mem);
-        mfc = readb(mem + INTEL_FWH_MANUFACTURER_CODE_ADDRESS);
-        dvc = readb(mem + INTEL_FWH_DEVICE_CODE_ADDRESS);
-        writeb(INTEL_FWH_RESET_CMD, mem);
-
-        if (!(bios_cntl_val &
-              (BIOS_CNTL_LOCK_ENABLE_MASK|BIOS_CNTL_WRITE_ENABLE_MASK)))
-                pci_write_config_byte(dev, bios_cntl_off, bios_cntl_val);
-        if (!(fwh_dec_en1_val & FWH_F8_EN_MASK))
-                pci_write_config_byte(dev, fwh_dec_en1_off, fwh_dec_en1_val);
-
-        local_irq_restore(flags);
-#ifdef CONFIG_SMP
-        /* Tell other CPUs to resume. */
-        set_mb(waitflag, 0);
-#endif
-
-        iounmap(mem);
+        err = stop_machine_run(intel_rng_hw_init, intel_rng_hw, NR_CPUS);
         pci_dev_put(dev);
-
-        if (mfc != INTEL_FWH_MANUFACTURER_CODE ||
-            (dvc != INTEL_FWH_DEVICE_CODE_8M &&
-             dvc != INTEL_FWH_DEVICE_CODE_4M)) {
-                printk(KERN_ERR PFX "FWH not detected\n");
-                err = -ENODEV;
+        iounmap(intel_rng_hw->mem);
+        kfree(intel_rng_hw);
+        if (err)
                 goto out;
-        }
 
 fwh_done:
-
         err = -ENOMEM;
         mem = ioremap(INTEL_RNG_ADDR, INTEL_RNG_ADDR_LEN);
         if (!mem)
@@ -352,22 +378,21 @@ fwh_done:
         /* Check for Random Number Generator */
         err = -ENODEV;
         hw_status = hwstatus_get(mem);
-        if ((hw_status & INTEL_RNG_PRESENT) == 0)
-                goto err_unmap;
+        if ((hw_status & INTEL_RNG_PRESENT) == 0) {
+                iounmap(mem);
+                goto out;
+        }
 
         printk(KERN_INFO "Intel 82802 RNG detected\n");
         err = hwrng_register(&intel_rng);
         if (err) {
                 printk(KERN_ERR PFX "RNG registering failed (%d)\n",
                        err);
-                goto err_unmap;
+                iounmap(mem);
         }
 out:
         return err;
 
-err_unmap:
-        iounmap(mem);
-        goto out;
 }
 
 static void __exit mod_exit(void)
diff --git a/drivers/char/hw_random/pasemi-rng.c b/drivers/char/hw_random/pasemi-rng.c
new file mode 100644
index 000000000000..fa6040b6c8f2
--- /dev/null
+++ b/drivers/char/hw_random/pasemi-rng.c
@@ -0,0 +1,156 @@
+/*
+ * Copyright (C) 2006-2007 PA Semi, Inc
+ *
+ * Maintained by: Olof Johansson <olof@lixom.net>
+ *
+ * Driver for the PWRficient onchip rng
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ * 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.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
+ */
+
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/platform_device.h>
+#include <linux/hw_random.h>
+#include <asm/of_platform.h>
+#include <asm/io.h>
+
+#define SDCRNG_CTL_REG                  0x00
+#define   SDCRNG_CTL_FVLD_M             0x0000f000
+#define   SDCRNG_CTL_FVLD_S             12
+#define   SDCRNG_CTL_KSZ                0x00000800
+#define   SDCRNG_CTL_RSRC_CRG           0x00000010
+#define   SDCRNG_CTL_RSRC_RRG           0x00000000
+#define   SDCRNG_CTL_CE                 0x00000004
+#define   SDCRNG_CTL_RE                 0x00000002
+#define   SDCRNG_CTL_DR                 0x00000001
+#define   SDCRNG_CTL_SELECT_RRG_RNG     (SDCRNG_CTL_RE | SDCRNG_CTL_RSRC_RRG)
+#define   SDCRNG_CTL_SELECT_CRG_RNG     (SDCRNG_CTL_CE | SDCRNG_CTL_RSRC_CRG)
+#define SDCRNG_VAL_REG                  0x20
+
+#define MODULE_NAME "pasemi_rng"
+
+static int pasemi_rng_data_present(struct hwrng *rng)
+{
+        void __iomem *rng_regs = (void __iomem *)rng->priv;
+
+        return (in_le32(rng_regs + SDCRNG_CTL_REG)
+                & SDCRNG_CTL_FVLD_M) ? 1 : 0;
+}
+
+static int pasemi_rng_data_read(struct hwrng *rng, u32 *data)
+{
+        void __iomem *rng_regs = (void __iomem *)rng->priv;
+        *data = in_le32(rng_regs + SDCRNG_VAL_REG);
+        return 4;
+}
+
+static int pasemi_rng_init(struct hwrng *rng)
+{
+        void __iomem *rng_regs = (void __iomem *)rng->priv;
+        u32 ctl;
+
+        ctl = SDCRNG_CTL_DR | SDCRNG_CTL_SELECT_RRG_RNG | SDCRNG_CTL_KSZ;
+        out_le32(rng_regs + SDCRNG_CTL_REG, ctl);
+        out_le32(rng_regs + SDCRNG_CTL_REG, ctl & ~SDCRNG_CTL_DR);
+
+        return 0;
+}
+
+static void pasemi_rng_cleanup(struct hwrng *rng)
+{
+        void __iomem *rng_regs = (void __iomem *)rng->priv;
+        u32 ctl;
+
+        ctl = SDCRNG_CTL_RE | SDCRNG_CTL_CE;
+        out_le32(rng_regs + SDCRNG_CTL_REG,
+                 in_le32(rng_regs + SDCRNG_CTL_REG) & ~ctl);
+}
+
+static struct hwrng pasemi_rng = {
+        .name           = MODULE_NAME,
+        .init           = pasemi_rng_init,
+        .cleanup        = pasemi_rng_cleanup,
+        .data_present   = pasemi_rng_data_present,
+        .data_read      = pasemi_rng_data_read,
+};
+
+static int __devinit rng_probe(struct of_device *ofdev,
+                               const struct of_device_id *match)
+{
+        void __iomem *rng_regs;
+        struct device_node *rng_np = ofdev->node;
+        struct resource res;
+        int err = 0;
+
+        err = of_address_to_resource(rng_np, 0, &res);
+        if (err)
+                return -ENODEV;
+
+        rng_regs = ioremap(res.start, 0x100);
+
+        if (!rng_regs)
+                return -ENOMEM;
+
+        pasemi_rng.priv = (unsigned long)rng_regs;
+
+        printk(KERN_INFO "Registering PA Semi RNG\n");
+
+        err = hwrng_register(&pasemi_rng);
+
+        if (err)
+                iounmap(rng_regs);
+
+        return err;
+}
+
+static int __devexit rng_remove(struct of_device *dev)
+{
+        void __iomem *rng_regs = (void __iomem *)pasemi_rng.priv;
+
+        hwrng_unregister(&pasemi_rng);
+        iounmap(rng_regs);
+
+        return 0;
+}
+
+static struct of_device_id rng_match[] = {
+        {
+                .compatible      = "1682m-rng",
+        },
+        {},
+};
+
+static struct of_platform_driver rng_driver = {
+        .name           = "pasemi-rng",
+        .match_table    = rng_match,
+        .probe          = rng_probe,
+        .remove         = rng_remove,
+};
+
+static int __init rng_init(void)
+{
+        return of_register_platform_driver(&rng_driver);
+}
+module_init(rng_init);
+
+static void __exit rng_exit(void)
+{
+        of_unregister_platform_driver(&rng_driver);
+}
+module_exit(rng_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Egor Martovetsky <egor@pasemi.com>");
+MODULE_DESCRIPTION("H/W RNG driver for PA Semi processor");
diff --git a/drivers/char/hw_random/via-rng.c b/drivers/char/hw_random/via-rng.c
index 9ebf84d18655..ec435cb25c4f 100644
--- a/drivers/char/hw_random/via-rng.c
+++ b/drivers/char/hw_random/via-rng.c
@@ -26,7 +26,6 @@
 
 #include <linux/module.h>
 #include <linux/kernel.h>
-#include <linux/pci.h>
 #include <linux/hw_random.h>
 #include <asm/io.h>
 #include <asm/msr.h>