diff options
| -rw-r--r-- | drivers/char/hw_random/geode-rng.c | 50 | 
1 files changed, 15 insertions, 35 deletions
diff --git a/drivers/char/hw_random/geode-rng.c b/drivers/char/hw_random/geode-rng.c index 0d0579fe465e..79e7482dc5c4 100644 --- a/drivers/char/hw_random/geode-rng.c +++ b/drivers/char/hw_random/geode-rng.c @@ -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);  | 
