drivers: watchdog: wdt_ti_rti.c: add callback support

- Add callback support for the wathdog driver.

Signed-off-by: Sunil Hegde <[email protected]>

Author: Sunil-Hegde

drivers/watchdog/wdt_ti_rti.c

@@ -9,6 +9,7 @@
 #include <zephyr/drivers/watchdog.h>
 #include <zephyr/kernel.h>
 #include <stdint.h>
+#include <zephyr/irq.h>
 
 #define WDENABLE_KEY  0xa98559da
 #define WDDISABLE_KEY 0x5312aced
@@ -59,28 +60,28 @@ struct wdt_ti_rti_regs {
 
 struct wdt_ti_rti_data {
 	DEVICE_MMIO_RAM;
+	wdt_callback_t callback;
 };
 
 struct wdt_ti_rti_config {
 	DEVICE_MMIO_ROM;
-
 	uint64_t freq;
+	void (*irq_config_func)(void);
 };
 
 static int wdt_ti_rti_setup(const struct device *dev, uint8_t options)
 {
 	ARG_UNUSED(options);
-
 	struct wdt_ti_rti_regs *regs = DEV_REGS(dev);
 
 	if (options & WDT_OPT_PAUSE_HALTED_BY_DBG) {
 		regs->GCTRL = RTIGCTRL_HALT_BY_DBG;
 	} else {
 		regs->GCTRL = RTIGCTRL_RUN_BY_DBG;
 	}
-
+	/* Clear the Watchdog status register before enabling */
+	regs->WDSTATUS = 0x3f;
 	regs->DWDCTRL = WDENABLE_KEY;
-
 	return 0;
 }
 
@@ -112,17 +113,21 @@ static int wdt_ti_rti_window_size(const struct wdt_window window)
 			break;
 		}
 	}
-
 	return -EINVAL;
 }
 
 static int wdt_ti_rti_timeout(const struct device *dev, const struct wdt_timeout_cfg *cfg)
 {
 	const struct wdt_ti_rti_config *config = DEV_CFG(dev);
+	struct wdt_ti_rti_data *data = DEV_DATA(dev);
 	struct wdt_ti_rti_regs *regs = DEV_REGS(dev);
 	uint32_t timer_margin;
 	int window_size;
 
+	if (cfg->callback != NULL) {
+		data->callback = cfg->callback;
+	}
+
 	window_size = wdt_ti_rti_window_size(cfg->window);
 	if (window_size < 0) {
 		return window_size;
@@ -134,6 +139,7 @@ static int wdt_ti_rti_timeout(const struct device *dev, const struct wdt_timeout
 		return -EINVAL;
 	}
 
+	/* Only NMI is supported */
 	if (cfg->flags == WDT_FLAG_RESET_SOC) {
 		regs->WWDRXNCTRL = RTIWWDRX_NMI;
 	}
@@ -151,24 +157,36 @@ static int wdt_ti_rti_feed(const struct device *dev, int channel_id)
 	if (channel_id != 0) {
 		return -EINVAL;
 	}
-
 	regs->WDKEY = WDKEY_SEQ0;
 	regs->WDKEY = WDKEY_SEQ1;
-
 	return 0;
 }
 
+static void wdt_ti_rti_isr(const struct device *dev)
+{
+	struct wdt_ti_rti_data *data = DEV_DATA(dev);
+	struct wdt_ti_rti_regs *regs = DEV_REGS(dev);
+	volatile uint32_t status = regs->WDSTATUS;
+	/* Clear status register before servicing the wathdog */
+	regs->WDSTATUS = 0x3f;
+	if (status & BIT(5) && data->callback) {
+		data->callback(dev, 0);
+	}
+	regs->WDKEY = WDKEY_SEQ0;
+	regs->WDKEY = WDKEY_SEQ1;
+}
+
 static int wdt_ti_rti_init(const struct device *dev)
 {
+	const struct wdt_ti_rti_config *config = DEV_CFG(dev);
 	struct wdt_ti_rti_regs *regs;
 
 	DEVICE_MMIO_MAP(dev, K_MEM_CACHE_NONE);
-
 	regs = DEV_REGS(dev);
 	if (!regs) {
 		return -EINVAL;
 	}
-
+	config->irq_config_func();
 	return 0;
 }
 
@@ -180,11 +198,18 @@ static DEVICE_API(wdt, wdt_ti_rti_api) = {
 };
 
 #define WDT_TI_RTI_INIT(i)                                                                         \
+	static void wdt_ti_rti_irq_config_##i(void)                                                \
+	{                                                                                          \
+		IRQ_CONNECT(DT_INST_IRQN(i), DT_INST_IRQ(i, priority), wdt_ti_rti_isr,             \
+			    DEVICE_DT_INST_GET(i), 0);                                             \
+		irq_enable(DT_INST_IRQN(i));                                                       \
+	};                                                                                         \
 	static struct wdt_ti_rti_data wdt_ti_rti_data_##i = {};                                    \
                                                                                                    \
 	static struct wdt_ti_rti_config wdt_ti_rti_config_##i = {                                  \
 		DEVICE_MMIO_ROM_INIT(DT_DRV_INST(i)),                                              \
 		.freq = DT_INST_PROP(i, clock_frequency),                                          \
+		.irq_config_func = wdt_ti_rti_irq_config_##i,                                      \
 	};                                                                                         \
                                                                                                    \
 	DEVICE_DT_INST_DEFINE(i, wdt_ti_rti_init, NULL, &wdt_ti_rti_data_##i,                      \