mpsl: enable use of nrfx_power_constlat_mode

Enable application to have several modules requesting constlat.
Right now, on 54l, mpsl just writes to NRF_POWER directly, disregarding
what other users in system might want constlat to be.

This PR prepares for a soon commig nrfxlib PR where mpsl will rather
use mpsl_constlat_request_callback to turn on constlat.
If NRFX_POWER modules is enabled in config,
it will use nrfx_power_constlat_mode_request,
if not it will use NRF_POWER diretly.

Signed-off-by: Martin Tverdal <[email protected]>

subsys/mpsl/init/mpsl_init.c

@@ -15,6 +15,9 @@
 #include <mpsl/mpsl_work.h>
 #include "multithreading_lock.h"
 #include <nrfx.h>
+#if IS_ENABLED(CONFIG_SOC_COMPATIBLE_NRF54LX)
+#include <nrfx_power.h>
+#endif
 #if defined(CONFIG_NRFX_DPPI)
 #include <nrfx_dppi.h>
 #endif
@@ -395,7 +398,8 @@ static int32_t mpsl_lib_init_internal(void)
 
 	mpsl_clock_hfclk_latency_set(CONFIG_MPSL_HFCLK_LATENCY);
 
-	if (IS_ENABLED(CONFIG_SOC_NRF_FORCE_CONSTLAT)) {
+	if (IS_ENABLED(CONFIG_SOC_NRF_FORCE_CONSTLAT) &&
+		!IS_ENABLED(CONFIG_SOC_COMPATIBLE_NRF54LX)) {
 		mpsl_pan_rfu();
 	}
 
@@ -509,6 +513,26 @@ int32_t mpsl_lib_uninit(void)
 #endif /* IS_ENABLED(CONFIG_MPSL_DYNAMIC_INTERRUPTS) */
 }
 
+#if defined(CONFIG_SOC_COMPATIBLE_NRF54LX)
+void mpsl_constlat_request_callback(void)
+{
+#if defined(CONFIG_NRFX_POWER)
+	nrfx_power_constlat_mode_request();
+#else
+	nrf_power_task_trigger(NRF_POWER, NRF_POWER_TASK_CONSTLAT);
+#endif
+}
+
+void mpsl_lowpower_request_callbacqk(void)
+{
+#if defined(CONFIG_NRFX_POWER)
+	nrfx_power_constlat_mode_free();
+#else
+	nrf_power_task_trigger(NRF_POWER, NRF_POWER_TASK_LOWPWR);
+#endif
+}
+#endif /* defined(CONFIG_SOC_COMPATIBLE_NRF54LX) */
+
 SYS_INIT(mpsl_lib_init_sys, PRE_KERNEL_1, CONFIG_KERNEL_INIT_PRIORITY_DEFAULT);
 SYS_INIT(mpsl_low_prio_init, POST_KERNEL,
 	 CONFIG_KERNEL_INIT_PRIORITY_DEFAULT);