libsp: Add high level SP discovery function.
The patch adds functions for accessing the caller's and other
partitions' 16 bit FF-A ID and for discovering other partitions of the
system.
Signed-off-by: Imre Kis <imre.kis@arm.com>
Change-Id: I761e7771653bec22afc2d121afbf3798041688d2
diff --git a/components/messaging/ffa/libsp/sp_discovery.c b/components/messaging/ffa/libsp/sp_discovery.c
new file mode 100644
index 0000000..a801167
--- /dev/null
+++ b/components/messaging/ffa/libsp/sp_discovery.c
@@ -0,0 +1,188 @@
+// SPDX-License-Identifier: BSD-3-Clause
+/*
+ * Copyright (c) 2020, Arm Limited and Contributors. All rights reserved.
+ */
+
+#include "sp_discovery.h"
+#include "ffa_api.h"
+#include "sp_rxtx.h"
+#include "util.h"
+#include <string.h>
+
+static const struct sp_uuid uuid_nil = {0};
+
+sp_result sp_discovery_ffa_version_get(uint16_t *major, uint16_t *minor)
+{
+ uint32_t version = 0;
+ ffa_result ffa_res = FFA_OK;
+
+ ffa_res = ffa_version(&version);
+ if (ffa_res != FFA_OK) {
+ *major = UINT16_C(0);
+ *minor = UINT16_C(0);
+
+ return SP_RESULT_FFA(ffa_res);
+ }
+
+ *major = (version >> FFA_VERSION_MAJOR_SHIFT) & FFA_VERSION_MAJOR_MASK;
+ *minor = (version >> FFA_VERSION_MINOR_SHIFT) & FFA_VERSION_MINOR_MASK;
+
+ return SP_RESULT_OK;
+}
+
+sp_result sp_discovery_own_id_get(uint16_t *id)
+{
+ ffa_result ffa_res = FFA_OK;
+
+ ffa_res = ffa_id_get(id);
+ return SP_RESULT_FFA(ffa_res);
+}
+
+static sp_result
+partition_info_get(const struct sp_uuid *uuid,
+ const struct ffa_partition_information **info,
+ uint32_t *count)
+{
+ const void *buffer = NULL;
+ size_t buffer_size = 0;
+ struct ffa_uuid ffa_uuid = {0};
+ sp_result sp_res = SP_RESULT_OK;
+ ffa_result ffa_res = FFA_OK;
+
+ sp_res = sp_rxtx_buffer_rx_get(&buffer, &buffer_size);
+ if (sp_res != SP_RESULT_OK) {
+ *count = UINT32_C(0);
+ return sp_res;
+ }
+
+ /* Safely convert to FF-A UUID format */
+ memcpy(&ffa_uuid.uuid, uuid->uuid, sizeof(ffa_uuid.uuid));
+
+ ffa_res = ffa_partition_info_get(&ffa_uuid, count);
+ if (ffa_res != FFA_OK) {
+ *count = UINT32_C(0);
+ return SP_RESULT_FFA(ffa_res);
+ }
+
+ if (*count * sizeof(struct ffa_partition_information) < buffer_size) {
+ /*
+ * The indicated amount of info structures doesn't fit into the
+ * RX buffer.
+ */
+ *count = UINT32_C(0);
+ return SP_RESULT_INTERNAL_ERROR;
+ }
+
+ *info = (const struct ffa_partition_information *)buffer;
+
+ return SP_RESULT_OK;
+}
+
+static void unpack_ffa_info(const struct ffa_partition_information ffa_info[],
+ struct sp_partition_info *sp_info)
+{
+ uint32_t props = ffa_info->partition_properties;
+
+ sp_info->partition_id = ffa_info->partition_id;
+ sp_info->execution_context_count = ffa_info->execution_context_count;
+ sp_info->supports_direct_requests =
+ props & FFA_PARTITION_SUPPORTS_DIRECT_REQUESTS;
+ sp_info->can_send_direct_requests =
+ props & FFA_PARTITION_CAN_SEND_DIRECT_REQUESTS;
+ sp_info->supports_indirect_requests =
+ props & FFA_PARTITION_SUPPORTS_INDIRECT_REQUESTS;
+}
+
+sp_result sp_discovery_partition_id_get(const struct sp_uuid *uuid,
+ uint16_t *id)
+{
+ const struct ffa_partition_information *ffa_info = NULL;
+ uint32_t count = 0;
+ sp_result sp_res = SP_RESULT_OK;
+
+ if (uuid == NULL || id == NULL)
+ return SP_RESULT_INVALID_PARAMETERS;
+
+ /*
+ * Nil UUID means querying all partitions which is handled by a separate
+ * function.
+ */
+ if (memcmp(&uuid_nil, uuid, sizeof(struct sp_uuid)) == 0) {
+ *id = FFA_ID_GET_ID_MASK;
+ return SP_RESULT_INVALID_PARAMETERS;
+ }
+
+ sp_res = partition_info_get(uuid, &ffa_info, &count);
+ if (sp_res != SP_RESULT_OK) {
+ *id = FFA_ID_GET_ID_MASK;
+ return sp_res;
+ }
+
+ if (count == 0) {
+ *id = FFA_ID_GET_ID_MASK;
+ return SP_RESULT_NOT_FOUND;
+ }
+
+ *id = ffa_info->partition_id;
+
+ return SP_RESULT_OK;
+}
+
+sp_result sp_discovery_partition_info_get(const struct sp_uuid *uuid,
+ struct sp_partition_info *info)
+{
+ const struct ffa_partition_information *ffa_info = NULL;
+ uint32_t count = 0;
+ sp_result sp_res = SP_RESULT_OK;
+
+ if (uuid == NULL || info == NULL)
+ return SP_RESULT_INVALID_PARAMETERS;
+
+ /*
+ * Nil UUID means querying all partitions which is handled by a separate
+ * function.
+ */
+ if (memcmp(&uuid_nil, uuid, sizeof(struct sp_uuid)) == 0) {
+ *info = (struct sp_partition_info){0};
+ return SP_RESULT_INVALID_PARAMETERS;
+ }
+
+ sp_res = partition_info_get(uuid, &ffa_info, &count);
+ if (sp_res != SP_RESULT_OK) {
+ *info = (struct sp_partition_info){0};
+ return sp_res;
+ }
+
+ if (count == 0) {
+ *info = (struct sp_partition_info){0};
+ return SP_RESULT_NOT_FOUND;
+ }
+
+ unpack_ffa_info(ffa_info, info);
+
+ return SP_RESULT_OK;
+}
+
+sp_result sp_discovery_partition_info_get_all(struct sp_partition_info info[],
+ uint32_t *count)
+{
+ const struct ffa_partition_information *ffa_info = NULL;
+ uint32_t ffa_count = 0;
+ uint32_t i = 0;
+ sp_result sp_res = SP_RESULT_OK;
+
+ if (info == NULL || count == NULL)
+ return SP_RESULT_INVALID_PARAMETERS;
+
+ sp_res = partition_info_get(&uuid_nil, &ffa_info, &ffa_count);
+ if (sp_res != SP_RESULT_OK) {
+ *count = UINT32_C(0);
+ return sp_res;
+ }
+
+ *count = MIN(*count, ffa_count);
+ for (i = 0; i < *count; i++)
+ unpack_ffa_info(&ffa_info[i], &info[i]);
+
+ return SP_RESULT_OK;
+}