Cactus: helper commands needed for interrupt testing

Following commands added
  1. CACTUS_SLEEP_CMD: request to run cactus in a busy loop for
     given time. Returns time lapsed in this routine.
  2. CACTUS_INTERRUPT_CMD: request to enable/disable given interrupt
     ID, returns success on completion.

Change-Id: I9c7903f1e483d3ea0dc91db5f07135995da77862
Signed-off-by: Manish Pandey <manish.pandey2@arm.com>
Signed-off-by: Olivier Deprez <olivier.deprez@arm.com>

1 files changed, 51 insertions, 0 deletions

diff --git a/spm/cactus/cactus_tests/cactus_test_interrupts.c b/spm/cactus/cactus_tests/cactus_test_interrupts.c
new file mode 100644
index 0000000..b675dfc
--- /dev/null
+++ b/spm/cactus/cactus_tests/cactus_test_interrupts.c
@@ -0,0 +1,51 @@
+/*
+ * Copyright (c) 2021, Arm Limited. All rights reserved.
+ *
+ * SPDX-License-Identifier: BSD-3-Clause
+ */
+
+#include <common/debug.h>
+#include <sp_helpers.h>
+#include <spm_helpers.h>
+
+#include "cactus_message_loop.h"
+#include "cactus_test_cmds.h"
+
+CACTUS_CMD_HANDLER(sleep_cmd, CACTUS_SLEEP_CMD)
+{
+	uint64_t timer_freq = read_cntfrq_el0();
+	uint64_t time1, time2, time_lapsed;
+	uint32_t sleep_time = cactus_get_sleep_time(*args);
+
+	VERBOSE("Request to sleep %x for %ums.\n", ffa_dir_msg_dest(*args), sleep_time);
+
+	time1 = read_cntvct_el0();
+	sp_sleep(sleep_time);
+	time2 = read_cntvct_el0();
+
+	/* Lapsed time should be at least equal to sleep time */
+	time_lapsed = ((time2 - time1) * 1000) / timer_freq;
+
+	return cactus_response(ffa_dir_msg_dest(*args),
+			       ffa_dir_msg_source(*args),
+			       time_lapsed);
+}
+
+CACTUS_CMD_HANDLER(interrupt_cmd, CACTUS_INTERRUPT_CMD)
+{
+	uint32_t int_id = cactus_get_interrupt_id(*args);
+	bool enable = cactus_get_interrupt_enable(*args);
+	enum interrupt_pin pin = cactus_get_interrupt_pin(*args);
+	int64_t ret;
+
+	ret = spm_interrupt_enable(int_id, enable, pin);
+	if (ret != 0) {
+		return cactus_error_resp(ffa_dir_msg_dest(*args),
+					 ffa_dir_msg_source(*args),
+					 CACTUS_ERROR_TEST);
+	}
+
+	return cactus_response(ffa_dir_msg_dest(*args),
+			       ffa_dir_msg_source(*args),
+			       CACTUS_SUCCESS);
+}