123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797 |
- #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
- #include <linux/module.h>
- #include <linux/moduleparam.h>
- #include <linux/types.h>
- #include <linux/kernel.h>
- #include <linux/fs.h>
- #include <linux/miscdevice.h>
- #include <linux/init.h>
- #include <linux/ioport.h>
- #include <linux/watchdog.h>
- #include <linux/notifier.h>
- #include <linux/reboot.h>
- #include <linux/uaccess.h>
- #include <linux/io.h>
- #define WATCHDOG_VERSION "1.14"
- #define WATCHDOG_NAME "IT87 WDT"
- #define DRIVER_VERSION WATCHDOG_NAME " driver, v" WATCHDOG_VERSION "\n"
- #define WD_MAGIC 'V'
- #define DEFAULT_NOGAMEPORT 0
- #define DEFAULT_NOCIR 0
- #define DEFAULT_EXCLUSIVE 1
- #define DEFAULT_TIMEOUT 60
- #define DEFAULT_TESTMODE 0
- #define DEFAULT_NOWAYOUT WATCHDOG_NOWAYOUT
- #define REG 0x2e
- #define VAL 0x2f
- #define GPIO 0x07
- #define GAMEPORT 0x09
- #define CIR 0x0a
- #define LDNREG 0x07
- #define CHIPID 0x20
- #define CHIPREV 0x22
- #define ACTREG 0x30
- #define BASEREG 0x60
- #define NO_DEV_ID 0xffff
- #define IT8702_ID 0x8702
- #define IT8705_ID 0x8705
- #define IT8712_ID 0x8712
- #define IT8716_ID 0x8716
- #define IT8718_ID 0x8718
- #define IT8720_ID 0x8720
- #define IT8721_ID 0x8721
- #define IT8726_ID 0x8726
- #define IT8728_ID 0x8728
- #define IT8783_ID 0x8783
- #define WDTCTRL 0x71
- #define WDTCFG 0x72
- #define WDTVALLSB 0x73
- #define WDTVALMSB 0x74
- #define WDT_CIRINT 0x80
- #define WDT_MOUSEINT 0x40
- #define WDT_KYBINT 0x20
- #define WDT_GAMEPORT 0x10
- #define WDT_FORCE 0x02
- #define WDT_ZERO 0x01
- #define WDT_TOV1 0x80
- #define WDT_KRST 0x40
- #define WDT_TOVE 0x20
- #define WDT_PWROK 0x10
- #define WDT_INT_MASK 0x0f
- #define CIR_ILS 0x70
- #define CIR_BASE 0x0208
- #define CIR_DR(b) (b)
- #define CIR_IER(b) (b + 1)
- #define CIR_RCR(b) (b + 2)
- #define CIR_TCR1(b) (b + 3)
- #define CIR_TCR2(b) (b + 4)
- #define CIR_TSR(b) (b + 5)
- #define CIR_RSR(b) (b + 6)
- #define CIR_BDLR(b) (b + 5)
- #define CIR_BDHR(b) (b + 6)
- #define CIR_IIR(b) (b + 7)
- #define GP_BASE_DEFAULT 0x0201
- #define WDTS_TIMER_RUN 0
- #define WDTS_DEV_OPEN 1
- #define WDTS_KEEPALIVE 2
- #define WDTS_LOCKED 3
- #define WDTS_USE_GP 4
- #define WDTS_EXPECTED 5
- #define WDTS_USE_CIR 6
- static unsigned int base, gpact, ciract, max_units, chip_type;
- static unsigned long wdt_status;
- static int nogameport = DEFAULT_NOGAMEPORT;
- static int nocir = DEFAULT_NOCIR;
- static int exclusive = DEFAULT_EXCLUSIVE;
- static int timeout = DEFAULT_TIMEOUT;
- static int testmode = DEFAULT_TESTMODE;
- static bool nowayout = DEFAULT_NOWAYOUT;
- module_param(nogameport, int, 0);
- MODULE_PARM_DESC(nogameport, "Forbid the activation of game port, default="
- __MODULE_STRING(DEFAULT_NOGAMEPORT));
- module_param(nocir, int, 0);
- MODULE_PARM_DESC(nocir, "Forbid the use of Consumer IR interrupts to reset timer, default="
- __MODULE_STRING(DEFAULT_NOCIR));
- module_param(exclusive, int, 0);
- MODULE_PARM_DESC(exclusive, "Watchdog exclusive device open, default="
- __MODULE_STRING(DEFAULT_EXCLUSIVE));
- module_param(timeout, int, 0);
- MODULE_PARM_DESC(timeout, "Watchdog timeout in seconds, default="
- __MODULE_STRING(DEFAULT_TIMEOUT));
- module_param(testmode, int, 0);
- MODULE_PARM_DESC(testmode, "Watchdog test mode (1 = no reboot), default="
- __MODULE_STRING(DEFAULT_TESTMODE));
- module_param(nowayout, bool, 0);
- MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started, default="
- __MODULE_STRING(WATCHDOG_NOWAYOUT));
- static inline int superio_enter(void)
- {
-
- if (!request_muxed_region(REG, 2, WATCHDOG_NAME))
- return -EBUSY;
- outb(0x87, REG);
- outb(0x01, REG);
- outb(0x55, REG);
- outb(0x55, REG);
- return 0;
- }
- static inline void superio_exit(void)
- {
- outb(0x02, REG);
- outb(0x02, VAL);
- release_region(REG, 2);
- }
- static inline void superio_select(int ldn)
- {
- outb(LDNREG, REG);
- outb(ldn, VAL);
- }
- static inline int superio_inb(int reg)
- {
- outb(reg, REG);
- return inb(VAL);
- }
- static inline void superio_outb(int val, int reg)
- {
- outb(reg, REG);
- outb(val, VAL);
- }
- static inline int superio_inw(int reg)
- {
- int val;
- outb(reg++, REG);
- val = inb(VAL) << 8;
- outb(reg, REG);
- val |= inb(VAL);
- return val;
- }
- static inline void superio_outw(int val, int reg)
- {
- outb(reg++, REG);
- outb(val >> 8, VAL);
- outb(reg, REG);
- outb(val, VAL);
- }
- static void wdt_update_timeout(void)
- {
- unsigned char cfg = WDT_KRST;
- int tm = timeout;
- if (testmode)
- cfg = 0;
- if (tm <= max_units)
- cfg |= WDT_TOV1;
- else
- tm /= 60;
- if (chip_type != IT8721_ID)
- cfg |= WDT_PWROK;
- superio_outb(cfg, WDTCFG);
- superio_outb(tm, WDTVALLSB);
- if (max_units > 255)
- superio_outb(tm>>8, WDTVALMSB);
- }
- static int wdt_round_time(int t)
- {
- t += 59;
- t -= t % 60;
- return t;
- }
- static void wdt_keepalive(void)
- {
- if (test_bit(WDTS_USE_GP, &wdt_status))
- inb(base);
- else if (test_bit(WDTS_USE_CIR, &wdt_status))
-
- outb(0x55, CIR_DR(base));
- else {
- if (superio_enter())
- return;
- superio_select(GPIO);
- wdt_update_timeout();
- superio_exit();
- }
- set_bit(WDTS_KEEPALIVE, &wdt_status);
- }
- static int wdt_start(void)
- {
- int ret = superio_enter();
- if (ret)
- return ret;
- superio_select(GPIO);
- if (test_bit(WDTS_USE_GP, &wdt_status))
- superio_outb(WDT_GAMEPORT, WDTCTRL);
- else if (test_bit(WDTS_USE_CIR, &wdt_status))
- superio_outb(WDT_CIRINT, WDTCTRL);
- wdt_update_timeout();
- superio_exit();
- return 0;
- }
- static int wdt_stop(void)
- {
- int ret = superio_enter();
- if (ret)
- return ret;
- superio_select(GPIO);
- superio_outb(0x00, WDTCTRL);
- superio_outb(WDT_TOV1, WDTCFG);
- superio_outb(0x00, WDTVALLSB);
- if (max_units > 255)
- superio_outb(0x00, WDTVALMSB);
- superio_exit();
- return 0;
- }
- static int wdt_set_timeout(int t)
- {
- if (t < 1 || t > max_units * 60)
- return -EINVAL;
- if (t > max_units)
- timeout = wdt_round_time(t);
- else
- timeout = t;
- if (test_bit(WDTS_TIMER_RUN, &wdt_status)) {
- int ret = superio_enter();
- if (ret)
- return ret;
- superio_select(GPIO);
- wdt_update_timeout();
- superio_exit();
- }
- return 0;
- }
- static int wdt_get_status(int *status)
- {
- *status = 0;
- if (testmode) {
- int ret = superio_enter();
- if (ret)
- return ret;
- superio_select(GPIO);
- if (superio_inb(WDTCTRL) & WDT_ZERO) {
- superio_outb(0x00, WDTCTRL);
- clear_bit(WDTS_TIMER_RUN, &wdt_status);
- *status |= WDIOF_CARDRESET;
- }
- superio_exit();
- }
- if (test_and_clear_bit(WDTS_KEEPALIVE, &wdt_status))
- *status |= WDIOF_KEEPALIVEPING;
- if (test_bit(WDTS_EXPECTED, &wdt_status))
- *status |= WDIOF_MAGICCLOSE;
- return 0;
- }
- static int wdt_open(struct inode *inode, struct file *file)
- {
- if (exclusive && test_and_set_bit(WDTS_DEV_OPEN, &wdt_status))
- return -EBUSY;
- if (!test_and_set_bit(WDTS_TIMER_RUN, &wdt_status)) {
- int ret;
- if (nowayout && !test_and_set_bit(WDTS_LOCKED, &wdt_status))
- __module_get(THIS_MODULE);
- ret = wdt_start();
- if (ret) {
- clear_bit(WDTS_LOCKED, &wdt_status);
- clear_bit(WDTS_TIMER_RUN, &wdt_status);
- clear_bit(WDTS_DEV_OPEN, &wdt_status);
- return ret;
- }
- }
- return nonseekable_open(inode, file);
- }
- static int wdt_release(struct inode *inode, struct file *file)
- {
- if (test_bit(WDTS_TIMER_RUN, &wdt_status)) {
- if (test_and_clear_bit(WDTS_EXPECTED, &wdt_status)) {
- int ret = wdt_stop();
- if (ret) {
-
- set_bit(WDTS_EXPECTED, &wdt_status);
- wdt_keepalive();
- return ret;
- }
- clear_bit(WDTS_TIMER_RUN, &wdt_status);
- } else {
- wdt_keepalive();
- pr_crit("unexpected close, not stopping watchdog!\n");
- }
- }
- clear_bit(WDTS_DEV_OPEN, &wdt_status);
- return 0;
- }
- static ssize_t wdt_write(struct file *file, const char __user *buf,
- size_t count, loff_t *ppos)
- {
- if (count) {
- clear_bit(WDTS_EXPECTED, &wdt_status);
- wdt_keepalive();
- }
- if (!nowayout) {
- size_t ofs;
-
- for (ofs = 0; ofs != count; ofs++) {
- char c;
- if (get_user(c, buf + ofs))
- return -EFAULT;
- if (c == WD_MAGIC)
- set_bit(WDTS_EXPECTED, &wdt_status);
- }
- }
- return count;
- }
- static const struct watchdog_info ident = {
- .options = WDIOF_SETTIMEOUT | WDIOF_MAGICCLOSE | WDIOF_KEEPALIVEPING,
- .firmware_version = 1,
- .identity = WATCHDOG_NAME,
- };
- static long wdt_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
- {
- int rc = 0, status, new_options, new_timeout;
- union {
- struct watchdog_info __user *ident;
- int __user *i;
- } uarg;
- uarg.i = (int __user *)arg;
- switch (cmd) {
- case WDIOC_GETSUPPORT:
- return copy_to_user(uarg.ident,
- &ident, sizeof(ident)) ? -EFAULT : 0;
- case WDIOC_GETSTATUS:
- rc = wdt_get_status(&status);
- if (rc)
- return rc;
- return put_user(status, uarg.i);
- case WDIOC_GETBOOTSTATUS:
- return put_user(0, uarg.i);
- case WDIOC_KEEPALIVE:
- wdt_keepalive();
- return 0;
- case WDIOC_SETOPTIONS:
- if (get_user(new_options, uarg.i))
- return -EFAULT;
- switch (new_options) {
- case WDIOS_DISABLECARD:
- if (test_bit(WDTS_TIMER_RUN, &wdt_status)) {
- rc = wdt_stop();
- if (rc)
- return rc;
- }
- clear_bit(WDTS_TIMER_RUN, &wdt_status);
- return 0;
- case WDIOS_ENABLECARD:
- if (!test_and_set_bit(WDTS_TIMER_RUN, &wdt_status)) {
- rc = wdt_start();
- if (rc) {
- clear_bit(WDTS_TIMER_RUN, &wdt_status);
- return rc;
- }
- }
- return 0;
- default:
- return -EFAULT;
- }
- case WDIOC_SETTIMEOUT:
- if (get_user(new_timeout, uarg.i))
- return -EFAULT;
- rc = wdt_set_timeout(new_timeout);
- case WDIOC_GETTIMEOUT:
- if (put_user(timeout, uarg.i))
- return -EFAULT;
- return rc;
- default:
- return -ENOTTY;
- }
- }
- static int wdt_notify_sys(struct notifier_block *this, unsigned long code,
- void *unused)
- {
- if (code == SYS_DOWN || code == SYS_HALT)
- wdt_stop();
- return NOTIFY_DONE;
- }
- static const struct file_operations wdt_fops = {
- .owner = THIS_MODULE,
- .llseek = no_llseek,
- .write = wdt_write,
- .unlocked_ioctl = wdt_ioctl,
- .open = wdt_open,
- .release = wdt_release,
- };
- static struct miscdevice wdt_miscdev = {
- .minor = WATCHDOG_MINOR,
- .name = "watchdog",
- .fops = &wdt_fops,
- };
- static struct notifier_block wdt_notifier = {
- .notifier_call = wdt_notify_sys,
- };
- static int __init it87_wdt_init(void)
- {
- int rc = 0;
- int try_gameport = !nogameport;
- u8 chip_rev;
- int gp_rreq_fail = 0;
- wdt_status = 0;
- rc = superio_enter();
- if (rc)
- return rc;
- chip_type = superio_inw(CHIPID);
- chip_rev = superio_inb(CHIPREV) & 0x0f;
- superio_exit();
- switch (chip_type) {
- case IT8702_ID:
- max_units = 255;
- break;
- case IT8712_ID:
- max_units = (chip_rev < 8) ? 255 : 65535;
- break;
- case IT8716_ID:
- case IT8726_ID:
- max_units = 65535;
- break;
- case IT8718_ID:
- case IT8720_ID:
- case IT8721_ID:
- case IT8728_ID:
- case IT8783_ID:
- max_units = 65535;
- try_gameport = 0;
- break;
- case IT8705_ID:
- pr_err("Unsupported Chip found, Chip %04x Revision %02x\n",
- chip_type, chip_rev);
- return -ENODEV;
- case NO_DEV_ID:
- pr_err("no device\n");
- return -ENODEV;
- default:
- pr_err("Unknown Chip found, Chip %04x Revision %04x\n",
- chip_type, chip_rev);
- return -ENODEV;
- }
- rc = superio_enter();
- if (rc)
- return rc;
- superio_select(GPIO);
- superio_outb(WDT_TOV1, WDTCFG);
- superio_outb(0x00, WDTCTRL);
-
- if (try_gameport) {
- superio_select(GAMEPORT);
- base = superio_inw(BASEREG);
- if (!base) {
- base = GP_BASE_DEFAULT;
- superio_outw(base, BASEREG);
- }
- gpact = superio_inb(ACTREG);
- superio_outb(0x01, ACTREG);
- if (request_region(base, 1, WATCHDOG_NAME))
- set_bit(WDTS_USE_GP, &wdt_status);
- else
- gp_rreq_fail = 1;
- }
-
- if (!nocir && !test_bit(WDTS_USE_GP, &wdt_status)) {
- if (!request_region(CIR_BASE, 8, WATCHDOG_NAME)) {
- if (gp_rreq_fail)
- pr_err("I/O Address 0x%04x and 0x%04x already in use\n",
- base, CIR_BASE);
- else
- pr_err("I/O Address 0x%04x already in use\n",
- CIR_BASE);
- rc = -EIO;
- goto err_out;
- }
- base = CIR_BASE;
- superio_select(CIR);
- superio_outw(base, BASEREG);
- superio_outb(0x00, CIR_ILS);
- ciract = superio_inb(ACTREG);
- superio_outb(0x01, ACTREG);
- if (gp_rreq_fail) {
- superio_select(GAMEPORT);
- superio_outb(gpact, ACTREG);
- }
- set_bit(WDTS_USE_CIR, &wdt_status);
- }
- if (timeout < 1 || timeout > max_units * 60) {
- timeout = DEFAULT_TIMEOUT;
- pr_warn("Timeout value out of range, use default %d sec\n",
- DEFAULT_TIMEOUT);
- }
- if (timeout > max_units)
- timeout = wdt_round_time(timeout);
- rc = register_reboot_notifier(&wdt_notifier);
- if (rc) {
- pr_err("Cannot register reboot notifier (err=%d)\n", rc);
- goto err_out_region;
- }
- rc = misc_register(&wdt_miscdev);
- if (rc) {
- pr_err("Cannot register miscdev on minor=%d (err=%d)\n",
- wdt_miscdev.minor, rc);
- goto err_out_reboot;
- }
-
- if (test_bit(WDTS_USE_CIR, &wdt_status)) {
- outb(0x00, CIR_RCR(base));
- outb(0xc0, CIR_TCR1(base));
- outb(0x5c, CIR_TCR2(base));
- outb(0x10, CIR_IER(base));
- outb(0x00, CIR_BDHR(base));
- outb(0x01, CIR_BDLR(base));
- outb(0x09, CIR_IER(base));
- }
- pr_info("Chip IT%04x revision %d initialized. timeout=%d sec (nowayout=%d testmode=%d exclusive=%d nogameport=%d nocir=%d)\n",
- chip_type, chip_rev, timeout,
- nowayout, testmode, exclusive, nogameport, nocir);
- superio_exit();
- return 0;
- err_out_reboot:
- unregister_reboot_notifier(&wdt_notifier);
- err_out_region:
- if (test_bit(WDTS_USE_GP, &wdt_status))
- release_region(base, 1);
- else if (test_bit(WDTS_USE_CIR, &wdt_status)) {
- release_region(base, 8);
- superio_select(CIR);
- superio_outb(ciract, ACTREG);
- }
- err_out:
- if (try_gameport) {
- superio_select(GAMEPORT);
- superio_outb(gpact, ACTREG);
- }
- superio_exit();
- return rc;
- }
- static void __exit it87_wdt_exit(void)
- {
- if (superio_enter() == 0) {
- superio_select(GPIO);
- superio_outb(0x00, WDTCTRL);
- superio_outb(0x00, WDTCFG);
- superio_outb(0x00, WDTVALLSB);
- if (max_units > 255)
- superio_outb(0x00, WDTVALMSB);
- if (test_bit(WDTS_USE_GP, &wdt_status)) {
- superio_select(GAMEPORT);
- superio_outb(gpact, ACTREG);
- } else if (test_bit(WDTS_USE_CIR, &wdt_status)) {
- superio_select(CIR);
- superio_outb(ciract, ACTREG);
- }
- superio_exit();
- }
- misc_deregister(&wdt_miscdev);
- unregister_reboot_notifier(&wdt_notifier);
- if (test_bit(WDTS_USE_GP, &wdt_status))
- release_region(base, 1);
- else if (test_bit(WDTS_USE_CIR, &wdt_status))
- release_region(base, 8);
- }
- module_init(it87_wdt_init);
- module_exit(it87_wdt_exit);
- MODULE_AUTHOR("Oliver Schuster");
- MODULE_DESCRIPTION("Hardware Watchdog Device Driver for IT87xx EC-LPC I/O");
- MODULE_LICENSE("GPL");
|