cregit-Linux how code gets into the kernel

Release 4.14 drivers/watchdog/sp5100_tco.c

Directory: drivers/watchdog
/*
 *      sp5100_tco :    TCO timer driver for sp5100 chipsets
 *
 *      (c) Copyright 2009 Google Inc., All Rights Reserved.
 *
 *      Based on i8xx_tco.c:
 *      (c) Copyright 2000 kernel concepts <nils@kernelconcepts.de>, All Rights
 *      Reserved.
 *                              http://www.kernelconcepts.de
 *
 *      This program is free software; you can redistribute it and/or
 *      modify it under the terms of the GNU General Public License
 *      as published by the Free Software Foundation; either version
 *      2 of the License, or (at your option) any later version.
 *
 *      See AMD Publication 43009 "AMD SB700/710/750 Register Reference Guide",
 *          AMD Publication 45482 "AMD SB800-Series Southbridges Register
 *                                                            Reference Guide"
 */

/*
 *      Includes, defines, variables, module parameters, ...
 */


#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/types.h>
#include <linux/miscdevice.h>
#include <linux/watchdog.h>
#include <linux/init.h>
#include <linux/fs.h>
#include <linux/pci.h>
#include <linux/ioport.h>
#include <linux/platform_device.h>
#include <linux/uaccess.h>
#include <linux/io.h>

#include "sp5100_tco.h"

/* Module and version information */

#define TCO_VERSION "0.05"

#define TCO_MODULE_NAME "SP5100 TCO timer"

#define TCO_DRIVER_NAME   TCO_MODULE_NAME ", v" TCO_VERSION

/* internal variables */

static u32 tcobase_phys;

static u32 tco_wdt_fired;

static void __iomem *tcobase;

static unsigned int pm_iobase;
static DEFINE_SPINLOCK(tco_lock);	/* Guards the hardware */

static unsigned long timer_alive;

static char tco_expect_close;

static struct pci_dev *sp5100_tco_pci;

/* the watchdog platform device */

static struct platform_device *sp5100_tco_platform_device;

/* module parameters */


#define WATCHDOG_HEARTBEAT 60	
/* 60 sec default heartbeat. */

static int heartbeat = WATCHDOG_HEARTBEAT;  
/* in seconds */
module_param(heartbeat, int, 0);
MODULE_PARM_DESC(heartbeat, "Watchdog heartbeat in seconds. (default="
		 __MODULE_STRING(WATCHDOG_HEARTBEAT) ")");


static bool nowayout = WATCHDOG_NOWAYOUT;
module_param(nowayout, bool, 0);
MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started."
		" (default=" __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");

/*
 * Some TCO specific functions
 */


static bool tco_has_sp5100_reg_layout(struct pci_dev *dev) { return dev->device == PCI_DEVICE_ID_ATI_SBX00_SMBUS && dev->revision < 0x40; }

Contributors

PersonTokensPropCommitsCommitProp
Lucas Stach24100.00%1100.00%
Total24100.00%1100.00%


static void tco_timer_start(void) { u32 val; unsigned long flags; spin_lock_irqsave(&tco_lock, flags); val = readl(SP5100_WDT_CONTROL(tcobase)); val |= SP5100_WDT_START_STOP_BIT; writel(val, SP5100_WDT_CONTROL(tcobase)); spin_unlock_irqrestore(&tco_lock, flags); }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta55100.00%1100.00%
Total55100.00%1100.00%


static void tco_timer_stop(void) { u32 val; unsigned long flags; spin_lock_irqsave(&tco_lock, flags); val = readl(SP5100_WDT_CONTROL(tcobase)); val &= ~SP5100_WDT_START_STOP_BIT; writel(val, SP5100_WDT_CONTROL(tcobase)); spin_unlock_irqrestore(&tco_lock, flags); }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta56100.00%1100.00%
Total56100.00%1100.00%


