mirror of
https://github.com/riscv-software-src/opensbi.git
synced 2025-08-24 15:31:22 +01:00
434add551c
For driver subsystems that are not tightly integrated into the OpenSBI init sequence, it is not important that the drivers are initialized in any particular order. By putting all of these drivers in one array, they can all be initialized with a single pass through the devicetree. This saves about 10 ms of boot time on HiFive Unmatched. 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" },
|
|
{},
|
|
};
|
|
|
|
struct fdt_driver fdt_suspend_rpmi = {
|
|
.match_table = rpmi_suspend_match,
|
|
.init = rpmi_suspend_init,
|
|
.experimental = true,
|
|
};
|