From: Matt Fleming <[email protected]>

The revision of the watchdog hardware in Sunrisepoint necessitates a new
"version" inside the TCO watchdog driver because some of the register
layouts have changed.

Cc: Wim Van Sebroeck <[email protected]>
Signed-off-by: Matt Fleming <[email protected]>
---
 drivers/watchdog/iTCO_wdt.c | 58 ++++++++++++++++++++++++++-------------------
 1 file changed, 34 insertions(+), 24 deletions(-)

diff --git a/drivers/watchdog/iTCO_wdt.c b/drivers/watchdog/iTCO_wdt.c
index 9a6e70976f64..17dfbc51b85a 100644
--- a/drivers/watchdog/iTCO_wdt.c
+++ b/drivers/watchdog/iTCO_wdt.c
@@ -145,58 +145,65 @@ static inline unsigned int ticks_to_seconds(int ticks)
        return iTCO_wdt_private.iTCO_version == 3 ? ticks : (ticks * 6) / 10;
 }
 
+static inline u32 no_reboot_bit(void)
+{
+       u32 enable_bit;
+
+       switch (iTCO_wdt_private.iTCO_version) {
+       case 3:
+               enable_bit = 0x00000010;
+               break;
+       case 2:
+               enable_bit = 0x00000020;
+               break;
+       default:
+               enable_bit = 0x00000002;
+               break;
+       }
+
+       return enable_bit;
+}
+
 static void iTCO_wdt_set_NO_REBOOT_bit(void)
 {
        u32 val32;
 
        /* Set the NO_REBOOT bit: this disables reboots */
-       if (iTCO_wdt_private.iTCO_version == 3) {
-               val32 = readl(iTCO_wdt_private.gcs_pmc);
-               val32 |= 0x00000010;
-               writel(val32, iTCO_wdt_private.gcs_pmc);
-       } else if (iTCO_wdt_private.iTCO_version == 2) {
+       if (iTCO_wdt_private.iTCO_version >= 2) {
                val32 = readl(iTCO_wdt_private.gcs_pmc);
-               val32 |= 0x00000020;
+               val32 |= no_reboot_bit();
                writel(val32, iTCO_wdt_private.gcs_pmc);
        } else if (iTCO_wdt_private.iTCO_version == 1) {
                pci_read_config_dword(iTCO_wdt_private.pdev, 0xd4, &val32);
-               val32 |= 0x00000002;
+               val32 |= no_reboot_bit();
                pci_write_config_dword(iTCO_wdt_private.pdev, 0xd4, val32);
        }
 }
 
 static int iTCO_wdt_unset_NO_REBOOT_bit(void)
 {
+       u32 enable_bit = no_reboot_bit();
        int ret = 0;
-       u32 val32;
+       u32 val32 = 0;
 
        /* Unset the NO_REBOOT bit: this enables reboots */
-       if (iTCO_wdt_private.iTCO_version == 3) {
-               val32 = readl(iTCO_wdt_private.gcs_pmc);
-               val32 &= 0xffffffef;
-               writel(val32, iTCO_wdt_private.gcs_pmc);
-
-               val32 = readl(iTCO_wdt_private.gcs_pmc);
-               if (val32 & 0x00000010)
-                       ret = -EIO;
-       } else if (iTCO_wdt_private.iTCO_version == 2) {
+       if (iTCO_wdt_private.iTCO_version >= 2) {
                val32 = readl(iTCO_wdt_private.gcs_pmc);
-               val32 &= 0xffffffdf;
+               val32 &= ~enable_bit;
                writel(val32, iTCO_wdt_private.gcs_pmc);
 
                val32 = readl(iTCO_wdt_private.gcs_pmc);
-               if (val32 & 0x00000020)
-                       ret = -EIO;
        } else if (iTCO_wdt_private.iTCO_version == 1) {
                pci_read_config_dword(iTCO_wdt_private.pdev, 0xd4, &val32);
-               val32 &= 0xfffffffd;
+               val32 &= ~enable_bit;
                pci_write_config_dword(iTCO_wdt_private.pdev, 0xd4, val32);
 
                pci_read_config_dword(iTCO_wdt_private.pdev, 0xd4, &val32);
-               if (val32 & 0x00000002)
-                       ret = -EIO;
        }
 
+       if (val32 & enable_bit)
+               ret = -EIO;
+
        return ret; /* returns: 0 = OK, -EIO = Error */
 }
 
@@ -503,7 +510,10 @@ static int iTCO_wdt_probe(struct platform_device *dev)
                pdata->name, pdata->iTCO_version, (u64)TCOBASE);
 
        /* Clear out the (probably old) status */
-       if (iTCO_wdt_private.iTCO_version == 3) {
+       if (iTCO_wdt_private.iTCO_version == 4) {
+               outw(0x0008, TCO1_STS); /* Clear the Time Out Status bit */
+               outw(0x0002, TCO2_STS); /* Clear SECOND_TO_STS bit */
+       } else if (iTCO_wdt_private.iTCO_version == 3) {
                outl(0x20008, TCO1_STS);
        } else {
                outw(0x0008, TCO1_STS); /* Clear the Time Out Status bit */
-- 
2.1.0

--
To unsubscribe from this list: send the line "unsubscribe linux-watchdog" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to