tests: benchmarks: multicore: idle_with_pwm: Disable GD2 and GD3 manually

This commit shall be dropped when GD handling
is implemented in sdk-zephyr.

Signed-off-by: Sebastian Głąb <[email protected]>
(cherry picked from commit 7909484)

Author: nordic-segl

tests/benchmarks/multicore/idle_with_pwm/prj_s2ram.conf

@@ -13,3 +13,4 @@ CONFIG_BOOT_BANNER=n
 CONFIG_NRFS_MRAM_SERVICE_ENABLED=n
 
 CONFIG_PWM=y
+CONFIG_NRFS=y

tests/benchmarks/multicore/idle_with_pwm/src/main.c

@@ -11,6 +11,9 @@ LOG_MODULE_REGISTER(idle_with_pwm, LOG_LEVEL_INF);
 #include <zephyr/drivers/pwm.h>
 #include <zephyr/pm/device_runtime.h>
 
+#include <nrfs_backend_ipc_service.h>
+#include <nrfs_gdpwr.h>
+
 #if IS_ENABLED(CONFIG_SOC_NRF54H20_CPUAPP_COMMON)
 /* Alias pwm-led0 = &pwm_led2 */
 static const struct pwm_dt_spec pwm_led = PWM_DT_SPEC_GET(DT_ALIAS(pwm_led0));
@@ -23,6 +26,53 @@ static const struct pwm_dt_spec pwm_led = PWM_DT_SPEC_GET(DT_ALIAS(pwm_led0));
 
 #define PWM_STEPS_PER_SEC	(50)
 
+/* Required to power off the GD2 and GD3 domains
+ * Will be removed when GD handling
+ * is implemented in sdk-zephyr
+ */
+static void gdpwr_handler(nrfs_gdpwr_evt_t const *p_evt, void *context)
+{
+	switch (p_evt->type) {
+	case NRFS_GDPWR_REQ_APPLIED:
+		printk("GDPWR handler - response received: 0x%x, CTX=%d\n", p_evt->type,
+			(uint32_t)context);
+		break;
+	case NRFS_GDPWR_REQ_REJECTED:
+		printk("GDPWR handler - request rejected: 0x%x, CTX=%d\n", p_evt->type,
+			(uint32_t)context);
+		break;
+	default:
+		printk("GDPWR handler - unexpected event: 0x%x, CTX=%d\n", p_evt->type,
+			(uint32_t)context);
+		break;
+	}
+}
+
+/* Required to power off the GD2 and GD3 domains
+ * Will be removed when GD handling
+ * is implemented in sdk-zephyr
+ */
+static void clear_global_power_domains_requests(void)
+{
+	int service_status;
+	int tst_ctx = 1;
+
+	service_status = nrfs_gdpwr_init(gdpwr_handler);
+	printk("Response: %d\n", service_status);
+	printk("Sending GDPWR DISABLE request for: GDPWR_POWER_DOMAIN_ACTIVE_SLOW\n");
+	service_status = nrfs_gdpwr_power_request(GDPWR_POWER_DOMAIN_ACTIVE_SLOW,
+						  GDPWR_POWER_REQUEST_CLEAR, (void *)tst_ctx++);
+	printk("Response: %d\n", service_status);
+	printk("Sending GDPWR DISABLE request for: GDPWR_POWER_DOMAIN_ACTIVE_FAST\n");
+	service_status = nrfs_gdpwr_power_request(GDPWR_POWER_DOMAIN_ACTIVE_FAST,
+						  GDPWR_POWER_REQUEST_CLEAR, (void *)tst_ctx++);
+	printk("Response: %d\n", service_status);
+	printk("Sending GDPWR DISABLE request for: GDPWR_POWER_DOMAIN_MAIN_SLOW\n");
+	service_status = nrfs_gdpwr_power_request(GDPWR_POWER_DOMAIN_MAIN_SLOW,
+						  GDPWR_POWER_REQUEST_CLEAR, (void *)tst_ctx);
+	printk("Response: %d\n", service_status);
+}
+
 int main(void)
 {
 	int ret;
@@ -33,6 +83,9 @@ int main(void)
 	int32_t pulse_step;
 	uint32_t current_pulse_width;
 
+	nrfs_backend_wait_for_connection(K_FOREVER);
+	clear_global_power_domains_requests();
+
 	if (!pwm_is_ready_dt(&pwm_led)) {
 		LOG_ERR("Device %s is not ready.", pwm_led.dev->name);
 		return -ENODEV;