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
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
|
/*
* SPDX-License-Identifier: BSD-2-Clause
*
* Copyright (c) 2025 Ventana Micro Systems Inc.
*/
#include <sbi/sbi_bitmap.h>
#include <sbi/sbi_domain.h>
#include <sbi/sbi_byteorder.h>
#include <sbi/sbi_heap.h>
#include <sbi_utils/mailbox/rpmi_mailbox.h>
#include <sbi_utils/mpxy/fdt_mpxy_rpmi_mbox.h>
struct mpxy_rpmi_sysmsi {
u32 sys_num_msi;
unsigned long *sys_msi_denied_bmap;
};
static int mpxy_rpmi_sysmis_xfer(void *context, struct mbox_chan *chan,
struct mbox_xfer *xfer)
{
struct rpmi_message_args *args = xfer->args;
struct mpxy_rpmi_sysmsi *smg = context;
u64 sys_msi_address;
u32 sys_msi_index;
int rc = 0;
if (!xfer->rx || args->type != RPMI_MSG_NORMAL_REQUEST)
return 0;
switch (args->service_id) {
case RPMI_SYSMSI_SRV_GET_ATTRIBUTES:
((u32 *)xfer->rx)[0] = cpu_to_le32(RPMI_SUCCESS);
((u32 *)xfer->rx)[1] = cpu_to_le32(smg->sys_num_msi);
((u32 *)xfer->rx)[2] = 0;
((u32 *)xfer->rx)[3] = 0;
args->rx_data_len = 4 * sizeof(u32);
break;
case RPMI_SYSMSI_SRV_GET_MSI_ATTRIBUTES:
case RPMI_SYSMSI_SRV_SET_MSI_STATE:
case RPMI_SYSMSI_SRV_GET_MSI_STATE:
case RPMI_SYSMSI_SRV_SET_MSI_TARGET:
case RPMI_SYSMSI_SRV_GET_MSI_TARGET:
sys_msi_index = le32_to_cpu(((u32 *)xfer->tx)[0]);
if (smg->sys_num_msi <= sys_msi_index) {
((u32 *)xfer->rx)[0] = cpu_to_le32(RPMI_ERR_INVALID_PARAM);
args->rx_data_len = sizeof(u32);
break;
}
if (bitmap_test(smg->sys_msi_denied_bmap, sys_msi_index)) {
((u32 *)xfer->rx)[0] = cpu_to_le32(RPMI_ERR_DENIED);
args->rx_data_len = sizeof(u32);
break;
}
if (args->service_id == RPMI_SYSMSI_SRV_SET_MSI_TARGET) {
sys_msi_address = le32_to_cpu(((u32 *)xfer->tx)[1]);
sys_msi_address |= ((u64)le32_to_cpu(((u32 *)xfer->tx)[2])) << 32;
if (!sbi_domain_check_addr_range(sbi_domain_thishart_ptr(),
sys_msi_address, 0x4, PRV_S,
SBI_DOMAIN_READ | SBI_DOMAIN_WRITE |
SBI_DOMAIN_MMIO)) {
((u32 *)xfer->rx)[0] = cpu_to_le32(RPMI_ERR_INVALID_ADDR);
args->rx_data_len = sizeof(u32);
break;
}
}
rc = mbox_chan_xfer(chan, xfer);
break;
default:
((u32 *)xfer->rx)[0] = cpu_to_le32(RPMI_ERR_NOTSUPP);
args->rx_data_len = sizeof(u32);
break;
};
return rc;
}
static void mpxy_rpmi_sysmsi_cleanup(void *context)
{
struct mpxy_rpmi_sysmsi *smg = context;
sbi_free(smg->sys_msi_denied_bmap);
sbi_free(smg);
}
static int mpxy_rpmi_sysmsi_setup(void **context, struct mbox_chan *chan,
const struct mpxy_rpmi_mbox_data *data)
{
struct rpmi_sysmsi_get_msi_attributes_resp gmaresp;
struct rpmi_sysmsi_get_msi_attributes_req gmareq;
struct rpmi_sysmsi_get_attributes_resp garesp;
struct mpxy_rpmi_sysmsi *smg;
u32 p2a_db_index;
int rc, i;
rc = mbox_chan_get_attribute(chan, RPMI_CHANNEL_ATTR_P2A_DOORBELL_SYSMSI_INDEX,
&p2a_db_index);
if (rc)
return rc;
rc = rpmi_normal_request_with_status(chan, RPMI_SYSMSI_SRV_GET_ATTRIBUTES,
NULL, 0, 0, &garesp, rpmi_u32_count(garesp),
rpmi_u32_count(garesp));
if (rc)
return rc;
smg = sbi_zalloc(sizeof(*smg));
if (!smg)
return SBI_ENOMEM;
smg->sys_num_msi = garesp.sys_num_msi;
smg->sys_msi_denied_bmap = sbi_zalloc(bitmap_estimate_size(smg->sys_num_msi));
if (!smg->sys_msi_denied_bmap) {
sbi_free(smg);
return SBI_ENOMEM;
}
for (i = 0; i < smg->sys_num_msi; i++) {
gmareq.sys_msi_index = i;
rc = rpmi_normal_request_with_status(chan,
RPMI_SYSMSI_SRV_GET_MSI_ATTRIBUTES,
&gmareq, rpmi_u32_count(gmareq),
rpmi_u32_count(gmareq),
&gmaresp, rpmi_u32_count(gmaresp),
rpmi_u32_count(gmaresp));
if (rc) {
mpxy_rpmi_sysmsi_cleanup(smg);
return rc;
}
if (p2a_db_index == i ||
(gmaresp.flag0 & RPMI_SYSMSI_MSI_ATTRIBUTES_FLAG0_PREF_PRIV))
bitmap_set(smg->sys_msi_denied_bmap, i, 1);
}
*context = smg;
return 0;
}
static struct mpxy_rpmi_service_data sysmsi_services[] = {
{
.id = RPMI_SYSMSI_SRV_ENABLE_NOTIFICATION,
.min_tx_len = sizeof(struct rpmi_enable_notification_req),
.max_tx_len = sizeof(struct rpmi_enable_notification_req),
.min_rx_len = sizeof(struct rpmi_enable_notification_resp),
.max_rx_len = sizeof(struct rpmi_enable_notification_resp),
},
{
.id = RPMI_SYSMSI_SRV_GET_ATTRIBUTES,
.min_tx_len = 0,
.max_tx_len = 0,
.min_rx_len = sizeof(struct rpmi_sysmsi_get_attributes_resp),
.max_rx_len = sizeof(struct rpmi_sysmsi_get_attributes_resp),
},
{
.id = RPMI_SYSMSI_SRV_GET_MSI_ATTRIBUTES,
.min_tx_len = sizeof(struct rpmi_sysmsi_get_msi_attributes_req),
.max_tx_len = sizeof(struct rpmi_sysmsi_get_msi_attributes_req),
.min_rx_len = sizeof(struct rpmi_sysmsi_get_msi_attributes_resp),
.max_rx_len = sizeof(struct rpmi_sysmsi_get_msi_attributes_resp),
},
{
.id = RPMI_SYSMSI_SRV_SET_MSI_STATE,
.min_tx_len = sizeof(struct rpmi_sysmsi_set_msi_state_req),
.max_tx_len = sizeof(struct rpmi_sysmsi_set_msi_state_req),
.min_rx_len = sizeof(struct rpmi_sysmsi_set_msi_state_resp),
.max_rx_len = sizeof(struct rpmi_sysmsi_set_msi_state_resp),
},
{
.id = RPMI_SYSMSI_SRV_GET_MSI_STATE,
.min_tx_len = sizeof(struct rpmi_sysmsi_get_msi_state_req),
.max_tx_len = sizeof(struct rpmi_sysmsi_get_msi_state_req),
.min_rx_len = sizeof(struct rpmi_sysmsi_get_msi_state_resp),
.max_rx_len = sizeof(struct rpmi_sysmsi_get_msi_state_resp),
},
{
.id = RPMI_SYSMSI_SRV_SET_MSI_TARGET,
.min_tx_len = sizeof(struct rpmi_sysmsi_set_msi_target_req),
.max_tx_len = sizeof(struct rpmi_sysmsi_set_msi_target_req),
.min_rx_len = sizeof(struct rpmi_sysmsi_set_msi_target_resp),
.max_rx_len = sizeof(struct rpmi_sysmsi_set_msi_target_resp),
},
{
.id = RPMI_SYSMSI_SRV_GET_MSI_TARGET,
.min_tx_len = sizeof(struct rpmi_sysmsi_get_msi_target_req),
.max_tx_len = sizeof(struct rpmi_sysmsi_get_msi_target_req),
.min_rx_len = sizeof(struct rpmi_sysmsi_get_msi_target_resp),
.max_rx_len = sizeof(struct rpmi_sysmsi_get_msi_target_resp),
},
};
static const struct mpxy_rpmi_mbox_data sysmsi_data = {
.servicegrp_id = RPMI_SRVGRP_SYSTEM_MSI,
.num_services = RPMI_SYSMSI_SRV_ID_MAX_COUNT,
.service_data = sysmsi_services,
.xfer_group = mpxy_rpmi_sysmis_xfer,
.setup_group = mpxy_rpmi_sysmsi_setup,
.cleanup_group = mpxy_rpmi_sysmsi_cleanup,
};
static const struct fdt_match sysmsi_match[] = {
{ .compatible = "riscv,rpmi-mpxy-system-msi", .data = &sysmsi_data },
{ },
};
const struct fdt_driver fdt_mpxy_rpmi_sysmsi = {
.match_table = sysmsi_match,
.init = mpxy_rpmi_mbox_init,
};
|
