1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
|
// SPDX-License-Identifier: BSD-3-Clause
/*
* Copyright (c) 2015-2019, Arm Limited and Contributors. All rights reserved.
* Copyright (c) 2019-2022, Linaro Limited
*/
#include <assert.h>
#include <string.h>
#include <drivers/scmi-msg.h>
#include <drivers/scmi.h>
#include <lib/utils.h>
#include <lib/utils_def.h>
#include "common.h"
static bool message_id_is_supported(unsigned int message_id);
static void report_version(struct scmi_msg *msg)
{
struct scmi_protocol_version_p2a return_values = {
.status = SCMI_SUCCESS,
.version = SCMI_PROTOCOL_VERSION_BASE,
};
if (msg->in_size != 0U) {
scmi_status_response(msg, SCMI_PROTOCOL_ERROR);
return;
}
scmi_write_response(msg, &return_values, sizeof(return_values));
}
static void report_attributes(struct scmi_msg *msg)
{
size_t protocol_count = plat_scmi_protocol_count();
struct scmi_protocol_attributes_p2a return_values = {
.status = SCMI_SUCCESS,
/* Null agent count since agent discovery is not supported */
.attributes = SCMI_BASE_PROTOCOL_ATTRIBUTES(protocol_count, 0U),
};
if (msg->in_size != 0U) {
scmi_status_response(msg, SCMI_PROTOCOL_ERROR);
return;
}
scmi_write_response(msg, &return_values, sizeof(return_values));
}
static void report_message_attributes(struct scmi_msg *msg)
{
struct scmi_protocol_message_attributes_a2p *in_args = (void *)msg->in;
struct scmi_protocol_message_attributes_p2a return_values = {
.status = SCMI_SUCCESS,
/* For this protocol, attributes shall be zero */
.attributes = 0U,
};
if (msg->in_size != sizeof(*in_args)) {
scmi_status_response(msg, SCMI_PROTOCOL_ERROR);
return;
}
if (!message_id_is_supported(in_args->message_id)) {
scmi_status_response(msg, SCMI_NOT_FOUND);
return;
}
scmi_write_response(msg, &return_values, sizeof(return_values));
}
static void discover_vendor(struct scmi_msg *msg)
{
const char *name = plat_scmi_vendor_name();
struct scmi_base_discover_vendor_p2a return_values = {
.status = SCMI_SUCCESS,
};
if (msg->in_size != 0U) {
scmi_status_response(msg, SCMI_PROTOCOL_ERROR);
return;
}
COPY_NAME_IDENTIFIER(return_values.vendor_identifier, name);
scmi_write_response(msg, &return_values, sizeof(return_values));
}
static void discover_sub_vendor(struct scmi_msg *msg)
{
const char *name = plat_scmi_sub_vendor_name();
struct scmi_base_discover_sub_vendor_p2a return_values = {
.status = SCMI_SUCCESS,
};
if (msg->in_size != 0U) {
scmi_status_response(msg, SCMI_PROTOCOL_ERROR);
return;
}
COPY_NAME_IDENTIFIER(return_values.sub_vendor_identifier, name);
scmi_write_response(msg, &return_values, sizeof(return_values));
}
static void discover_implementation_version(struct scmi_msg *msg)
{
struct scmi_protocol_version_p2a return_values = {
.status = SCMI_SUCCESS,
.version = SCMI_IMPL_VERSION,
};
if (msg->in_size != 0U) {
scmi_status_response(msg, SCMI_PROTOCOL_ERROR);
return;
}
scmi_write_response(msg, &return_values, sizeof(return_values));
}
static unsigned int count_protocols_in_list(const uint8_t *protocol_list)
{
unsigned int count = 0U;
if (protocol_list != NULL) {
while (protocol_list[count] != 0U) {
count++;
}
}
return count;
}
static void discover_list_protocols(struct scmi_msg *msg)
{
const struct scmi_base_discover_list_protocols_a2p *a2p = NULL;
struct scmi_base_discover_list_protocols_p2a p2a = {
.status = SCMI_SUCCESS,
};
const uint8_t *list = NULL;
unsigned int count = 0U;
if (msg->in_size != sizeof(*a2p)) {
scmi_status_response(msg, SCMI_PROTOCOL_ERROR);
return;
}
a2p = (void *)msg->in;
list = plat_scmi_protocol_list(msg->agent_id);
count = count_protocols_in_list(list);
if (count > a2p->skip) {
count = MIN((uint32_t)(count - a2p->skip),
(uint32_t)(msg->out_size - sizeof(p2a)));
} else {
count = 0U;
}
p2a.num_protocols = count;
memcpy(msg->out, &p2a, sizeof(p2a));
memcpy(msg->out + sizeof(p2a), list + a2p->skip, count);
msg->out_size_out = sizeof(p2a) + round_up(count, sizeof(uint32_t));
}
static const scmi_msg_handler_t scmi_base_handler_table[] = {
[SCMI_PROTOCOL_VERSION] = report_version,
[SCMI_PROTOCOL_ATTRIBUTES] = report_attributes,
[SCMI_PROTOCOL_MESSAGE_ATTRIBUTES] = report_message_attributes,
[SCMI_BASE_DISCOVER_VENDOR] = discover_vendor,
[SCMI_BASE_DISCOVER_SUB_VENDOR] = discover_sub_vendor,
[SCMI_BASE_DISCOVER_IMPLEMENTATION_VERSION] =
discover_implementation_version,
[SCMI_BASE_DISCOVER_LIST_PROTOCOLS] = discover_list_protocols,
};
static bool message_id_is_supported(unsigned int message_id)
{
return (message_id < ARRAY_SIZE(scmi_base_handler_table)) &&
(scmi_base_handler_table[message_id] != NULL);
}
scmi_msg_handler_t scmi_msg_get_base_handler(struct scmi_msg *msg)
{
unsigned int message_id = SPECULATION_SAFE_VALUE(msg->message_id);
if (message_id >= ARRAY_SIZE(scmi_base_handler_table)) {
VERBOSE("Base handle not found %u\n", msg->message_id);
return NULL;
}
return scmi_base_handler_table[message_id];
}
|
