From 85b55a7624bb8c16eb0745eb4dc8cc90bfec8d59 Mon Sep 17 00:00:00 2001
From: Sebastian Huber <sebastian.huber@embedded-brains.de>
Date: Tue, 16 Jan 2024 10:47:35 +0100
Subject: bsps/clock: Fix fast idle for SMP

---
 bsps/shared/dev/clock/clockimpl.h | 16 ++++++++++++++++
 1 file changed, 16 insertions(+)

(limited to 'bsps')

diff --git a/bsps/shared/dev/clock/clockimpl.h b/bsps/shared/dev/clock/clockimpl.h
index e922c0b320..c58a6eb079 100644
--- a/bsps/shared/dev/clock/clockimpl.h
+++ b/bsps/shared/dev/clock/clockimpl.h
@@ -139,6 +139,21 @@ volatile uint32_t    Clock_driver_ticks;
 #error "Clock_driver_support_shutdown_hardware() is no longer supported"
 #endif
 
+#if CLOCK_DRIVER_USE_FAST_IDLE
+static bool _Clock_Has_watchdogs(const Per_CPU_Control *cpu)
+{
+  size_t i;
+
+  for (i = 0; i < RTEMS_ARRAY_SIZE(cpu->Watchdog.Header); ++i) {
+    if (_Watchdog_Header_first(&cpu->Watchdog.Header[i]) != NULL) {
+      return true;
+    }
+  }
+
+  return false;
+}
+#endif
+
 /**
  *  @brief Clock_isr
  *
@@ -182,6 +197,7 @@ rtems_isr Clock_isr(
           cpu_self->thread_dispatch_disable_level == cpu_self->isr_nest_level
             && cpu_self->heir == cpu_self->executing
             && cpu_self->executing->is_idle
+            && _Clock_Has_watchdogs(cpu_self)
         ) {
           ISR_lock_Context lock_context;
 
-- 
cgit v1.2.3