Commit c7bbcc87 authored by Guenter Roeck's avatar Guenter Roeck

watchdog: iTCO_wdt: Use device managed resources

Using device managed resources simplifies error handling and cleanup,
and to reduce the likelyhood of errors.
Reviewed-by: default avatarAndy Shevchenko <andy.shevchenko@gmail.com>
Mika Westerberg <mika.westerberg@linux.intel.com>
Signed-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
parent ce1b95ca
...@@ -401,27 +401,6 @@ static const struct watchdog_ops iTCO_wdt_ops = { ...@@ -401,27 +401,6 @@ static const struct watchdog_ops iTCO_wdt_ops = {
* Init & exit routines * Init & exit routines
*/ */
static void iTCO_wdt_cleanup(struct iTCO_wdt_private *p)
{
/* Stop the timer before we leave */
if (!nowayout)
iTCO_wdt_stop(&p->wddev);
/* Deregister */
watchdog_unregister_device(&p->wddev);
/* release resources */
release_region(p->tco_res->start,
resource_size(p->tco_res));
release_region(p->smi_res->start,
resource_size(p->smi_res));
if (p->iTCO_version >= 2) {
iounmap(p->gcs_pmc);
release_mem_region(p->gcs_pmc_res->start,
resource_size(p->gcs_pmc_res));
}
}
static int iTCO_wdt_probe(struct platform_device *dev) static int iTCO_wdt_probe(struct platform_device *dev)
{ {
struct itco_wdt_platform_data *pdata = dev_get_platdata(&dev->dev); struct itco_wdt_platform_data *pdata = dev_get_platdata(&dev->dev);
...@@ -458,41 +437,28 @@ static int iTCO_wdt_probe(struct platform_device *dev) ...@@ -458,41 +437,28 @@ static int iTCO_wdt_probe(struct platform_device *dev)
p->gcs_pmc_res = platform_get_resource(dev, p->gcs_pmc_res = platform_get_resource(dev,
IORESOURCE_MEM, IORESOURCE_MEM,
ICH_RES_MEM_GCS_PMC); ICH_RES_MEM_GCS_PMC);
p->gcs_pmc = devm_ioremap_resource(&dev->dev, p->gcs_pmc_res);
if (!p->gcs_pmc_res) if (IS_ERR(p->gcs_pmc))
return -ENODEV; return PTR_ERR(p->gcs_pmc);
if (!request_mem_region(p->gcs_pmc_res->start,
resource_size(p->gcs_pmc_res),
dev->name))
return -EBUSY;
p->gcs_pmc = ioremap(p->gcs_pmc_res->start,
resource_size(p->gcs_pmc_res));
if (!p->gcs_pmc) {
ret = -EIO;
goto unreg_gcs_pmc;
}
} }
/* Check chipset's NO_REBOOT bit */ /* Check chipset's NO_REBOOT bit */
if (iTCO_wdt_unset_NO_REBOOT_bit(p) && if (iTCO_wdt_unset_NO_REBOOT_bit(p) &&
iTCO_vendor_check_noreboot_on()) { iTCO_vendor_check_noreboot_on()) {
pr_info("unable to reset NO_REBOOT flag, device disabled by hardware/BIOS\n"); pr_info("unable to reset NO_REBOOT flag, device disabled by hardware/BIOS\n");
ret = -ENODEV; /* Cannot reset NO_REBOOT bit */ return -ENODEV; /* Cannot reset NO_REBOOT bit */
goto unmap_gcs_pmc;
} }
/* Set the NO_REBOOT bit to prevent later reboots, just for sure */ /* Set the NO_REBOOT bit to prevent later reboots, just for sure */
iTCO_wdt_set_NO_REBOOT_bit(p); iTCO_wdt_set_NO_REBOOT_bit(p);
/* The TCO logic uses the TCO_EN bit in the SMI_EN register */ /* The TCO logic uses the TCO_EN bit in the SMI_EN register */
if (!request_region(p->smi_res->start, if (!devm_request_region(&dev->dev, p->smi_res->start,
resource_size(p->smi_res), dev->name)) { resource_size(p->smi_res),
dev->name)) {
pr_err("I/O address 0x%04llx already in use, device disabled\n", pr_err("I/O address 0x%04llx already in use, device disabled\n",
(u64)SMI_EN(p)); (u64)SMI_EN(p));
ret = -EBUSY; return -EBUSY;
goto unmap_gcs_pmc;
} }
if (turn_SMI_watchdog_clear_off >= p->iTCO_version) { if (turn_SMI_watchdog_clear_off >= p->iTCO_version) {
/* /*
...@@ -504,12 +470,12 @@ static int iTCO_wdt_probe(struct platform_device *dev) ...@@ -504,12 +470,12 @@ static int iTCO_wdt_probe(struct platform_device *dev)
outl(val32, SMI_EN(p)); outl(val32, SMI_EN(p));
} }
if (!request_region(p->tco_res->start, if (!devm_request_region(&dev->dev, p->tco_res->start,
resource_size(p->tco_res), dev->name)) { resource_size(p->tco_res),
dev->name)) {
pr_err("I/O address 0x%04llx already in use, device disabled\n", pr_err("I/O address 0x%04llx already in use, device disabled\n",
(u64)TCOBASE(p)); (u64)TCOBASE(p));
ret = -EBUSY; return -EBUSY;
goto unreg_smi;
} }
pr_info("Found a %s TCO device (Version=%d, TCOBASE=0x%04llx)\n", pr_info("Found a %s TCO device (Version=%d, TCOBASE=0x%04llx)\n",
...@@ -555,37 +521,25 @@ static int iTCO_wdt_probe(struct platform_device *dev) ...@@ -555,37 +521,25 @@ static int iTCO_wdt_probe(struct platform_device *dev)
WATCHDOG_TIMEOUT); WATCHDOG_TIMEOUT);
} }
ret = watchdog_register_device(&p->wddev); ret = devm_watchdog_register_device(&dev->dev, &p->wddev);
if (ret != 0) { if (ret != 0) {
pr_err("cannot register watchdog device (err=%d)\n", ret); pr_err("cannot register watchdog device (err=%d)\n", ret);
goto unreg_tco; return ret;
} }
pr_info("initialized. heartbeat=%d sec (nowayout=%d)\n", pr_info("initialized. heartbeat=%d sec (nowayout=%d)\n",
heartbeat, nowayout); heartbeat, nowayout);
return 0; return 0;
unreg_tco:
release_region(p->tco_res->start, resource_size(p->tco_res));
unreg_smi:
release_region(p->smi_res->start, resource_size(p->smi_res));
unmap_gcs_pmc:
if (p->iTCO_version >= 2)
iounmap(p->gcs_pmc);
unreg_gcs_pmc:
if (p->iTCO_version >= 2)
release_mem_region(p->gcs_pmc_res->start,
resource_size(p->gcs_pmc_res));
return ret;
} }
static int iTCO_wdt_remove(struct platform_device *dev) static int iTCO_wdt_remove(struct platform_device *dev)
{ {
struct iTCO_wdt_private *p = platform_get_drvdata(dev); struct iTCO_wdt_private *p = platform_get_drvdata(dev);
if (p->tco_res || p->smi_res) /* Stop the timer before we leave */
iTCO_wdt_cleanup(p); if (!nowayout)
iTCO_wdt_stop(&p->wddev);
return 0; return 0;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment