|
@@ -31,9 +31,6 @@
|
|
|
#include <linux/delay.h>
|
|
|
#include <asm/io.h>
|
|
|
|
|
|
-
|
|
|
-#define PFX KBUILD_MODNAME ": "
|
|
|
-
|
|
|
#define GEODE_RNG_DATA_REG 0x50
|
|
|
#define GEODE_RNG_STATUS_REG 0x54
|
|
|
|
|
@@ -85,7 +82,6 @@ static struct hwrng geode_rng = {
|
|
|
|
|
|
static int __init mod_init(void)
|
|
|
{
|
|
|
- int err = -ENODEV;
|
|
|
struct pci_dev *pdev = NULL;
|
|
|
const struct pci_device_id *ent;
|
|
|
void __iomem *mem;
|
|
@@ -93,43 +89,27 @@ static int __init mod_init(void)
|
|
|
|
|
|
for_each_pci_dev(pdev) {
|
|
|
ent = pci_match_id(pci_tbl, pdev);
|
|
|
- if (ent)
|
|
|
- goto found;
|
|
|
- }
|
|
|
- /* Device not found. */
|
|
|
- goto out;
|
|
|
-
|
|
|
-found:
|
|
|
- rng_base = pci_resource_start(pdev, 0);
|
|
|
- if (rng_base == 0)
|
|
|
- goto out;
|
|
|
- err = -ENOMEM;
|
|
|
- mem = ioremap(rng_base, 0x58);
|
|
|
- if (!mem)
|
|
|
- goto out;
|
|
|
- geode_rng.priv = (unsigned long)mem;
|
|
|
-
|
|
|
- pr_info("AMD Geode RNG detected\n");
|
|
|
- err = hwrng_register(&geode_rng);
|
|
|
- if (err) {
|
|
|
- pr_err(PFX "RNG registering failed (%d)\n",
|
|
|
- err);
|
|
|
- goto err_unmap;
|
|
|
+ if (ent) {
|
|
|
+ rng_base = pci_resource_start(pdev, 0);
|
|
|
+ if (rng_base == 0)
|
|
|
+ return -ENODEV;
|
|
|
+
|
|
|
+ mem = devm_ioremap(&pdev->dev, rng_base, 0x58);
|
|
|
+ if (IS_ERR(mem))
|
|
|
+ return PTR_ERR(mem);
|
|
|
+ geode_rng.priv = (unsigned long)mem;
|
|
|
+
|
|
|
+ pr_info("AMD Geode RNG detected\n");
|
|
|
+ return devm_hwrng_register(&pdev->dev, &geode_rng);
|
|
|
+ }
|
|
|
}
|
|
|
-out:
|
|
|
- return err;
|
|
|
|
|
|
-err_unmap:
|
|
|
- iounmap(mem);
|
|
|
- goto out;
|
|
|
+ /* Device not found. */
|
|
|
+ return -ENODEV;
|
|
|
}
|
|
|
|
|
|
static void __exit mod_exit(void)
|
|
|
{
|
|
|
- void __iomem *mem = (void __iomem *)geode_rng.priv;
|
|
|
-
|
|
|
- hwrng_unregister(&geode_rng);
|
|
|
- iounmap(mem);
|
|
|
}
|
|
|
|
|
|
module_init(mod_init);
|