Commit e189410c authored by Guenter Roeck's avatar Guenter Roeck Committed by Wim Van Sebroeck

watchdog: sp5100_tco: Clean up sp5100_tco_setupdevice

There are too many unnecessary goto statements in sp5100_tco_setupdevice().
Rearrange the code and limit goto statements to error handling.

Cc: Zoltán Böszörményi <zboszor@pr.hu>
Signed-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
Signed-off-by: default avatarWim Van Sebroeck <wim@iguana.be>
parent 23dfe140
...@@ -396,48 +396,44 @@ static int sp5100_tco_setupdevice(void) ...@@ -396,48 +396,44 @@ static int sp5100_tco_setupdevice(void)
pr_debug("Got 0x%04x from indirect I/O\n", val); pr_debug("Got 0x%04x from indirect I/O\n", val);
/* Check MMIO address conflict */ /* Check MMIO address conflict */
if (request_mem_region_exclusive(val, SP5100_WDT_MEM_MAP_SIZE, if (!request_mem_region_exclusive(val, SP5100_WDT_MEM_MAP_SIZE,
dev_name)) dev_name)) {
goto setup_wdt;
else
pr_debug("MMIO address 0x%04x already in use\n", val); pr_debug("MMIO address 0x%04x already in use\n", val);
/*
* Secondly, Find the watchdog timer MMIO address
* from SBResource_MMIO register.
*/
if (tco_has_sp5100_reg_layout(sp5100_tco_pci)) {
/* Read SBResource_MMIO from PCI config(PCI_Reg: 9Ch) */
pci_read_config_dword(sp5100_tco_pci,
SP5100_SB_RESOURCE_MMIO_BASE,
&val);
} else {
/* Read SBResource_MMIO from AcpiMmioEn(PM_Reg: 24h) */
val = sp5100_tco_read_pm_reg32(SB800_PM_ACPI_MMIO_EN);
}
/* /* The SBResource_MMIO is enabled and mapped memory space? */
* Secondly, Find the watchdog timer MMIO address if ((val & (SB800_ACPI_MMIO_DECODE_EN | SB800_ACPI_MMIO_SEL)) !=
* from SBResource_MMIO register.
*/
if (tco_has_sp5100_reg_layout(sp5100_tco_pci)) {
/* Read SBResource_MMIO from PCI config(PCI_Reg: 9Ch) */
pci_read_config_dword(sp5100_tco_pci,
SP5100_SB_RESOURCE_MMIO_BASE, &val);
} else {
/* Read SBResource_MMIO from AcpiMmioEn(PM_Reg: 24h) */
val = sp5100_tco_read_pm_reg32(SB800_PM_ACPI_MMIO_EN);
}
/* The SBResource_MMIO is enabled and mapped memory space? */
if ((val & (SB800_ACPI_MMIO_DECODE_EN | SB800_ACPI_MMIO_SEL)) ==
SB800_ACPI_MMIO_DECODE_EN) { SB800_ACPI_MMIO_DECODE_EN) {
pr_notice("failed to find MMIO address, giving up.\n");
ret = -ENODEV;
goto unreg_region;
}
/* Clear unnecessary the low twelve bits */ /* Clear unnecessary the low twelve bits */
val &= ~0xFFF; val &= ~0xFFF;
/* Add the Watchdog Timer offset to base address. */ /* Add the Watchdog Timer offset to base address. */
val += SB800_PM_WDT_MMIO_OFFSET; val += SB800_PM_WDT_MMIO_OFFSET;
/* Check MMIO address conflict */ /* Check MMIO address conflict */
if (request_mem_region_exclusive(val, SP5100_WDT_MEM_MAP_SIZE, if (!request_mem_region_exclusive(val, SP5100_WDT_MEM_MAP_SIZE,
dev_name)) { dev_name)) {
pr_debug("Got 0x%04x from SBResource_MMIO register\n",
val);
goto setup_wdt;
} else
pr_debug("MMIO address 0x%04x already in use\n", val); pr_debug("MMIO address 0x%04x already in use\n", val);
} else ret = -EBUSY;
pr_debug("SBResource_MMIO is disabled(0x%04x)\n", val); goto unreg_region;
}
pr_notice("failed to find MMIO address, giving up.\n"); pr_debug("Got 0x%04x from SBResource_MMIO register\n", val);
ret = -ENODEV; }
goto unreg_region;
setup_wdt:
tcobase_phys = val; tcobase_phys = val;
tcobase = ioremap(val, SP5100_WDT_MEM_MAP_SIZE); tcobase = ioremap(val, SP5100_WDT_MEM_MAP_SIZE);
...@@ -472,7 +468,7 @@ static int sp5100_tco_setupdevice(void) ...@@ -472,7 +468,7 @@ static int sp5100_tco_setupdevice(void)
tco_timer_stop(); tco_timer_stop();
release_region(SP5100_IO_PM_INDEX_REG, SP5100_PM_IOPORTS_SIZE); release_region(SP5100_IO_PM_INDEX_REG, SP5100_PM_IOPORTS_SIZE);
/* Done */
return 0; return 0;
unreg_mem_region: unreg_mem_region:
......
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