refactor(test): merge S-EL0 test with ffa_secure_partitions

Merge S-EL0 tests with ffa_secure_partitions test infrastructure. Remove
old S-EL0 test infrastructure, since it is mostly a repeat of what is in
the ffa_secure_partitions test infrastructure.

Signed-off-by: Raghu Krishnamurthy <raghu.ncstate@gmail.com>
Change-Id: I17179a1cbfa07c900bd07fec22c13264550f4116
diff --git a/test/hftest/service_common.c b/test/hftest/service_common.c
index bd7840d..25df466 100644
--- a/test/hftest/service_common.c
+++ b/test/hftest/service_common.c
@@ -9,14 +9,28 @@
 #include <stdalign.h>
 #include <stdint.h>
 
+#include "hf/fdt_handler.h"
+#include "hf/ffa.h"
+#include "hf/memiter.h"
 #include "hf/mm.h"
 #include "hf/std.h"
 
+#include "vmapi/hf/call.h"
+
 #include "test/hftest.h"
 #include "test/hftest_impl.h"
 
 HFTEST_ENABLE();
 
+extern struct hftest_test hftest_begin[];
+extern struct hftest_test hftest_end[];
+
+static alignas(HF_MAILBOX_SIZE) uint8_t send[HF_MAILBOX_SIZE];
+static alignas(HF_MAILBOX_SIZE) uint8_t recv[HF_MAILBOX_SIZE];
+
+static hf_ipaddr_t send_addr = (hf_ipaddr_t)send;
+static hf_ipaddr_t recv_addr = (hf_ipaddr_t)recv;
+
 static struct hftest_context global_context;
 
 struct hftest_context *hftest_get_context(void)
@@ -34,3 +48,85 @@
 	for (;;) {
 	}
 }
+
+/** Find the service with the name passed in the arguments. */
+static hftest_test_fn find_service(struct memiter *args)
+{
+	struct memiter service_name;
+	struct hftest_test *test;
+
+	if (!memiter_parse_str(args, &service_name)) {
+		return NULL;
+	}
+
+	for (test = hftest_begin; test < hftest_end; ++test) {
+		if (test->kind == HFTEST_KIND_SERVICE &&
+		    memiter_iseq(&service_name, test->name)) {
+			return test->fn;
+		}
+	}
+
+	return NULL;
+}
+
+noreturn void hftest_service_main(const void *fdt_ptr)
+{
+	struct memiter args;
+	hftest_test_fn service;
+	struct hftest_context *ctx;
+	struct ffa_value ret;
+	struct fdt fdt;
+
+	/* Prepare the context. */
+
+	/* Set up the mailbox. */
+	ffa_rxtx_map(send_addr, recv_addr);
+
+	/* Receive the name of the service to run. */
+	ret = ffa_msg_wait();
+	ASSERT_EQ(ret.func, FFA_MSG_SEND_32);
+	memiter_init(&args, recv, ffa_msg_send_size(ret));
+	service = find_service(&args);
+	EXPECT_EQ(ffa_rx_release().func, FFA_SUCCESS_32);
+
+	/* Check the service was found. */
+	if (service == NULL) {
+		HFTEST_LOG_FAILURE();
+		HFTEST_LOG(HFTEST_LOG_INDENT
+			   "Unable to find requested service");
+		abort();
+	}
+
+	if (!fdt_struct_from_ptr(fdt_ptr, &fdt)) {
+		HFTEST_LOG(HFTEST_LOG_INDENT "Unable to access the FDT");
+		abort();
+	}
+
+	/* Clean the context. */
+	ctx = hftest_get_context();
+	memset_s(ctx, sizeof(*ctx), 0, sizeof(*ctx));
+	ctx->abort = abort;
+	ctx->send = send;
+	ctx->recv = recv;
+	if (!fdt_get_memory_size(&fdt, &ctx->memory_size)) {
+		HFTEST_LOG_FAILURE();
+		HFTEST_LOG(HFTEST_LOG_INDENT
+			   "No entry in the FDT on memory size details");
+		abort();
+	}
+
+	/* Pause so the next time cycles are given the service will be run. */
+	ffa_yield();
+
+	/* Let the service run. */
+	service();
+
+	/* Cleanly handle it if the service returns. */
+	if (ctx->failures) {
+		abort();
+	}
+
+	for (;;) {
+		/* Hang if the service returns. */
+	}
+}