static void tco_timer_keepalive(void) { u32 val; unsigned long flags; spin_lock_irqsave(&tco_lock, flags); val = readl(SP5100_WDT_CONTROL(tcobase)); val |= SP5100_WDT_TRIGGER_BIT; writel(val, SP5100_WDT_CONTROL(tcobase)); spin_unlock_irqrestore(&tco_lock, flags); }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta55100.00%1100.00%
Total55100.00%1100.00%


static int tco_timer_set_heartbeat(int t) { unsigned long flags; if (t < 0 || t > 0xffff) return -EINVAL; /* Write new heartbeat to watchdog */ spin_lock_irqsave(&tco_lock, flags); writel(t, SP5100_WDT_COUNT(tcobase)); spin_unlock_irqrestore(&tco_lock, flags); heartbeat = t; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta61100.00%1100.00%
Total61100.00%1100.00%


static void tco_timer_enable(void) { int val; if (!tco_has_sp5100_reg_layout(sp5100_tco_pci)) { /* For SB800 or later */ /* Set the Watchdog timer resolution to 1 sec */ outb(SB800_PM_WATCHDOG_CONFIG, SB800_IO_PM_INDEX_REG); val = inb(SB800_IO_PM_DATA_REG); val |= SB800_PM_WATCHDOG_SECOND_RES; outb(val, SB800_IO_PM_DATA_REG); /* Enable watchdog decode bit and watchdog timer */ outb(SB800_PM_WATCHDOG_CONTROL, SB800_IO_PM_INDEX_REG); val = inb(SB800_IO_PM_DATA_REG); val |= SB800_PCI_WATCHDOG_DECODE_EN; val &= ~SB800_PM_WATCHDOG_DISABLE; outb(val, SB800_IO_PM_DATA_REG); } else { /* For SP5100 or SB7x0 */ /* Enable watchdog decode bit */ pci_read_config_dword(sp5100_tco_pci, SP5100_PCI_WATCHDOG_MISC_REG, &val); val |= SP5100_PCI_WATCHDOG_DECODE_EN; pci_write_config_dword(sp5100_tco_pci, SP5100_PCI_WATCHDOG_MISC_REG, val); /* Enable Watchdog timer and set the resolution to 1 sec */ outb(SP5100_PM_WATCHDOG_CONTROL, SP5100_IO_PM_INDEX_REG); val = inb(SP5100_IO_PM_DATA_REG); val |= SP5100_PM_WATCHDOG_SECOND_RES; val &= ~SP5100_PM_WATCHDOG_DISABLE; outb(val, SP5100_IO_PM_DATA_REG); } }

Contributors

PersonTokensPropCommitsCommitProp
Takahisa Tanaka10576.09%125.00%
Priyanka Gupta2820.29%125.00%
Lucas Stach42.90%125.00%
Joe Perches10.72%125.00%
Total138100.00%4100.00%

/* * /dev/watchdog handling */
static int sp5100_tco_open(struct inode *inode, struct file *file) { /* /dev/watchdog can only be opened once */ if (test_and_set_bit(0, &timer_alive)) return -EBUSY; /* Reload and activate timer */ tco_timer_start(); tco_timer_keepalive(); return nonseekable_open(inode, file); }

Contributors

PersonTokensPropCommitsCommitProp
Takahisa Tanaka46100.00%1100.00%
Total46100.00%1100.00%


static int sp5100_tco_release(struct inode *inode, struct file *file) { /* Shut off the timer. */ if (tco_expect_close == 42) { tco_timer_stop(); } else { pr_crit("Unexpected close, not stopping watchdog!\n"); tco_timer_keepalive(); } clear_bit(0, &timer_alive); tco_expect_close = 0; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Takahisa Tanaka54100.00%1100.00%
Total54100.00%1100.00%


static ssize_t sp5100_tco_write(struct file *file, const char __user *data, size_t len, loff_t *ppos) { /* See if we got the magic character 'V' and reload the timer */ if (len) { if (!nowayout) { size_t i; /* note: just in case someone wrote the magic character * five months ago... */ tco_expect_close = 0; /* scan to see whether or not we got the magic character */ for (i = 0; i != len; i++) { char c; if (get_user(c, data + i)) return -EFAULT; if (c == 'V') tco_expect_close = 42; } } /* someone wrote to us, we should reload the timer */ tco_timer_keepalive(); } return len; }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta6162.89%150.00%
Takahisa Tanaka3637.11%150.00%
Total97100.00%2100.00%


static long sp5100_tco_ioctl(struct file *file, unsigned int cmd, unsigned long arg) { int new_options, retval = -EINVAL; int new_heartbeat; void __user *argp = (void __user *)arg; int __user *p = argp; static const struct watchdog_info ident = { .options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE, .firmware_version = 0, .identity = TCO_MODULE_NAME, }; switch (cmd) { case WDIOC_GETSUPPORT: return copy_to_user(argp, &ident, sizeof(ident)) ? -EFAULT : 0; case WDIOC_GETSTATUS: case WDIOC_GETBOOTSTATUS: return put_user(0, p); case WDIOC_SETOPTIONS: if (get_user(new_options, p)) return -EFAULT; if (new_options & WDIOS_DISABLECARD) { tco_timer_stop(); retval = 0; } if (new_options & WDIOS_ENABLECARD) { tco_timer_start(); tco_timer_keepalive(); retval = 0; } return retval; case WDIOC_KEEPALIVE: tco_timer_keepalive(); return 0; case WDIOC_SETTIMEOUT: if (get_user(new_heartbeat, p)) return -EFAULT; if (tco_timer_set_heartbeat(new_heartbeat)) return -EINVAL; tco_timer_keepalive(); /* Fall through */ case WDIOC_GETTIMEOUT: return put_user(heartbeat, p); default: return -ENOTTY; } }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta226100.00%1100.00%
Total226100.00%1100.00%

/* * Kernel Interfaces */ static const struct file_operations sp5100_tco_fops = { .owner = THIS_MODULE, .llseek = no_llseek, .write = sp5100_tco_write, .unlocked_ioctl = sp5100_tco_ioctl, .open = sp5100_tco_open, .release = sp5100_tco_release, }; static struct miscdevice sp5100_tco_miscdev = { .minor = WATCHDOG_MINOR, .name = "watchdog", .fops = &sp5100_tco_fops, }; /* * Data for PCI driver interface * * This data only exists for exporting the supported * PCI ids via MODULE_DEVICE_TABLE. We do not actually * register a pci_driver, because someone else might * want to register another driver on the same PCI id. */ static const struct pci_device_id sp5100_tco_pci_tbl[] = { { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_SBX00_SMBUS, PCI_ANY_ID, PCI_ANY_ID, }, { PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_HUDSON2_SMBUS, PCI_ANY_ID, PCI_ANY_ID, }, { PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_KERNCZ_SMBUS, PCI_ANY_ID, PCI_ANY_ID, }, { 0, }, /* End of list */ }; MODULE_DEVICE_TABLE(pci, sp5100_tco_pci_tbl); /* * Init & exit routines */
static unsigned char sp5100_tco_setupdevice(void) { struct pci_dev *dev = NULL; const char *dev_name = NULL; u32 val; u32 index_reg, data_reg, base_addr; /* Match the PCI device */ for_each_pci_dev(dev) { if (pci_match_id(sp5100_tco_pci_tbl, dev) != NULL) { sp5100_tco_pci = dev; break; } } if (!sp5100_tco_pci) return 0; pr_info("PCI Vendor ID: 0x%x, Device ID: 0x%x, Revision ID: 0x%x\n", sp5100_tco_pci->vendor, sp5100_tco_pci->device, sp5100_tco_pci->revision); /* * Determine type of southbridge chipset. */ if (tco_has_sp5100_reg_layout(sp5100_tco_pci)) { dev_name = SP5100_DEVNAME; index_reg = SP5100_IO_PM_INDEX_REG; data_reg = SP5100_IO_PM_DATA_REG; base_addr = SP5100_PM_WATCHDOG_BASE; } else { dev_name = SB800_DEVNAME; index_reg = SB800_IO_PM_INDEX_REG; data_reg = SB800_IO_PM_DATA_REG; base_addr = SB800_PM_WATCHDOG_BASE; } /* Request the IO ports used by this driver */ pm_iobase = SP5100_IO_PM_INDEX_REG; if (!request_region(pm_iobase, SP5100_PM_IOPORTS_SIZE, dev_name)) { pr_err("I/O address 0x%04x already in use\n", pm_iobase); goto exit; } /* * First, Find the watchdog timer MMIO address from indirect I/O. */ outb(base_addr+3, index_reg); val = inb(data_reg); outb(base_addr+2, index_reg); val = val << 8 | inb(data_reg); outb(base_addr+1, index_reg); val = val << 8 | inb(data_reg); outb(base_addr+0, index_reg); /* Low three bits of BASE are reserved */ val = val << 8 | (inb(data_reg) & 0xf8); pr_debug("Got 0x%04x from indirect I/O\n", val); /* Check MMIO address conflict */ if (request_mem_region_exclusive(val, SP5100_WDT_MEM_MAP_SIZE, dev_name)) goto setup_wdt; else 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) */ outb(SB800_PM_ACPI_MMIO_EN+3, SB800_IO_PM_INDEX_REG); val = inb(SB800_IO_PM_DATA_REG); outb(SB800_PM_ACPI_MMIO_EN+2, SB800_IO_PM_INDEX_REG); val = val << 8 | inb(SB800_IO_PM_DATA_REG); outb(SB800_PM_ACPI_MMIO_EN+1, SB800_IO_PM_INDEX_REG); val = val << 8 | inb(SB800_IO_PM_DATA_REG); outb(SB800_PM_ACPI_MMIO_EN+0, SB800_IO_PM_INDEX_REG); val = val << 8 | inb(SB800_IO_PM_DATA_REG); } /* 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) { /* Clear unnecessary the low twelve bits */ val &= ~0xFFF; /* Add the Watchdog Timer offset to base address. */ val += SB800_PM_WDT_MMIO_OFFSET; /* Check MMIO address conflict */ if (request_mem_region_exclusive(val, SP5100_WDT_MEM_MAP_SIZE, 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); } else pr_debug("SBResource_MMIO is disabled(0x%04x)\n", val); pr_notice("failed to find MMIO address, giving up.\n"); goto unreg_region; setup_wdt: tcobase_phys = val; tcobase = ioremap(val, SP5100_WDT_MEM_MAP_SIZE); if (!tcobase) { pr_err("failed to get tcobase address\n"); goto unreg_mem_region; } pr_info("Using 0x%04x for watchdog MMIO address\n", val); /* Setup the watchdog timer */ tco_timer_enable(); /* Check that the watchdog action is set to reset the system */ val = readl(SP5100_WDT_CONTROL(tcobase)); /* * Save WatchDogFired status, because WatchDogFired flag is * cleared here. */ tco_wdt_fired = val & SP5100_PM_WATCHDOG_FIRED; val &= ~SP5100_PM_WATCHDOG_ACTION_RESET; writel(val, SP5100_WDT_CONTROL(tcobase)); /* Set a reasonable heartbeat before we stop the timer */ tco_timer_set_heartbeat(heartbeat); /* * Stop the TCO before we change anything so we don't race with * a zeroed timer. */ tco_timer_stop(); /* Done */ return 1; unreg_mem_region: release_mem_region(tcobase_phys, SP5100_WDT_MEM_MAP_SIZE); unreg_region: release_region(pm_iobase, SP5100_PM_IOPORTS_SIZE); exit: return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Takahisa Tanaka29953.68%228.57%
Priyanka Gupta19334.65%114.29%
Huang Rui315.57%114.29%
Yinghai Lu234.13%114.29%
Lucas Stach61.08%114.29%
Joe Perches50.90%114.29%
Total557100.00%7100.00%


static int sp5100_tco_init(struct platform_device *dev) { int ret; /* * Check whether or not the hardware watchdog is there. If found, then * set it up. */ if (!sp5100_tco_setupdevice()) return -ENODEV; /* Check to see if last reboot was due to watchdog timeout */ pr_info("Last reboot was %striggered by watchdog.\n", tco_wdt_fired ? "" : "not "); /* * Check that the heartbeat value is within it's range. * If not, reset to the default. */ if (tco_timer_set_heartbeat(heartbeat)) { heartbeat = WATCHDOG_HEARTBEAT; tco_timer_set_heartbeat(heartbeat); } ret = misc_register(&sp5100_tco_miscdev); if (ret != 0) { pr_err("cannot register miscdev on minor=%d (err=%d)\n", WATCHDOG_MINOR, ret); goto exit; } clear_bit(0, &timer_alive); /* Show module parameters */ pr_info("initialized (0x%p). heartbeat=%d sec (nowayout=%d)\n", tcobase, heartbeat, nowayout); return 0; exit: iounmap(tcobase); release_mem_region(tcobase_phys, SP5100_WDT_MEM_MAP_SIZE); release_region(pm_iobase, SP5100_PM_IOPORTS_SIZE); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta10580.15%120.00%
Joe Perches1410.69%120.00%
Yinghai Lu75.34%120.00%
Takahisa Tanaka53.82%240.00%
Total131100.00%5100.00%


static void sp5100_tco_cleanup(void) { /* Stop the timer before we leave */ if (!nowayout) tco_timer_stop(); /* Deregister */ misc_deregister(&sp5100_tco_miscdev); iounmap(tcobase); release_mem_region(tcobase_phys, SP5100_WDT_MEM_MAP_SIZE); release_region(pm_iobase, SP5100_PM_IOPORTS_SIZE); }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta3683.72%150.00%
Yinghai Lu716.28%150.00%
Total43100.00%2100.00%


static int sp5100_tco_remove(struct platform_device *dev) { if (tcobase) sp5100_tco_cleanup(); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta21100.00%1100.00%
Total21100.00%1100.00%


static void sp5100_tco_shutdown(struct platform_device *dev) { tco_timer_stop(); }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta14100.00%1100.00%
Total14100.00%1100.00%

static struct platform_driver sp5100_tco_driver = { .probe = sp5100_tco_init, .remove = sp5100_tco_remove, .shutdown = sp5100_tco_shutdown, .driver = { .name = TCO_MODULE_NAME, }, };
static int __init sp5100_tco_init_module(void) { int err; pr_info("SP5100/SB800 TCO WatchDog Timer Driver v%s\n", TCO_VERSION); err = platform_driver_register(&sp5100_tco_driver); if (err) return err; sp5100_tco_platform_device = platform_device_register_simple( TCO_MODULE_NAME, -1, NULL, 0); if (IS_ERR(sp5100_tco_platform_device)) { err = PTR_ERR(sp5100_tco_platform_device); goto unreg_platform_driver; } return 0; unreg_platform_driver: platform_driver_unregister(&sp5100_tco_driver); return err; }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta7795.06%133.33%
Joe Perches33.70%133.33%
Takahisa Tanaka11.23%133.33%
Total81100.00%3100.00%


static void __exit sp5100_tco_cleanup_module(void) { platform_device_unregister(sp5100_tco_platform_device); platform_driver_unregister(&sp5100_tco_driver); pr_info("SP5100/SB800 TCO Watchdog Module Unloaded\n"); }

Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta2288.00%133.33%
Joe Perches28.00%133.33%
Takahisa Tanaka14.00%133.33%
Total25100.00%3100.00%

module_init(sp5100_tco_init_module); module_exit(sp5100_tco_cleanup_module); MODULE_AUTHOR("Priyanka Gupta"); MODULE_DESCRIPTION("TCO timer driver for SP5100/SB800 chipset"); MODULE_LICENSE("GPL");

Overall Contributors

PersonTokensPropCommitsCommitProp
Priyanka Gupta130964.45%19.09%
Takahisa Tanaka55627.38%218.18%
Huang Rui412.02%218.18%
Yinghai Lu412.02%19.09%
Lucas Stach341.67%19.09%
Joe Perches321.58%19.09%
Denis Turischev100.49%19.09%
Jingoo Han60.30%19.09%
Wim Van Sebroeck20.10%19.09%
Total2031100.00%11100.00%
Directory: drivers/watchdog
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.