Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 | // SPDX-License-Identifier: GPL-2.0 /* Marvell GTI Watchdog driver * * Copyright (C) 2023 Marvell. */ #include <linux/clk.h> #include <linux/interrupt.h> #include <linux/io.h> #include <linux/module.h> #include <linux/platform_device.h> #include <linux/of.h> #include <linux/watchdog.h> /* * Hardware supports following mode of operation: * 1) Interrupt Only: * This will generate the interrupt to arm core whenever timeout happens. * * 2) Interrupt + del3t (Interrupt to firmware (SCP processor)). * This will generate interrupt to arm core on 1st timeout happens * This will generate interrupt to SCP processor on 2nd timeout happens * * 3) Interrupt + Interrupt to SCP processor (called delt3t) + reboot. * This will generate interrupt to arm core on 1st timeout happens * Will generate interrupt to SCP processor on 2nd timeout happens, * if interrupt is configured. * Reboot on 3rd timeout. * * Driver will use hardware in mode-3 above so that system can reboot in case * a hardware hang. Also h/w is configured not to generate SCP interrupt, so * effectively 2nd timeout is ignored within hardware. * * First timeout is effectively watchdog pretimeout. */ /* GTI CWD Watchdog (GTI_CWD_WDOG) Register */ #define GTI_CWD_WDOG(reg_offset) (0x8 * (reg_offset)) #define GTI_CWD_WDOG_MODE_INT_DEL3T_RST 0x3 #define GTI_CWD_WDOG_MODE_MASK GENMASK_ULL(1, 0) #define GTI_CWD_WDOG_LEN_SHIFT 4 #define GTI_CWD_WDOG_LEN_MASK GENMASK_ULL(19, 4) #define GTI_CWD_WDOG_CNT_SHIFT 20 #define GTI_CWD_WDOG_CNT_MASK GENMASK_ULL(43, 20) /* GTI CWD Watchdog Interrupt (GTI_CWD_INT) Register */ #define GTI_CWD_INT 0x200 #define GTI_CWD_INT_PENDING_STATUS(bit) BIT_ULL(bit) /* GTI CWD Watchdog Interrupt Enable Clear (GTI_CWD_INT_ENA_CLR) Register */ #define GTI_CWD_INT_ENA_CLR 0x210 #define GTI_CWD_INT_ENA_CLR_VAL(bit) BIT_ULL(bit) /* GTI CWD Watchdog Interrupt Enable Set (GTI_CWD_INT_ENA_SET) Register */ #define GTI_CWD_INT_ENA_SET 0x218 #define GTI_CWD_INT_ENA_SET_VAL(bit) BIT_ULL(bit) /* GTI CWD Watchdog Poke (GTI_CWD_POKE) Registers */ #define GTI_CWD_POKE(reg_offset) (0x10000 + 0x8 * (reg_offset)) #define GTI_CWD_POKE_VAL 1 struct gti_match_data { u32 gti_num_timers; }; static const struct gti_match_data match_data_octeontx2 = { .gti_num_timers = 54, }; static const struct gti_match_data match_data_cn10k = { .gti_num_timers = 64, }; struct gti_wdt_priv { struct watchdog_device wdev; void __iomem *base; u32 clock_freq; struct clk *sclk; /* wdt_timer_idx used for timer to be used for system watchdog */ u32 wdt_timer_idx; const struct gti_match_data *data; }; static irqreturn_t gti_wdt_interrupt(int irq, void *data) { struct watchdog_device *wdev = data; struct gti_wdt_priv *priv = watchdog_get_drvdata(wdev); /* Clear Interrupt Pending Status */ writeq(GTI_CWD_INT_PENDING_STATUS(priv->wdt_timer_idx), priv->base + GTI_CWD_INT); watchdog_notify_pretimeout(wdev); return IRQ_HANDLED; } static int gti_wdt_ping(struct watchdog_device *wdev) { struct gti_wdt_priv *priv = watchdog_get_drvdata(wdev); writeq(GTI_CWD_POKE_VAL, priv->base + GTI_CWD_POKE(priv->wdt_timer_idx)); return 0; } static int gti_wdt_start(struct watchdog_device *wdev) { struct gti_wdt_priv *priv = watchdog_get_drvdata(wdev); u64 regval; if (!wdev->pretimeout) return -EINVAL; set_bit(WDOG_HW_RUNNING, &wdev->status); /* Clear any pending interrupt */ writeq(GTI_CWD_INT_PENDING_STATUS(priv->wdt_timer_idx), priv->base + GTI_CWD_INT); /* Enable Interrupt */ writeq(GTI_CWD_INT_ENA_SET_VAL(priv->wdt_timer_idx), priv->base + GTI_CWD_INT_ENA_SET); /* Set (Interrupt + SCP interrupt (DEL3T) + core domain reset) Mode */ regval = readq(priv->base + GTI_CWD_WDOG(priv->wdt_timer_idx)); regval |= GTI_CWD_WDOG_MODE_INT_DEL3T_RST; writeq(regval, priv->base + GTI_CWD_WDOG(priv->wdt_timer_idx)); return 0; } static int gti_wdt_stop(struct watchdog_device *wdev) { struct gti_wdt_priv *priv = watchdog_get_drvdata(wdev); u64 regval; /* Disable Interrupt */ writeq(GTI_CWD_INT_ENA_CLR_VAL(priv->wdt_timer_idx), priv->base + GTI_CWD_INT_ENA_CLR); /* Set GTI_CWD_WDOG.Mode = 0 to stop the timer */ regval = readq(priv->base + GTI_CWD_WDOG(priv->wdt_timer_idx)); regval &= ~GTI_CWD_WDOG_MODE_MASK; writeq(regval, priv->base + GTI_CWD_WDOG(priv->wdt_timer_idx)); return 0; } static int gti_wdt_settimeout(struct watchdog_device *wdev, unsigned int timeout) { struct gti_wdt_priv *priv = watchdog_get_drvdata(wdev); u64 timeout_wdog, regval; /* Update new timeout */ wdev->timeout = timeout; /* Pretimeout is 1/3 of timeout */ wdev->pretimeout = timeout / 3; /* Get clock cycles from pretimeout */ timeout_wdog = (u64)priv->clock_freq * wdev->pretimeout; /* Watchdog counts in 1024 cycle steps */ timeout_wdog = timeout_wdog >> 10; /* GTI_CWD_WDOG.CNT: reload counter is 16-bit */ timeout_wdog = (timeout_wdog + 0xff) >> 8; if (timeout_wdog >= 0x10000) timeout_wdog = 0xffff; /* * GTI_CWD_WDOG.LEN is 24bit, lower 8-bits should be zero and * upper 16-bits are same as GTI_CWD_WDOG.CNT */ regval = readq(priv->base + GTI_CWD_WDOG(priv->wdt_timer_idx)); regval &= GTI_CWD_WDOG_MODE_MASK; regval |= (timeout_wdog << (GTI_CWD_WDOG_CNT_SHIFT + 8)) | (timeout_wdog << GTI_CWD_WDOG_LEN_SHIFT); writeq(regval, priv->base + GTI_CWD_WDOG(priv->wdt_timer_idx)); return 0; } static int gti_wdt_set_pretimeout(struct watchdog_device *wdev, unsigned int timeout) { struct gti_wdt_priv *priv = watchdog_get_drvdata(wdev); struct watchdog_device *wdog_dev = &priv->wdev; if (!timeout) { /* Disable Interrupt */ writeq(GTI_CWD_INT_ENA_CLR_VAL(priv->wdt_timer_idx), priv->base + GTI_CWD_INT_ENA_CLR); return 0; } /* pretimeout should 1/3 of max_timeout */ if (timeout * 3 <= wdog_dev->max_timeout) return gti_wdt_settimeout(wdev, timeout * 3); return -EINVAL; } static void gti_clk_disable_unprepare(void *data) { clk_disable_unprepare(data); } static int gti_wdt_get_cntfrq(struct platform_device *pdev, struct gti_wdt_priv *priv) { int err; priv->sclk = devm_clk_get_enabled(&pdev->dev, NULL); if (IS_ERR(priv->sclk)) return PTR_ERR(priv->sclk); err = devm_add_action_or_reset(&pdev->dev, gti_clk_disable_unprepare, priv->sclk); if (err) return err; priv->clock_freq = clk_get_rate(priv->sclk); if (!priv->clock_freq) return -EINVAL; return 0; } static const struct watchdog_info gti_wdt_ident = { .identity = "Marvell GTI watchdog", .options = WDIOF_SETTIMEOUT | WDIOF_PRETIMEOUT | WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE | WDIOF_CARDRESET, }; static const struct watchdog_ops gti_wdt_ops = { .owner = THIS_MODULE, .start = gti_wdt_start, .stop = gti_wdt_stop, .ping = gti_wdt_ping, .set_timeout = gti_wdt_settimeout, .set_pretimeout = gti_wdt_set_pretimeout, }; static int gti_wdt_probe(struct platform_device *pdev) { struct gti_wdt_priv *priv; struct device *dev = &pdev->dev; struct watchdog_device *wdog_dev; u64 max_pretimeout; u32 wdt_idx; int irq; int err; priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); if (!priv) return -ENOMEM; priv->base = devm_platform_ioremap_resource(pdev, 0); if (IS_ERR(priv->base)) return dev_err_probe(&pdev->dev, PTR_ERR(priv->base), "reg property not valid/found\n"); err = gti_wdt_get_cntfrq(pdev, priv); if (err) return dev_err_probe(&pdev->dev, err, "GTI clock frequency not valid/found"); priv->data = of_device_get_match_data(dev); /* default use last timer for watchdog */ priv->wdt_timer_idx = priv->data->gti_num_timers - 1; err = of_property_read_u32(dev->of_node, "marvell,wdt-timer-index", &wdt_idx); if (!err) { if (wdt_idx >= priv->data->gti_num_timers) return dev_err_probe(&pdev->dev, -EINVAL, "GTI wdog timer index not valid"); priv->wdt_timer_idx = wdt_idx; } wdog_dev = &priv->wdev; wdog_dev->info = >i_wdt_ident, wdog_dev->ops = >i_wdt_ops, wdog_dev->parent = dev; /* * Watchdog counter is 24 bit where lower 8 bits are zeros * This counter decrements every 1024 clock cycles. */ max_pretimeout = (GTI_CWD_WDOG_CNT_MASK >> GTI_CWD_WDOG_CNT_SHIFT); max_pretimeout &= ~0xFFUL; max_pretimeout = (max_pretimeout * 1024) / priv->clock_freq; wdog_dev->pretimeout = max_pretimeout; /* Maximum timeout is 3 times the pretimeout */ wdog_dev->max_timeout = max_pretimeout * 3; wdog_dev->max_hw_heartbeat_ms = max_pretimeout * 1000; /* Minimum first timeout (pretimeout) is 1, so min_timeout as 3 */ wdog_dev->min_timeout = 3; wdog_dev->timeout = wdog_dev->pretimeout; watchdog_set_drvdata(wdog_dev, priv); platform_set_drvdata(pdev, priv); gti_wdt_settimeout(wdog_dev, wdog_dev->timeout); watchdog_stop_on_reboot(wdog_dev); watchdog_stop_on_unregister(wdog_dev); err = devm_watchdog_register_device(dev, wdog_dev); if (err) return err; irq = platform_get_irq(pdev, 0); if (irq < 0) return irq; err = devm_request_irq(dev, irq, gti_wdt_interrupt, 0, pdev->name, &priv->wdev); if (err) return dev_err_probe(dev, err, "Failed to register interrupt handler\n"); dev_info(dev, "Watchdog enabled (timeout=%d sec)\n", wdog_dev->timeout); return 0; } static const struct of_device_id gti_wdt_of_match[] = { { .compatible = "marvell,cn9670-wdt", .data = &match_data_octeontx2}, { .compatible = "marvell,cn10624-wdt", .data = &match_data_cn10k}, { }, }; MODULE_DEVICE_TABLE(of, gti_wdt_of_match); static struct platform_driver gti_wdt_driver = { .driver = { .name = "gti-wdt", .of_match_table = gti_wdt_of_match, }, .probe = gti_wdt_probe, }; module_platform_driver(gti_wdt_driver); MODULE_AUTHOR("Bharat Bhushan <bbhushan2@marvell.com>"); MODULE_DESCRIPTION("Marvell GTI watchdog driver"); MODULE_LICENSE("GPL"); |