Files
rt-thread/components/drivers/reset/reset-scmi.c
T
GuEe-GUI 2c88a3b698 [drivers][scmi] Fix reset provider lookup and driver registration order
- register SCMI reset and power-domain drivers during subsystem initialization
- resolve SCMI reset state through the reset-controller provider
- use the parsed DT reset domain ID when querying reset attributes
- retain the SCMI device reference in the reset provider instance

Signed-off-by: GuEe-GUI <2991707448@qq.com>
2026-11-02 18:20:45 +08:00

138 lines
3.2 KiB
C
Executable File

/*
* Copyright (c) 2006-2022, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2022-11-26 GuEe-GUI first version
*/
#include <rtthread.h>
#include <rtdevice.h>
#define DBG_TAG "reset.scmi"
#define DBG_LVL DBG_INFO
#include <rtdbg.h>
struct scmi_reset
{
struct rt_reset_controller parent;
struct rt_scmi_device *sdev;
};
#define raw_to_scmi_reset(raw) rt_container_of(raw, struct scmi_reset, parent)
static rt_err_t scmi_reset_do(struct scmi_reset *srst, int domain,
rt_uint32_t flags, rt_uint32_t state)
{
struct scmi_reset_in in =
{
.domain_id = rt_cpu_to_le32(domain),
.flags = rt_cpu_to_le32(flags),
.reset_state = rt_cpu_to_le32(state),
};
struct scmi_reset_out out;
struct rt_scmi_msg msg = RT_SCMI_MSG_IN_OUT(SCMI_RESET_RESET, &in, &out);
return rt_scmi_process_msg(srst->sdev, &msg);
}
static rt_err_t scmi_reset_reset(struct rt_reset_control *rstc)
{
struct scmi_reset *srst = raw_to_scmi_reset(rstc->rstcer);
return scmi_reset_do(srst, rstc->id, SCMI_RESET_FLAG_RESET, SCMI_ARCH_COLD_RESET);
}
static rt_err_t scmi_reset_assert(struct rt_reset_control *rstc)
{
struct scmi_reset *srst = raw_to_scmi_reset(rstc->rstcer);
return scmi_reset_do(srst, rstc->id, SCMI_RESET_FLAG_ASSERT, SCMI_ARCH_COLD_RESET);
}
static rt_err_t scmi_reset_deassert(struct rt_reset_control *rstc)
{
struct scmi_reset *srst = raw_to_scmi_reset(rstc->rstcer);
return scmi_reset_do(srst, rstc->id, 0, SCMI_ARCH_COLD_RESET);
}
static rt_err_t scmi_reset_ofw_parse(struct rt_reset_control *rstc,
struct rt_ofw_cell_args *args)
{
rt_err_t err;
struct scmi_reset *srst = raw_to_scmi_reset(rstc->rstcer);
struct scmi_reset_attr_in in =
{
.domain_id = rt_cpu_to_le32(args->args[0]),
};
struct scmi_reset_attr_out out;
struct rt_scmi_msg msg = RT_SCMI_MSG_IN_OUT(SCMI_RESET_DOMAIN_ATTRIBUTES, &in, &out);
if ((err = rt_scmi_process_msg(srst->sdev, &msg)))
{
return err;
}
return rt_le32_to_cpu(out.status) == 0 ? RT_EOK : -RT_ERROR;
}
static const struct rt_reset_control_ops scmi_reset_ops =
{
.ofw_parse = scmi_reset_ofw_parse,
.reset = scmi_reset_reset,
.assert = scmi_reset_assert,
.deassert = scmi_reset_deassert,
};
static rt_err_t scmi_reset_probe(struct rt_scmi_device *sdev)
{
rt_err_t err;
struct rt_reset_controller *rstcer;
struct scmi_reset *srst = rt_calloc(1, sizeof(*srst));
if (!srst)
{
return -RT_ENOMEM;
}
srst->sdev = sdev;
rstcer = &srst->parent;
rstcer->priv = srst;
rstcer->ofw_node = sdev->parent.ofw_node;
rstcer->ops = &scmi_reset_ops;
if ((err = rt_reset_controller_register(&srst->parent)))
{
rt_free(srst);
}
return err;
}
static const struct rt_scmi_device_id scmi_reset_ids[] =
{
{ SCMI_PROTOCOL_ID_RESET, "reset" },
{ /* sentinel */ },
};
static struct rt_scmi_driver scmi_reset_driver =
{
.name = "reset-scmi",
.ids = scmi_reset_ids,
.probe = scmi_reset_probe,
};
static int scmi_reset_drv_register(void)
{
rt_scmi_driver_register(&scmi_reset_driver);
return 0;
}
INIT_SUBSYS_EXPORT(scmi_reset_drv_register);