|
@@ -55,6 +55,7 @@ MODULE_DEVICE_TABLE(pci, pci_tbl);
|
|
|
struct amd768_priv {
|
|
|
void __iomem *iobase;
|
|
|
struct pci_dev *pcidev;
|
|
|
+ u32 pmbase;
|
|
|
};
|
|
|
|
|
|
static int amd_rng_read(struct hwrng *rng, void *buf, size_t max, bool wait)
|
|
@@ -148,33 +149,58 @@ found:
|
|
|
if (pmbase == 0)
|
|
|
return -EIO;
|
|
|
|
|
|
- priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
|
|
|
+ priv = kzalloc(sizeof(*priv), GFP_KERNEL);
|
|
|
if (!priv)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
- if (!devm_request_region(&pdev->dev, pmbase + PMBASE_OFFSET,
|
|
|
- PMBASE_SIZE, DRV_NAME)) {
|
|
|
+ if (!request_region(pmbase + PMBASE_OFFSET, PMBASE_SIZE, DRV_NAME)) {
|
|
|
dev_err(&pdev->dev, DRV_NAME " region 0x%x already in use!\n",
|
|
|
pmbase + 0xF0);
|
|
|
- return -EBUSY;
|
|
|
+ err = -EBUSY;
|
|
|
+ goto out;
|
|
|
}
|
|
|
|
|
|
- priv->iobase = devm_ioport_map(&pdev->dev, pmbase + PMBASE_OFFSET,
|
|
|
- PMBASE_SIZE);
|
|
|
+ priv->iobase = ioport_map(pmbase + PMBASE_OFFSET, PMBASE_SIZE);
|
|
|
if (!priv->iobase) {
|
|
|
pr_err(DRV_NAME "Cannot map ioport\n");
|
|
|
- return -ENOMEM;
|
|
|
+ err = -EINVAL;
|
|
|
+ goto err_iomap;
|
|
|
}
|
|
|
|
|
|
amd_rng.priv = (unsigned long)priv;
|
|
|
+ priv->pmbase = pmbase;
|
|
|
priv->pcidev = pdev;
|
|
|
|
|
|
pr_info(DRV_NAME " detected\n");
|
|
|
- return devm_hwrng_register(&pdev->dev, &amd_rng);
|
|
|
+ err = hwrng_register(&amd_rng);
|
|
|
+ if (err) {
|
|
|
+ pr_err(DRV_NAME " registering failed (%d)\n", err);
|
|
|
+ goto err_hwrng;
|
|
|
+ }
|
|
|
+ return 0;
|
|
|
+
|
|
|
+err_hwrng:
|
|
|
+ ioport_unmap(priv->iobase);
|
|
|
+err_iomap:
|
|
|
+ release_region(pmbase + PMBASE_OFFSET, PMBASE_SIZE);
|
|
|
+out:
|
|
|
+ kfree(priv);
|
|
|
+ return err;
|
|
|
}
|
|
|
|
|
|
static void __exit mod_exit(void)
|
|
|
{
|
|
|
+ struct amd768_priv *priv;
|
|
|
+
|
|
|
+ priv = (struct amd768_priv *)amd_rng.priv;
|
|
|
+
|
|
|
+ hwrng_unregister(&amd_rng);
|
|
|
+
|
|
|
+ ioport_unmap(priv->iobase);
|
|
|
+
|
|
|
+ release_region(priv->pmbase + PMBASE_OFFSET, PMBASE_SIZE);
|
|
|
+
|
|
|
+ kfree(priv);
|
|
|
}
|
|
|
|
|
|
module_init(mod_init);
|