1 /*
2  * Arm SCP/MCP Software
3  * Copyright (c) 2022, Arm Limited and Contributors. All rights reserved.
4  *
5  * SPDX-License-Identifier: BSD-3-Clause
6  */
7 
8 #include "tc2_scmi.h"
9 
10 #include <mod_scmi.h>
11 #include <mod_transport.h>
12 
13 #include <fwk_element.h>
14 #include <fwk_id.h>
15 #include <fwk_macros.h>
16 #include <fwk_module.h>
17 #include <fwk_module_idx.h>
18 
19 static const struct fwk_element service_table[
20     SCP_TC2_SCMI_SERVICE_IDX_COUNT + 1] = {
21     [SCP_TC2_SCMI_SERVICE_IDX_PSCI] = {
22         .name = "PSCI",
23         .data = &((struct mod_scmi_service_config) {
24             .transport_id = FWK_ID_ELEMENT_INIT(
25                 FWK_MODULE_IDX_TRANSPORT,
26                 SCP_TC2_SCMI_SERVICE_IDX_PSCI),
27             .transport_api_id = FWK_ID_API_INIT(
28                 FWK_MODULE_IDX_TRANSPORT,
29                 MOD_TRANSPORT_API_IDX_SCMI_TO_TRANSPORT),
30             .transport_notification_init_id = FWK_ID_NOTIFICATION_INIT(
31                 FWK_MODULE_IDX_TRANSPORT,
32                 MOD_TRANSPORT_NOTIFICATION_IDX_INITIALIZED),
33             .scmi_agent_id = SCP_SCMI_AGENT_ID_PSCI,
34             .scmi_p2a_id = FWK_ID_NONE_INIT,
35         }),
36     },
37     [SCP_TC2_SCMI_SERVICE_IDX_OSPM_0] = {
38         .name = "OSPM0",
39         .data = &((struct mod_scmi_service_config) {
40             .transport_id = FWK_ID_ELEMENT_INIT(
41                 FWK_MODULE_IDX_TRANSPORT,
42                 SCP_TC2_SCMI_SERVICE_IDX_OSPM_0),
43             .transport_api_id = FWK_ID_API_INIT(
44                 FWK_MODULE_IDX_TRANSPORT,
45                 MOD_TRANSPORT_API_IDX_SCMI_TO_TRANSPORT),
46             .transport_notification_init_id = FWK_ID_NOTIFICATION_INIT(
47                 FWK_MODULE_IDX_TRANSPORT,
48                 MOD_TRANSPORT_NOTIFICATION_IDX_INITIALIZED),
49             .scmi_agent_id = SCP_SCMI_AGENT_ID_OSPM,
50             .scmi_p2a_id = FWK_ID_NONE_INIT,
51         }),
52     },
53     [SCP_TC2_SCMI_SERVICE_IDX_OSPM_1] = {
54         .name = "OSPM1",
55         .data = &((struct mod_scmi_service_config) {
56             .transport_id = FWK_ID_ELEMENT_INIT(
57                 FWK_MODULE_IDX_TRANSPORT,
58                 SCP_TC2_SCMI_SERVICE_IDX_OSPM_1),
59             .transport_api_id = FWK_ID_API_INIT(
60                 FWK_MODULE_IDX_TRANSPORT,
61                 MOD_TRANSPORT_API_IDX_SCMI_TO_TRANSPORT),
62             .transport_notification_init_id = FWK_ID_NOTIFICATION_INIT(
63                 FWK_MODULE_IDX_TRANSPORT,
64                 MOD_TRANSPORT_NOTIFICATION_IDX_INITIALIZED),
65             .scmi_agent_id = SCP_SCMI_AGENT_ID_OSPM,
66             .scmi_p2a_id = FWK_ID_NONE_INIT,
67         }),
68     },
69     [SCP_TC2_SCMI_SERVICE_IDX_COUNT] = { 0 }
70 };
71 
get_service_table(fwk_id_t module_id)72 static const struct fwk_element *get_service_table(fwk_id_t module_id)
73 {
74     return service_table;
75 }
76 
77 #ifndef BUILD_HAS_MOD_RESOURCE_PERMS
78 
79 /* PSCI agent has no access to clock, perf and sensor protocol */
80 static const uint32_t dis_protocol_list_psci[3] = {
81     MOD_SCMI_PROTOCOL_ID_SENSOR,
82     MOD_SCMI_PROTOCOL_ID_CLOCK,
83     MOD_SCMI_PROTOCOL_ID_PERF,
84 };
85 #endif
86 
87 static struct mod_scmi_agent agent_table[SCP_SCMI_AGENT_ID_COUNT] = {
88     [SCP_SCMI_AGENT_ID_OSPM] = {
89         .type = SCMI_AGENT_TYPE_OSPM,
90         .name = "OSPM",
91     },
92     [SCP_SCMI_AGENT_ID_PSCI] = {
93         .type = SCMI_AGENT_TYPE_PSCI,
94         .name = "PSCI",
95     },
96 };
97 
98 const struct fwk_module_config config_scmi = {
99     .elements = FWK_MODULE_DYNAMIC_ELEMENTS(get_service_table),
100     .data = &((struct mod_scmi_config){
101         .protocol_count_max = 9,
102 #ifndef BUILD_HAS_MOD_RESOURCE_PERMS
103         .dis_protocol_count_psci = FWK_ARRAY_SIZE(dis_protocol_list_psci),
104         .dis_protocol_list_psci = dis_protocol_list_psci,
105 #endif
106         .agent_count = FWK_ARRAY_SIZE(agent_table) - 1,
107         .agent_table = agent_table,
108         .vendor_identifier = "arm",
109         .sub_vendor_identifier = "arm",
110     }),
111 };
112