mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-12-20 08:52:12 +01:00
0619cb3203
SCMI v3.2 introduces a new clock CONFIG_SET message format that can
optionally carry also OEM specific configuration values beside the usual
clock enable/disable requests. Add support to use such new format when
talking to a v3.2 compliant SCMI platform.
Support existing enable/disable operations across different clock protocol
versions: this patch still does not add protocol operations to support the
new OEM specific optional configuration capabilities.
No functional change for the SCMI drivers users of the related enable and
disable clock operations.
[Marek: Remodel after Linux e49e314a2cf7 ("firmware: arm_scmi: Add clock v3.2 CONFIG_SET support")
Support both old < 2.1 and new >= 2.1 protocol versions.
Update commit message based on Linux one]
Signed-off-by: Vinh Nguyen <vinh.nguyen.xz@renesas.com>
Signed-off-by: Marek Vasut <marek.vasut+renesas@mailbox.org>
Reviewed-by: Alice Guo <alice.guo@nxp.com>
Signed-off-by: Peng Fan <peng.fan@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_v1 in = {
|
|
.clock_id = clock_id,
|
|
.attributes = !!enable,
|
|
};
|
|
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;
|
|
}
|