Firmware/opensbi
8
0
Fork 0
forked from Mirrors/opensbi
Code Pull Requests Activity

lib: utils: Add MPXY RPMI mailbox driver for System MSI service group

Browse Source 
The supervisor software can directly receive most of the system MSIs
except P2A doorbell and MSIs preferred to be handled in M-mode.

Add MPXY RPMI mailbox client driver for the System MSI service group.

Signed-off-by: Anup Patel <apatel@ventanamicro.com>
This commit is contained in:
Anup Patel
2025-01-12 18:39:52 +05:30
committed by Anup Patel
parent b05e2a1956
commit 61abd975f2
5 changed files with 300 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
lib/utils/mpxy/Kconfig
View File

@@ -18,6 +18,10 @@ config FDT_MPXY_RPMI_CLOCK
bool "MPXY driver for RPMI clock service group"
default n
config FDT_MPXY_RPMI_SYSMSI
bool "MPXY driver for RPMI system MSI service group"
default n
endif
endmenu

204
lib/utils/mpxy/fdt_mpxy_rpmi_sysmsi.c Normal file
View File

@@ -0,0 +1,204 @@
/*
* 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] = -1U;
((u32 *)xfer->rx)[3] = 0;
((u32 *)xfer->rx)[4] = 0;
args->rx_data_len = 5 * 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)) {
((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;
int rc, i;
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 (garesp.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,
.experimental = true,
};

3
lib/utils/mpxy/objects.mk
View File

@@ -14,3 +14,6 @@ libsbiutils-objs-$(CONFIG_FDT_MPXY_RPMI_MBOX) += mpxy/fdt_mpxy_rpmi_mbox.o
carray-fdt_mpxy_drivers-$(CONFIG_FDT_MPXY_RPMI_CLOCK) += fdt_mpxy_rpmi_clock
libsbiutils-objs-$(CONFIG_FDT_MPXY_RPMI_CLOCK) += mpxy/fdt_mpxy_rpmi_clock.o
carray-fdt_mpxy_drivers-$(CONFIG_FDT_MPXY_RPMI_SYSMSI) += fdt_mpxy_rpmi_sysmsi
libsbiutils-objs-$(CONFIG_FDT_MPXY_RPMI_SYSMSI) += mpxy/fdt_mpxy_rpmi_sysmsi.o