Skip to content

Commit 125cea4

Browse files
saini-ranbirsvlsunil
authored and
avpatel
committed
lib: utils: Add MPXY client driver for RPMI MM service group
Co-authored-by: Sunil V L <sunilvl@ventanamicro.com> Signed-off-by: Ranbir Singh <rsingh@ventanamicro.com>
1 parent 41750db commit 125cea4

5 files changed

Lines changed: 161 additions & 0 deletions

File tree

‎include/sbi_utils/mailbox/rpmi_msgprot.h‎

Lines changed: 37 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -220,6 +220,7 @@ enum rpmi_servicegroup_id {
220220
RPMI_SRVGRP_CLOCK = 0x0008,
221221
RPMI_SRVGRP_DEVICE_POWER = 0x0009,
222222
RPMI_SRVGRP_PERFORMANCE = 0x0000A,
223+
RPMI_SRVGRP_MANAGEMENT_MODE = 0x000B,
223224
RPMI_SRVGRP_ID_MAX_COUNT,
224225

225226
/* Reserved range for service groups */
@@ -995,4 +996,40 @@ struct rpmi_ras_sync_err_resp {
995996
u32 pending_vecs[MAX_PEND_VECS];
996997
};
997998

999+
/** RPMI MM ServiceGroup Service IDs */
1000+
enum rpmi_mm_service_id {
1001+
RPMI_MM_SRV_ENABLE_NOTIFICATION = 0x01,
1002+
RPMI_MM_SRV_GET_ATTRIBUTES = 0x02,
1003+
RPMI_MM_SRV_COMMUNICATE = 0x03,
1004+
RPMI_MM_SRV_MAX_COUNT,
1005+
};
1006+
1007+
/** RPMI MM ServiceGroup Get Attributes main struct */
1008+
struct rpmi_mm_attributes {
1009+
u32 mm_version;
1010+
u32 shmem_addr_lo;
1011+
u32 shmem_addr_hi;
1012+
u32 shmem_size;
1013+
};
1014+
1015+
/** RPMI MM ServiceGroup Get Attributes response struct */
1016+
struct rpmi_mm_get_attributes_rsp {
1017+
s32 status;
1018+
struct rpmi_mm_attributes mma;
1019+
};
1020+
1021+
/** RPMI MM ServiceGroup Communicate request struct */
1022+
struct rpmi_mm_communicate_req {
1023+
u32 mm_comm_ipdata_off;
1024+
u32 mm_comm_ipdata_size;
1025+
u32 mm_comm_opdata_off;
1026+
u32 mm_comm_opdata_size;
1027+
};
1028+
1029+
/** RPMI MM ServiceGroup Communicate response struct */
1030+
struct rpmi_mm_communicate_rsp {
1031+
s32 status;
1032+
u32 mm_comm_retdata_size;
1033+
};
1034+
9981035
#endif /* !__RPMI_MSGPROT_H__ */

‎lib/utils/mpxy/Kconfig‎

Lines changed: 4 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -34,6 +34,10 @@ config FDT_MPXY_RPMI_PERFORMANCE
3434
bool "MPXY driver for RPMI performance service group"
3535
default n
3636

37+
config FDT_MPXY_RPMI_MM
38+
bool "MPXY driver for RPMI MM service group"
39+
default n
40+
3741
endif
3842

3943
endmenu

‎lib/utils/mpxy/fdt_mpxy_rpmi_mm.c‎

Lines changed: 116 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,116 @@
1+
/*
2+
* SPDX-License-Identifier: BSD-2-Clause
3+
*
4+
* Copyright (c) 2025 Ventana Micro Systems Inc.
5+
*
6+
* Authors:
7+
* Ranbir Singh <rsingh@ventanamicro.com>
8+
* Sunil V L <sunilvl@ventanamicro.com>
9+
*/
10+
11+
#include <sbi_utils/mpxy/fdt_mpxy_rpmi_mbox.h>
12+
#include <sbi_utils/mailbox/rpmi_mailbox.h>
13+
14+
static struct rpmi_mm_get_attributes_rsp rsp;
15+
16+
static struct mpxy_rpmi_service_data mm_srvcdata[] = {
17+
[0] {
18+
.id = RPMI_MM_SRV_GET_ATTRIBUTES,
19+
.min_tx_len = 0,
20+
.max_tx_len = 0,
21+
.min_rx_len = sizeof(struct rpmi_mm_get_attributes_rsp),
22+
.max_rx_len = sizeof(struct rpmi_mm_get_attributes_rsp),
23+
},
24+
[1] {
25+
.id = RPMI_MM_SRV_COMMUNICATE,
26+
.min_tx_len = sizeof(struct rpmi_mm_communicate_req),
27+
.max_tx_len = sizeof(struct rpmi_mm_communicate_req),
28+
.min_rx_len = sizeof(struct rpmi_mm_communicate_rsp),
29+
.max_rx_len = sizeof(struct rpmi_mm_communicate_rsp),
30+
},
31+
};
32+
33+
static int mpxy_rpmi_mm_setup(void **context, struct mbox_chan *chan,
34+
const struct mpxy_rpmi_mbox_data *data)
35+
{
36+
unsigned long mm_region_addr = 0;
37+
unsigned long mm_region_size = 0;
38+
unsigned long mm_region_flags;
39+
int rc = 0;
40+
41+
rc = rpmi_normal_request_with_status(chan, RPMI_MM_SRV_GET_ATTRIBUTES,
42+
NULL, 0, 0, &rsp,
43+
rpmi_u32_count(rsp),
44+
rpmi_u32_count(rsp));
45+
if (rc)
46+
return rc;
47+
48+
#if __riscv_xlen == 32
49+
mm_region_addr = rsp.mma.shmem_addr_lo;
50+
#else
51+
mm_region_addr = ((unsigned long)(rsp.mma.shmem_addr_hi) << 32) |
52+
rsp.mma.shmem_addr_lo;
53+
#endif
54+
55+
mm_region_size = rsp.mma.shmem_size;
56+
mm_region_flags = SBI_DOMAIN_MEMREGION_SHARED_SURW_MRW;
57+
58+
rc = sbi_domain_root_add_memrange(mm_region_addr, mm_region_size,
59+
PAGE_SIZE, mm_region_flags);
60+
return rc;
61+
}
62+
63+
static int mpxy_rpmi_mm_xfer(void *context, struct mbox_chan *chan,
64+
struct mbox_xfer *xfer)
65+
{
66+
struct rpmi_message_args *args = xfer->args;
67+
int rc = 0;
68+
69+
if (!xfer->rx || (args->type != RPMI_MSG_NORMAL_REQUEST))
70+
return 0;
71+
72+
switch (args->service_id) {
73+
case RPMI_MM_SRV_GET_ATTRIBUTES:
74+
((u32 *)xfer->rx)[0] = cpu_to_le32(RPMI_SUCCESS);
75+
((u32 *)xfer->rx)[1] = cpu_to_le32(rsp.mma.mm_version);
76+
((u32 *)xfer->rx)[2] = cpu_to_le32(rsp.mma.shmem_addr_lo);
77+
((u32 *)xfer->rx)[3] = cpu_to_le32(rsp.mma.shmem_addr_hi);
78+
((u32 *)xfer->rx)[4] = cpu_to_le32(rsp.mma.shmem_size);
79+
args->rx_data_len = 5 * sizeof(u32);
80+
break;
81+
82+
case RPMI_MM_SRV_COMMUNICATE:
83+
rc = mbox_chan_xfer(chan, xfer);
84+
break;
85+
86+
default:
87+
((u32 *)xfer->rx)[0] = cpu_to_le32(RPMI_ERR_NOTSUPP);
88+
args->rx_data_len = sizeof(u32);
89+
break;
90+
};
91+
92+
return rc;
93+
}
94+
95+
static const struct mpxy_rpmi_mbox_data mm_data = {
96+
.servicegrp_id = RPMI_SRVGRP_MANAGEMENT_MODE,
97+
.num_services = RPMI_MM_SRV_MAX_COUNT,
98+
.service_data = mm_srvcdata,
99+
.setup_group = mpxy_rpmi_mm_setup,
100+
.xfer_group = mpxy_rpmi_mm_xfer,
101+
};
102+
103+
/* one extra blank entry for loop termination while matching */
104+
static const struct fdt_match mm_match[] = {
105+
{
106+
.compatible = "riscv,rpmi-mpxy-mm",
107+
.data = &mm_data,
108+
},
109+
{},
110+
};
111+
112+
const struct fdt_driver fdt_mpxy_rpmi_mm = {
113+
.experimental = true,
114+
.match_table = mm_match,
115+
.init = mpxy_rpmi_mbox_init,
116+
};

‎lib/utils/mpxy/objects.mk‎

Lines changed: 3 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -26,3 +26,6 @@ libsbiutils-objs-$(CONFIG_FDT_MPXY_RPMI_VOLTAGE) += mpxy/fdt_mpxy_rpmi_voltage.o
2626

2727
carray-fdt_mpxy_drivers-$(CONFIG_FDT_MPXY_RPMI_DEVICE_POWER) += fdt_mpxy_rpmi_device_power
2828
libsbiutils-objs-$(CONFIG_FDT_MPXY_RPMI_DEVICE_POWER) += mpxy/fdt_mpxy_rpmi_device_power.o
29+
30+
carray-fdt_mpxy_drivers-$(CONFIG_FDT_MPXY_RPMI_MM) += fdt_mpxy_rpmi_mm
31+
libsbiutils-objs-$(CONFIG_FDT_MPXY_RPMI_MM) += mpxy/fdt_mpxy_rpmi_mm.o

‎platform/generic/configs/defconfig‎

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -68,3 +68,4 @@ CONFIG_FDT_MPXY_RPMI_VOLTAGE=y
6868
CONFIG_FDT_MPXY_RPMI_DEVICE_POWER=y
6969
CONFIG_FDT_MPXY_RPMI_PERFORMANCE=y
7070
CONFIG_FDT_MPXY_RPMI_SYSMSI=y
71+
CONFIG_FDT_MPXY_RPMI_MM=y

0 commit comments

Comments
 (0)