forked from Mirrors/opensbi
38df94422b
The carray referencing these definitions assumes they are const. Fixes:6a26726e08("lib/utils: reset: Add RPMI System Reset driver") Fixes:13f55f33a1("lib: utils/suspend: Add RPMI system suspend driver") Fixes:33ee9b8240("lib: utils/hsm: Add RPMI HSM driver") Fixes:591a98bdd5("lib: utils/cppc: Add RPMI CPPC driver") Signed-off-by: Samuel Holland <samuel.holland@sifive.com> Reviewed-by: Anup Patel <anup@brainfault.org>
140 lines
3.1 KiB
C
140 lines
3.1 KiB
C
/*
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*
|
|
* Copyright (c) 2024 Ventana Micro Systems Inc.
|
|
*
|
|
* Authors:
|
|
* Subrahmanya Lingappa <slingappa@ventanamicro.com>
|
|
*/
|
|
|
|
#include <libfdt.h>
|
|
#include <sbi/sbi_system.h>
|
|
#include <sbi/riscv_asm.h>
|
|
#include <sbi_utils/fdt/fdt_driver.h>
|
|
#include <sbi_utils/fdt/fdt_helper.h>
|
|
#include <sbi_utils/mailbox/fdt_mailbox.h>
|
|
#include <sbi_utils/mailbox/mailbox.h>
|
|
#include <sbi_utils/mailbox/rpmi_mailbox.h>
|
|
|
|
struct rpmi_syssusp {
|
|
struct mbox_chan *chan;
|
|
bool cust_res_addr_supported;
|
|
bool suspend_supported;
|
|
};
|
|
|
|
static struct rpmi_syssusp syssusp_ctx;
|
|
|
|
static int rpmi_syssusp_attrs(uint32_t *attrs)
|
|
{
|
|
int rc;
|
|
struct rpmi_syssusp_get_attr_resp resp;
|
|
struct rpmi_syssusp_get_attr_req req;
|
|
|
|
req.susp_type = SBI_SUSP_SLEEP_TYPE_SUSPEND;
|
|
|
|
rc = rpmi_normal_request_with_status(
|
|
syssusp_ctx.chan, RPMI_SYSSUSP_SRV_GET_ATTRIBUTES,
|
|
&req, rpmi_u32_count(req), rpmi_u32_count(req),
|
|
&resp, rpmi_u32_count(resp), rpmi_u32_count(resp));
|
|
if (rc)
|
|
return rc;
|
|
|
|
*attrs = resp.flags;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rpmi_syssusp(uint32_t suspend_type, ulong resume_addr)
|
|
{
|
|
int rc;
|
|
struct rpmi_syssusp_suspend_req req;
|
|
struct rpmi_syssusp_suspend_resp resp;
|
|
|
|
req.hartid = current_hartid();
|
|
req.suspend_type = suspend_type;
|
|
req.resume_addr_lo = resume_addr;
|
|
req.resume_addr_hi = (u64)resume_addr >> 32;
|
|
|
|
rc = rpmi_normal_request_with_status(
|
|
syssusp_ctx.chan, RPMI_SYSSUSP_SRV_SYSTEM_SUSPEND,
|
|
&req, rpmi_u32_count(req), rpmi_u32_count(req),
|
|
&resp, rpmi_u32_count(resp), rpmi_u32_count(resp));
|
|
if (rc)
|
|
return rc;
|
|
|
|
/* Wait for interrupt */
|
|
wfi();
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rpmi_system_suspend_check(u32 sleep_type)
|
|
{
|
|
return ((sleep_type == SBI_SUSP_SLEEP_TYPE_SUSPEND) &&
|
|
syssusp_ctx.suspend_supported) ? 0 : SBI_EINVAL;
|
|
}
|
|
|
|
static int rpmi_system_suspend(u32 sleep_type, ulong resume_addr)
|
|
{
|
|
int rc;
|
|
|
|
if (sleep_type != SBI_SUSP_SLEEP_TYPE_SUSPEND)
|
|
return SBI_ENOTSUPP;
|
|
|
|
rc = rpmi_syssusp(sleep_type, resume_addr);
|
|
if (rc)
|
|
return rc;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct sbi_system_suspend_device rpmi_suspend_dev = {
|
|
.name = "rpmi-system-suspend",
|
|
.system_suspend_check = rpmi_system_suspend_check,
|
|
.system_suspend = rpmi_system_suspend,
|
|
};
|
|
|
|
static int rpmi_suspend_init(const void *fdt, int nodeoff,
|
|
const struct fdt_match *match)
|
|
{
|
|
int rc;
|
|
uint32_t attrs = 0;
|
|
|
|
/* If channel already available then do nothing. */
|
|
if (syssusp_ctx.chan)
|
|
return 0;
|
|
|
|
/*
|
|
* If channel request failed then other end does not support
|
|
* suspend service group so do nothing.
|
|
*/
|
|
rc = fdt_mailbox_request_chan(fdt, nodeoff, 0, &syssusp_ctx.chan);
|
|
if (rc)
|
|
return SBI_ENODEV;
|
|
|
|
/* Get suspend attributes */
|
|
rc = rpmi_syssusp_attrs(&attrs);
|
|
if (rc)
|
|
return rc;
|
|
|
|
syssusp_ctx.suspend_supported =
|
|
attrs & RPMI_SYSSUSP_ATTRS_FLAGS_SUSPENDTYPE;
|
|
syssusp_ctx.cust_res_addr_supported =
|
|
attrs & RPMI_SYSSUSP_ATTRS_FLAGS_RESUMEADDR;
|
|
|
|
sbi_system_suspend_set_device(&rpmi_suspend_dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct fdt_match rpmi_suspend_match[] = {
|
|
{ .compatible = "riscv,rpmi-system-suspend" },
|
|
{},
|
|
};
|
|
|
|
const struct fdt_driver fdt_suspend_rpmi = {
|
|
.match_table = rpmi_suspend_match,
|
|
.init = rpmi_suspend_init,
|
|
.experimental = true,
|
|
};
|