1 // SPDX-License-Identifier: BSD-3-Clause
2 /*
3 * Copyright (c) 2015-2019, Arm Limited and Contributors. All rights reserved.
4 * Copyright (c) 2019-2022, Linaro Limited
5 */
6 #include <assert.h>
7 #include <drivers/scmi-msg.h>
8 #include <drivers/scmi.h>
9 #include <kernel/misc.h>
10 #include <kernel/spinlock.h>
11 #include <kernel/thread.h>
12 #include <string.h>
13 #include <trace.h>
14
15 #include "base.h"
16 #include "clock.h"
17 #include "common.h"
18 #include "perf_domain.h"
19 #include "reset_domain.h"
20 #include "voltage_domain.h"
21
22 /* Provision input message payload buffers for each supported entry channel */
23 #define SCMI_PAYLOAD_U32_MAX (SCMI_SEC_PAYLOAD_SIZE / sizeof(uint32_t))
24
25 static uint32_t threaded_payload[CFG_NUM_THREADS][SCMI_PAYLOAD_U32_MAX]
26 __maybe_unused;
27
28 static uint32_t interrupt_payload[CFG_TEE_CORE_NB_CORE][SCMI_PAYLOAD_U32_MAX]
29 __maybe_unused;
30
31 static uint32_t fastcall_payload[CFG_TEE_CORE_NB_CORE][SCMI_PAYLOAD_U32_MAX]
32 __maybe_unused;
33
34 /* SMP protection on channel->busy field */
35 static unsigned int smt_channels_lock;
36
37 /* If channel is not busy, set busy and return true, otherwise return false */
scmi_msg_claim_channel(struct scmi_msg_channel * channel)38 bool scmi_msg_claim_channel(struct scmi_msg_channel *channel)
39 {
40 uint32_t exceptions = cpu_spin_lock_xsave(&smt_channels_lock);
41 bool channel_is_busy = channel->busy;
42
43 if (!channel_is_busy)
44 channel->busy = true;
45
46 cpu_spin_unlock_xrestore(&smt_channels_lock, exceptions);
47
48 return !channel_is_busy;
49 }
50
scmi_msg_release_channel(struct scmi_msg_channel * channel)51 void scmi_msg_release_channel(struct scmi_msg_channel *channel)
52 {
53 channel->busy = false;
54 }
55
scmi_status_response(struct scmi_msg * msg,int32_t status)56 void scmi_status_response(struct scmi_msg *msg, int32_t status)
57 {
58 assert(msg->out && msg->out_size >= sizeof(int32_t));
59
60 memcpy(msg->out, &status, sizeof(int32_t));
61 msg->out_size_out = sizeof(int32_t);
62 }
63
scmi_write_response(struct scmi_msg * msg,void * payload,size_t size)64 void scmi_write_response(struct scmi_msg *msg, void *payload, size_t size)
65 {
66 if (msg->out_size < size) {
67 DMSG("SCMI resp. payload %zu > %zu bytes", size, msg->out_size);
68 scmi_status_response(msg, SCMI_PROTOCOL_ERROR);
69 } else {
70 memcpy(msg->out, payload, size);
71 msg->out_size_out = size;
72 }
73 }
74
scmi_process_message(struct scmi_msg * msg)75 void scmi_process_message(struct scmi_msg *msg)
76 {
77 scmi_msg_handler_t handler = NULL;
78
79 switch (msg->protocol_id) {
80 case SCMI_PROTOCOL_ID_BASE:
81 handler = scmi_msg_get_base_handler(msg);
82 break;
83 case SCMI_PROTOCOL_ID_CLOCK:
84 handler = scmi_msg_get_clock_handler(msg);
85 break;
86 case SCMI_PROTOCOL_ID_RESET_DOMAIN:
87 handler = scmi_msg_get_rd_handler(msg);
88 break;
89 case SCMI_PROTOCOL_ID_VOLTAGE_DOMAIN:
90 handler = scmi_msg_get_voltd_handler(msg);
91 break;
92 case SCMI_PROTOCOL_ID_PERF:
93 handler = scmi_msg_get_perf_handler(msg);
94 break;
95 default:
96 break;
97 }
98
99 if (handler) {
100 handler(msg);
101 return;
102 }
103
104 DMSG("Channel %u Protocol %#x Message %#x: not supported",
105 msg->channel_id, msg->protocol_id, msg->message_id);
106
107 scmi_status_response(msg, SCMI_NOT_SUPPORTED);
108 }
109
110 #ifdef CFG_SCMI_MSG_SMT_FASTCALL_ENTRY
scmi_smt_fastcall_smc_entry(unsigned int channel_id)111 void scmi_smt_fastcall_smc_entry(unsigned int channel_id)
112 {
113 assert(!plat_scmi_get_channel(channel_id)->threaded);
114
115 scmi_entry_smt(channel_id, fastcall_payload[get_core_pos()]);
116 }
117 #endif
118
119 #ifdef CFG_SCMI_MSG_SMT_INTERRUPT_ENTRY
scmi_smt_interrupt_entry(unsigned int channel_id)120 void scmi_smt_interrupt_entry(unsigned int channel_id)
121 {
122 assert(!plat_scmi_get_channel(channel_id)->threaded);
123
124 scmi_entry_smt(channel_id, interrupt_payload[get_core_pos()]);
125 }
126 #endif
127
128 #ifdef CFG_SCMI_MSG_SMT_THREAD_ENTRY
scmi_smt_threaded_entry(unsigned int channel_id)129 void scmi_smt_threaded_entry(unsigned int channel_id)
130 {
131 assert(plat_scmi_get_channel(channel_id)->threaded);
132
133 scmi_entry_smt(channel_id, threaded_payload[thread_get_id()]);
134 }
135 #endif
136
137 #ifdef CFG_SCMI_MSG_SHM_MSG
scmi_msg_threaded_entry(unsigned int channel_id,void * in_buf,size_t in_size,void * out_buf,size_t * out_size)138 TEE_Result scmi_msg_threaded_entry(unsigned int channel_id,
139 void *in_buf, size_t in_size,
140 void *out_buf, size_t *out_size)
141 {
142 assert(plat_scmi_get_channel(channel_id)->threaded);
143
144 return scmi_entry_msg(channel_id, in_buf, in_size, out_buf, out_size,
145 threaded_payload[thread_get_id()]);
146 }
147 #endif
148