| Peng Fan | aca2f88 | 2025-04-28 18:37:34 +0800 | [diff] [blame^] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
| 2 | /* |
| 3 | * Copyright 2025 NXP |
| 4 | * |
| 5 | * Peng Fan <peng.fan@nxp.com> |
| 6 | */ |
| 7 | |
| 8 | #include <dm/uclass.h> |
| 9 | #include <scmi_agent.h> |
| 10 | |
| 11 | int imx_clk_scmi_enable(u32 clock_id, bool enable) |
| 12 | { |
| 13 | struct scmi_clk_state_in in = { |
| 14 | .clock_id = clock_id, |
| 15 | .attributes = (enable) ? 1 : 0, |
| 16 | }; |
| 17 | struct scmi_clk_state_out out; |
| 18 | struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK, |
| 19 | SCMI_CLOCK_CONFIG_SET, |
| 20 | in, out); |
| 21 | int ret; |
| 22 | struct udevice *dev; |
| 23 | |
| 24 | ret = uclass_get_device_by_name(UCLASS_CLK, "protocol@14", &dev); |
| 25 | if (ret) |
| 26 | return ret; |
| 27 | |
| 28 | ret = devm_scmi_process_msg(dev, &msg); |
| 29 | if (ret) |
| 30 | return ret; |
| 31 | |
| 32 | return scmi_to_linux_errno(out.status); |
| 33 | } |
| 34 | |
| 35 | ulong imx_clk_scmi_set_rate(u32 clock_id, ulong rate) |
| 36 | { |
| 37 | struct scmi_clk_rate_set_in in = { |
| 38 | .clock_id = clock_id, |
| 39 | .flags = SCMI_CLK_RATE_ROUND_CLOSEST, |
| 40 | .rate_lsb = (u32)rate, |
| 41 | .rate_msb = (u32)((u64)rate >> 32), |
| 42 | }; |
| 43 | struct scmi_clk_rate_set_out out; |
| 44 | struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK, |
| 45 | SCMI_CLOCK_RATE_SET, |
| 46 | in, out); |
| 47 | int ret; |
| 48 | struct udevice *dev; |
| 49 | |
| 50 | ret = uclass_get_device_by_name(UCLASS_CLK, "protocol@14", &dev); |
| 51 | if (ret) |
| 52 | return ret; |
| 53 | |
| 54 | ret = devm_scmi_process_msg(dev, &msg); |
| 55 | if (ret < 0) |
| 56 | return ret; |
| 57 | |
| 58 | ret = scmi_to_linux_errno(out.status); |
| 59 | if (ret < 0) |
| 60 | return ret; |
| 61 | |
| 62 | struct scmi_clk_rate_get_in in_rate = { |
| 63 | .clock_id = clock_id, |
| 64 | }; |
| 65 | struct scmi_clk_rate_get_out out_rate; |
| 66 | |
| 67 | msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK, SCMI_CLOCK_RATE_GET, in_rate, out_rate); |
| 68 | |
| 69 | ret = devm_scmi_process_msg(dev, &msg); |
| 70 | if (ret < 0) |
| 71 | return ret; |
| 72 | |
| 73 | ret = scmi_to_linux_errno(out_rate.status); |
| 74 | if (ret < 0) |
| 75 | return ret; |
| 76 | |
| 77 | return (ulong)(((u64)out_rate.rate_msb << 32) | out_rate.rate_lsb); |
| 78 | } |
| 79 | |
| 80 | ulong imx_clk_scmi_get_rate(u32 clock_id) |
| 81 | { |
| 82 | struct scmi_clk_rate_get_in in = { |
| 83 | .clock_id = clock_id, |
| 84 | }; |
| 85 | struct scmi_clk_rate_get_out out; |
| 86 | struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK, |
| 87 | SCMI_CLOCK_RATE_GET, |
| 88 | in, out); |
| 89 | int ret; |
| 90 | struct udevice *dev; |
| 91 | |
| 92 | ret = uclass_get_device_by_name(UCLASS_CLK, "protocol@14", &dev); |
| 93 | if (ret) |
| 94 | return ret; |
| 95 | |
| 96 | ret = devm_scmi_process_msg(dev, &msg); |
| 97 | if (ret < 0) |
| 98 | return ret; |
| 99 | |
| 100 | ret = scmi_to_linux_errno(out.status); |
| 101 | if (ret < 0) |
| 102 | return ret; |
| 103 | |
| 104 | return (ulong)(((u64)out.rate_msb << 32) | out.rate_lsb); |
| 105 | } |
| 106 | |
| 107 | int imx_clk_scmi_set_parent(u32 clock_id, u32 parent_id) |
| 108 | { |
| 109 | struct scmi_clk_parent_set_in in = { |
| 110 | .clock_id = clock_id, |
| 111 | .parent_clk = parent_id, |
| 112 | }; |
| 113 | struct scmi_clk_parent_set_out out; |
| 114 | struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK, |
| 115 | SCMI_CLOCK_PARENT_SET, |
| 116 | in, out); |
| 117 | int ret; |
| 118 | struct udevice *dev; |
| 119 | |
| 120 | ret = uclass_get_device_by_name(UCLASS_CLK, "protocol@14", &dev); |
| 121 | if (ret) |
| 122 | return ret; |
| 123 | |
| 124 | ret = devm_scmi_process_msg(dev, &msg); |
| 125 | if (ret < 0) |
| 126 | return ret; |
| 127 | |
| 128 | ret = scmi_to_linux_errno(out.status); |
| 129 | if (ret < 0 && ret != -EACCES) |
| 130 | printf("%s: %d, clock_id %u\n", __func__, ret, clock_id); |
| 131 | |
| 132 | return ret; |
| 133 | } |