^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Watchdog driver for the MEN z069 IP-Core
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2018 Johannes Thumshirn <jth@kernel.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/mcb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/watchdog.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) struct men_z069_drv {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) struct watchdog_device wdt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) void __iomem *base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) struct resource *mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define MEN_Z069_WTR 0x10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define MEN_Z069_WTR_WDEN BIT(15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define MEN_Z069_WTR_WDET_MASK 0x7fff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define MEN_Z069_WVR 0x14
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define MEN_Z069_TIMER_FREQ 500 /* 500 Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define MEN_Z069_WDT_COUNTER_MIN 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define MEN_Z069_WDT_COUNTER_MAX 0x7fff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define MEN_Z069_DEFAULT_TIMEOUT 30
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) static bool nowayout = WATCHDOG_NOWAYOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) module_param(nowayout, bool, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started (default="
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) static int men_z069_wdt_start(struct watchdog_device *wdt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct men_z069_drv *drv = watchdog_get_drvdata(wdt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) u16 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) val = readw(drv->base + MEN_Z069_WTR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) val |= MEN_Z069_WTR_WDEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) writew(val, drv->base + MEN_Z069_WTR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) static int men_z069_wdt_stop(struct watchdog_device *wdt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) struct men_z069_drv *drv = watchdog_get_drvdata(wdt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) u16 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) val = readw(drv->base + MEN_Z069_WTR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) val &= ~MEN_Z069_WTR_WDEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) writew(val, drv->base + MEN_Z069_WTR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) static int men_z069_wdt_ping(struct watchdog_device *wdt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) struct men_z069_drv *drv = watchdog_get_drvdata(wdt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) u16 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) /* The watchdog trigger value toggles between 0x5555 and 0xaaaa */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) val = readw(drv->base + MEN_Z069_WVR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) val ^= 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) writew(val, drv->base + MEN_Z069_WVR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) static int men_z069_wdt_set_timeout(struct watchdog_device *wdt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) unsigned int timeout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) struct men_z069_drv *drv = watchdog_get_drvdata(wdt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) u16 reg, val, ena;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) wdt->timeout = timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) val = timeout * MEN_Z069_TIMER_FREQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) reg = readw(drv->base + MEN_Z069_WVR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) ena = reg & MEN_Z069_WTR_WDEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) reg = ena | val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) writew(reg, drv->base + MEN_Z069_WTR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) static const struct watchdog_info men_z069_info = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) .options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) .identity = "MEN z069 Watchdog",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) static const struct watchdog_ops men_z069_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) .start = men_z069_wdt_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) .stop = men_z069_wdt_stop,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) .ping = men_z069_wdt_ping,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) .set_timeout = men_z069_wdt_set_timeout,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) static struct watchdog_device men_z069_wdt = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) .info = &men_z069_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) .ops = &men_z069_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) .timeout = MEN_Z069_DEFAULT_TIMEOUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) .min_timeout = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) .max_timeout = MEN_Z069_WDT_COUNTER_MAX / MEN_Z069_TIMER_FREQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) static int men_z069_probe(struct mcb_device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) const struct mcb_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) struct men_z069_drv *drv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) struct resource *mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) drv = devm_kzalloc(&dev->dev, sizeof(struct men_z069_drv), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) if (!drv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) mem = mcb_request_mem(dev, "z069-wdt");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) if (IS_ERR(mem))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) return PTR_ERR(mem);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) drv->base = devm_ioremap(&dev->dev, mem->start, resource_size(mem));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) if (drv->base == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) goto release_mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) drv->mem = mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) drv->wdt = men_z069_wdt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) watchdog_init_timeout(&drv->wdt, 0, &dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) watchdog_set_nowayout(&drv->wdt, nowayout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) watchdog_set_drvdata(&drv->wdt, drv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) drv->wdt.parent = &dev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) mcb_set_drvdata(dev, drv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) return watchdog_register_device(&men_z069_wdt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) release_mem:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) mcb_release_mem(mem);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) static void men_z069_remove(struct mcb_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) struct men_z069_drv *drv = mcb_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) watchdog_unregister_device(&drv->wdt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) mcb_release_mem(drv->mem);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) static const struct mcb_device_id men_z069_ids[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) { .device = 0x45 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) { }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) MODULE_DEVICE_TABLE(mcb, men_z069_ids);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) static struct mcb_driver men_z069_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) .name = "z069-wdt",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) .probe = men_z069_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) .remove = men_z069_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) .id_table = men_z069_ids,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) module_mcb_driver(men_z069_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) MODULE_AUTHOR("Johannes Thumshirn <jth@kernel.org>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) MODULE_ALIAS("mcb:16z069");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) MODULE_IMPORT_NS(MCB);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags