This driver provides support for the CGEB watchdog found on some Congatec x86 modules. Signed-off-by: Sascha Hauer <s.hauer@xxxxxxxxxxxxxx> --- drivers/watchdog/Kconfig | 10 ++ drivers/watchdog/Makefile | 1 + drivers/watchdog/congatec_cgeb_watchdog.c | 161 +++++++++++++++++++++++++++++ 3 files changed, 172 insertions(+) create mode 100644 drivers/watchdog/congatec_cgeb_watchdog.c diff --git a/drivers/watchdog/Kconfig b/drivers/watchdog/Kconfig index 7f809fd..47138fb 100644 --- a/drivers/watchdog/Kconfig +++ b/drivers/watchdog/Kconfig @@ -934,6 +934,16 @@ config SBC_EPX_C3_WATCHDOG To compile this driver as a module, choose M here: the module will be called sbc_epx_c3. +config CONGATEC_CGEB_WATCHDOG + depends on CONGATEC_CGEB + tristate "Congatec CGEB watchdog" + ---help--- + This driver provides support for the watchdogs found on Congatec + modules with the CGEB BIOS interface. + + To compile this driver as a module, choose M here: the + module will be called congatec_cgeb_wdt. + # M32R Architecture # M68K Architecture diff --git a/drivers/watchdog/Makefile b/drivers/watchdog/Makefile index 97bbdb3a..e67eee5 100644 --- a/drivers/watchdog/Makefile +++ b/drivers/watchdog/Makefile @@ -108,6 +108,7 @@ obj-$(CONFIG_W83977F_WDT) += w83977f_wdt.o obj-$(CONFIG_MACHZ_WDT) += machzwd.o obj-$(CONFIG_SBC_EPX_C3_WATCHDOG) += sbc_epx_c3.o obj-$(CONFIG_INTEL_SCU_WATCHDOG) += intel_scu_watchdog.o +obj-$(CONFIG_CONGATEC_CGEB_WATCHDOG) += congatec_cgeb_watchdog.o # M32R Architecture diff --git a/drivers/watchdog/congatec_cgeb_watchdog.c b/drivers/watchdog/congatec_cgeb_watchdog.c new file mode 100644 index 0000000..b7b6cf5 --- /dev/null +++ b/drivers/watchdog/congatec_cgeb_watchdog.c @@ -0,0 +1,161 @@ +/* + * CGEB watchdog driver + * + * (c) 2011 Sascha Hauer, Pengutronix + * + * 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; version 2 of the License. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ +#include <linux/module.h> +#include <linux/platform_device.h> +#include <linux/watchdog.h> +#include <asm/congatec-cgeb.h> + +#define CGOS_WDOG_MODE_REBOOT_PC 0 +#define CGOS_WDOG_MODE_RESTART_OS 1 +#define CGOS_WDOG_MODE_STAGED 0x80 + +#define CGOS_WDOG_OPMODE_DISABLED 0 +#define CGOS_WDOG_OPMODE_ONETIME_TRIG 1 +#define CGOS_WDOG_OPMODE_SINGLE_EVENT 2 +#define CGOS_WDOG_OPMODE_EVENT_REPEAT 3 + +#define CGOS_WDOG_EVENT_INT 0 /* NMI/IRQ */ +#define CGOS_WDOG_EVENT_SCI 1 /* SMI/SCI */ +#define CGOS_WDOG_EVENT_RST 2 /* system reset */ +#define CGOS_WDOG_EVENT_BTN 3 /* power button */ + +#define CGOS_WDOG_EVENT_MAX_STAGES 3 + +struct cgeb_watchdog_stage { + unsigned long timeout; + unsigned long event; +}; + +struct cgeb_watchdog_config { + unsigned long size; + unsigned long timeout; /* not used in staged mode */ + unsigned long delay; + unsigned long mode; + /* optional parameters for staged watchdog */ + unsigned long op_mode; + unsigned long stage_count; + struct cgeb_watchdog_stage stages[CGOS_WDOG_EVENT_MAX_STAGES]; +}; + +struct cgeb_watchdog_priv { + struct cgeb_board_data *board; + struct watchdog_device wdd; + int unit; +}; + +static struct watchdog_info cgeb_wdd_info = { + .options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING, + .firmware_version = 0, + .identity = "cgeb watchdog", +}; + +static unsigned int watchdog_set_config(struct cgeb_watchdog_priv *priv, + unsigned int timeout_s) +{ + struct cgeb_board_data *board = priv->board; + struct cgeb_watchdog_config wdi; + struct cgeb_function_parameters fps; + + memset(&wdi, 0, sizeof(wdi)); + memset(&fps, 0, sizeof(fps)); + + fps.unit = priv->unit; + fps.iptr = &wdi; + + wdi.timeout = timeout_s * 1000; + wdi.delay = 0; + wdi.size = sizeof(wdi); + wdi.mode = CGOS_WDOG_MODE_REBOOT_PC; + + return cgeb_call(board, &fps, CgebWDogSetConfig); +} + +static int cgeb_watchdog_start(struct watchdog_device *wdd) +{ + struct cgeb_watchdog_priv *priv = watchdog_get_drvdata(wdd); + + return watchdog_set_config(priv, wdd->timeout); +} + +static int cgeb_watchdog_stop(struct watchdog_device *wdd) +{ + struct cgeb_watchdog_priv *priv = watchdog_get_drvdata(wdd); + + return watchdog_set_config(priv, 0); +} + +static int cgeb_watchdog_set_timeout(struct watchdog_device *wdd, + unsigned int timeout_s) +{ + return 0; +} + +struct watchdog_ops cgeb_watchdog_ops = { + .start = cgeb_watchdog_start, + .stop = cgeb_watchdog_stop, + .set_timeout = cgeb_watchdog_set_timeout, +}; + +static int cgeb_watchdog_probe(struct platform_device *pdev) +{ + struct cgeb_watchdog_priv *priv; + struct cgeb_pdata *pdata = pdev->dev.platform_data; + int ret; + + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + priv->wdd.ops = &cgeb_watchdog_ops; + priv->wdd.info = &cgeb_wdd_info; + priv->wdd.min_timeout = 1; + priv->wdd.max_timeout = 3600; + priv->board = pdata->board; + priv->unit = pdata->unit; + + watchdog_set_drvdata(&priv->wdd, priv); + platform_set_drvdata(pdev, priv); + + ret = watchdog_register_device(&priv->wdd); + if (ret) + return ret; + + dev_info(&pdev->dev, "registered\n"); + + return 0; +} + +static int cgeb_watchdog_remove(struct platform_device *pdev) +{ + struct cgeb_watchdog_priv *priv = platform_get_drvdata(pdev); + + watchdog_unregister_device(&priv->wdd); + + return 0; +} + +static struct platform_driver cgeb_watchdog_driver = { + .probe = cgeb_watchdog_probe, + .remove = cgeb_watchdog_remove, + .driver = { + .name = "cgeb-watchdog", + .owner = THIS_MODULE, + }, +}; +module_platform_driver(cgeb_watchdog_driver); + +MODULE_AUTHOR("Sascha Hauer <s.hauer@xxxxxxxxxxxxxx>"); +MODULE_DESCRIPTION("cgeb watchdog driver"); +MODULE_LICENSE("GPL v2"); -- 1.7.10.4 -- To unsubscribe from this list: send the line "unsubscribe linux-i2c" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html