Clock test

Author: e-rk

modules/hal_nordic/nrf_802154/sl_opensource/platform/nrf_802154_clock_zephyr.c

@@ -13,21 +13,31 @@
 #include <zephyr/kernel.h>
 #include <zephyr/drivers/clock_control/nrf_clock_control.h>
 #include <nrf_sys_event.h>
+#include <hal/nrf_egu.h>
+
+#define NTF_INT NRFX_CONCAT_2(NRF_EGU_INT_TRIGGERED, NRF_802154_SL_EGU_CLOCK_CHANNEL_NO)
+#define NTF_TASK NRFX_CONCAT_2(NRF_EGU_TASK_TRIGGER, NRF_802154_SL_EGU_CLOCK_CHANNEL_NO)
+#define NTF_EVENT NRFX_CONCAT_2(NRF_EGU_EVENT_TRIGGERED, NRF_802154_SL_EGU_CLOCK_CHANNEL_NO)
 
 static bool hfclk_is_running;
 
+/* Forward declaration. */
+static void hfclk_stop(void);
+
 void nrf_802154_clock_init(void)
 {
 #ifdef NRF54L_SERIES
 	uint32_t clock_latency_us = z_nrf_clock_bt_ctlr_hf_get_startup_time_us();
 
 	nrf_802154_clock_hfclk_latency_set(clock_latency_us);
 #endif
+
+	nrf_egu_int_enable(NRF_802154_EGU_INSTANCE, NTF_INT);
 }
 
 void nrf_802154_clock_deinit(void)
 {
-	/* Intentionally empty. */
+	nrf_egu_int_disable(NRF_802154_EGU_INSTANCE, NTF_INT);
 }
 
 bool nrf_802154_clock_hfclk_is_running(void)
@@ -47,6 +57,21 @@ static void hfclk_on_callback(struct onoff_manager *mgr,
 	nrf_802154_clock_hfclk_ready();
 }
 
+void nrf_802154_sl_clock_swi_irq_handler(void)
+{
+    if (nrf_egu_event_check(NRF_802154_EGU_INSTANCE, NTF_EVENT))
+    {
+        nrf_egu_event_clear(NRF_802154_EGU_INSTANCE, NTF_EVENT);
+
+        hfclk_stop();
+    }
+}
+
+void nrf_802154_clock_hfclk_stop(void)
+{
+	nrf_egu_task_trigger(NRF_802154_EGU_INSTANCE, NTF_TASK);
+}
+
 #if defined(CONFIG_CLOCK_CONTROL_NRF)
 void nrf_802154_clock_hfclk_start(void)
 {
@@ -70,13 +95,15 @@ void nrf_802154_clock_hfclk_start(void)
 	(void)ret;
 }
 
-void nrf_802154_clock_hfclk_stop(void)
+static void hfclk_stop(void)
 {
 	struct onoff_manager *mgr =
-		z_nrf_clock_control_get_onoff(CLOCK_CONTROL_NRF_SUBSYS_HF);
+	z_nrf_clock_control_get_onoff(CLOCK_CONTROL_NRF_SUBSYS_HF);
 
 	__ASSERT_NO_MSG(mgr != NULL);
 
+	unsigned int key = irq_lock();
+
 	int ret = onoff_cancel_or_release(mgr, &hfclk_cli);
 	__ASSERT_NO_MSG(ret >= 0);
 	(void)ret;
@@ -86,6 +113,8 @@ void nrf_802154_clock_hfclk_stop(void)
 	}
 
 	hfclk_is_running = false;
+
+	irq_unlock(key);
 }
 
 #elif DT_NODE_HAS_STATUS(DT_NODELABEL(hfxo), okay) && \
@@ -100,7 +129,7 @@ void nrf_802154_clock_hfclk_start(void)
 	(void)ret;
 }
 
-void nrf_802154_clock_hfclk_stop(void)
+static void hfclk_stop(void)
 {
 	int ret = nrf_clock_control_cancel_or_release(DEVICE_DT_GET(DT_NODELABEL(hfxo)),
 						      NULL, &hfclk_cli);