mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-08-16 12:16:59 +02:00
0bd99a1dd2
This patch adds i.MX95 SoC and clock related code. Because they are based on SCMI, put them in the scmi subfolder. Signed-off-by: Alice Guo <alice.guo@nxp.com> Signed-off-by: Frank Li <Frank.Li@nxp.com> Signed-off-by: Ji Luo <ji.luo@nxp.com> Signed-off-by: Jindong Yue <jindong.yue@nxp.com> Signed-off-by: Peng Fan <peng.fan@nxp.com> Signed-off-by: Ranjani Vaidyanathan <ranjani.vaidyanathan@nxp.com> Signed-off-by: Ye Li <ye.li@nxp.com>
134 lines
2.8 KiB
C
134 lines
2.8 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright 2025 NXP
|
|
*
|
|
* Peng Fan <peng.fan@nxp.com>
|
|
*/
|
|
|
|
#include <dm/uclass.h>
|
|
#include <scmi_agent.h>
|
|
|
|
int imx_clk_scmi_enable(u32 clock_id, bool enable)
|
|
{
|
|
struct scmi_clk_state_in in = {
|
|
.clock_id = clock_id,
|
|
.attributes = (enable) ? 1 : 0,
|
|
};
|
|
struct scmi_clk_state_out out;
|
|
struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK,
|
|
SCMI_CLOCK_CONFIG_SET,
|
|
in, out);
|
|
int ret;
|
|
struct udevice *dev;
|
|
|
|
ret = uclass_get_device_by_name(UCLASS_CLK, "protocol@14", &dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = devm_scmi_process_msg(dev, &msg);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return scmi_to_linux_errno(out.status);
|
|
}
|
|
|
|
ulong imx_clk_scmi_set_rate(u32 clock_id, ulong rate)
|
|
{
|
|
struct scmi_clk_rate_set_in in = {
|
|
.clock_id = clock_id,
|
|
.flags = SCMI_CLK_RATE_ROUND_CLOSEST,
|
|
.rate_lsb = (u32)rate,
|
|
.rate_msb = (u32)((u64)rate >> 32),
|
|
};
|
|
struct scmi_clk_rate_set_out out;
|
|
struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK,
|
|
SCMI_CLOCK_RATE_SET,
|
|
in, out);
|
|
int ret;
|
|
struct udevice *dev;
|
|
|
|
ret = uclass_get_device_by_name(UCLASS_CLK, "protocol@14", &dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = devm_scmi_process_msg(dev, &msg);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = scmi_to_linux_errno(out.status);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
struct scmi_clk_rate_get_in in_rate = {
|
|
.clock_id = clock_id,
|
|
};
|
|
struct scmi_clk_rate_get_out out_rate;
|
|
|
|
msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK, SCMI_CLOCK_RATE_GET, in_rate, out_rate);
|
|
|
|
ret = devm_scmi_process_msg(dev, &msg);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = scmi_to_linux_errno(out_rate.status);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ulong)(((u64)out_rate.rate_msb << 32) | out_rate.rate_lsb);
|
|
}
|
|
|
|
ulong imx_clk_scmi_get_rate(u32 clock_id)
|
|
{
|
|
struct scmi_clk_rate_get_in in = {
|
|
.clock_id = clock_id,
|
|
};
|
|
struct scmi_clk_rate_get_out out;
|
|
struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK,
|
|
SCMI_CLOCK_RATE_GET,
|
|
in, out);
|
|
int ret;
|
|
struct udevice *dev;
|
|
|
|
ret = uclass_get_device_by_name(UCLASS_CLK, "protocol@14", &dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = devm_scmi_process_msg(dev, &msg);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = scmi_to_linux_errno(out.status);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ulong)(((u64)out.rate_msb << 32) | out.rate_lsb);
|
|
}
|
|
|
|
int imx_clk_scmi_set_parent(u32 clock_id, u32 parent_id)
|
|
{
|
|
struct scmi_clk_parent_set_in in = {
|
|
.clock_id = clock_id,
|
|
.parent_clk = parent_id,
|
|
};
|
|
struct scmi_clk_parent_set_out out;
|
|
struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK,
|
|
SCMI_CLOCK_PARENT_SET,
|
|
in, out);
|
|
int ret;
|
|
struct udevice *dev;
|
|
|
|
ret = uclass_get_device_by_name(UCLASS_CLK, "protocol@14", &dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = devm_scmi_process_msg(dev, &msg);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = scmi_to_linux_errno(out.status);
|
|
if (ret < 0 && ret != -EACCES)
|
|
printf("%s: %d, clock_id %u\n", __func__, ret, clock_id);
|
|
|
|
return ret;
|
|
}
|