opensbi/lib/utils/mpxy/fdt_mpxy_rpmi_sysmsi.c

/*
 * 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)) {
				((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,
};