| // SPDX-License-Identifier: GPL-2.0 |
| /* |
| * Copyright 2018 NXP |
| * Peng Fan <peng.fan@nxp.com> |
| */ |
| |
| #include <common.h> |
| #include <clk-uclass.h> |
| #include <dm.h> |
| #include <asm/arch/sci/sci.h> |
| #include <asm/arch/clock.h> |
| #include <dt-bindings/clock/imx8qxp-clock.h> |
| #include <dt-bindings/soc/imx_rsrc.h> |
| #include <misc.h> |
| |
| struct imx8_clks { |
| ulong id; |
| const char *name; |
| }; |
| |
| #if CONFIG_IS_ENABLED(CMD_CLK) |
| static struct imx8_clks imx8_clk_names[] = { |
| { IMX8QXP_A35_DIV, "A35_DIV" }, |
| { IMX8QXP_I2C0_CLK, "I2C0" }, |
| { IMX8QXP_I2C1_CLK, "I2C1" }, |
| { IMX8QXP_I2C2_CLK, "I2C2" }, |
| { IMX8QXP_I2C3_CLK, "I2C3" }, |
| { IMX8QXP_UART0_CLK, "UART0" }, |
| { IMX8QXP_UART1_CLK, "UART1" }, |
| { IMX8QXP_UART2_CLK, "UART2" }, |
| { IMX8QXP_UART3_CLK, "UART3" }, |
| { IMX8QXP_SDHC0_CLK, "SDHC0" }, |
| { IMX8QXP_SDHC1_CLK, "SDHC1" }, |
| { IMX8QXP_ENET0_AHB_CLK, "ENET0_AHB" }, |
| { IMX8QXP_ENET0_IPG_CLK, "ENET0_IPG" }, |
| { IMX8QXP_ENET0_REF_DIV, "ENET0_REF" }, |
| { IMX8QXP_ENET0_PTP_CLK, "ENET0_PTP" }, |
| { IMX8QXP_ENET1_AHB_CLK, "ENET1_AHB" }, |
| { IMX8QXP_ENET1_IPG_CLK, "ENET1_IPG" }, |
| { IMX8QXP_ENET1_REF_DIV, "ENET1_REF" }, |
| { IMX8QXP_ENET1_PTP_CLK, "ENET1_PTP" }, |
| }; |
| #endif |
| |
| static ulong imx8_clk_get_rate(struct clk *clk) |
| { |
| sc_pm_clk_t pm_clk; |
| ulong rate; |
| u16 resource; |
| int ret; |
| |
| debug("%s(#%lu)\n", __func__, clk->id); |
| |
| switch (clk->id) { |
| case IMX8QXP_A35_DIV: |
| resource = SC_R_A35; |
| pm_clk = SC_PM_CLK_CPU; |
| break; |
| case IMX8QXP_I2C0_CLK: |
| resource = SC_R_I2C_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_I2C1_CLK: |
| resource = SC_R_I2C_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_I2C2_CLK: |
| resource = SC_R_I2C_2; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_I2C3_CLK: |
| resource = SC_R_I2C_3; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_SDHC0_IPG_CLK: |
| case IMX8QXP_SDHC0_CLK: |
| case IMX8QXP_SDHC0_DIV: |
| resource = SC_R_SDHC_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_SDHC1_IPG_CLK: |
| case IMX8QXP_SDHC1_CLK: |
| case IMX8QXP_SDHC1_DIV: |
| resource = SC_R_SDHC_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART0_IPG_CLK: |
| case IMX8QXP_UART0_CLK: |
| resource = SC_R_UART_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART1_CLK: |
| resource = SC_R_UART_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART2_CLK: |
| resource = SC_R_UART_2; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART3_CLK: |
| resource = SC_R_UART_3; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_ENET0_IPG_CLK: |
| case IMX8QXP_ENET0_AHB_CLK: |
| case IMX8QXP_ENET0_REF_DIV: |
| case IMX8QXP_ENET0_PTP_CLK: |
| resource = SC_R_ENET_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_ENET1_IPG_CLK: |
| case IMX8QXP_ENET1_AHB_CLK: |
| case IMX8QXP_ENET1_REF_DIV: |
| case IMX8QXP_ENET1_PTP_CLK: |
| resource = SC_R_ENET_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| default: |
| if (clk->id < IMX8QXP_UART0_IPG_CLK || |
| clk->id >= IMX8QXP_CLK_END) { |
| printf("%s(Invalid clk ID #%lu)\n", |
| __func__, clk->id); |
| return -EINVAL; |
| } |
| return -ENOTSUPP; |
| }; |
| |
| ret = sc_pm_get_clock_rate(-1, resource, pm_clk, |
| (sc_pm_clock_rate_t *)&rate); |
| if (ret) { |
| printf("%s err %d\n", __func__, ret); |
| return ret; |
| } |
| |
| return rate; |
| } |
| |
| static ulong imx8_clk_set_rate(struct clk *clk, unsigned long rate) |
| { |
| sc_pm_clk_t pm_clk; |
| u32 new_rate = rate; |
| u16 resource; |
| int ret; |
| |
| debug("%s(#%lu), rate: %lu\n", __func__, clk->id, rate); |
| |
| switch (clk->id) { |
| case IMX8QXP_I2C0_CLK: |
| resource = SC_R_I2C_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_I2C1_CLK: |
| resource = SC_R_I2C_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_I2C2_CLK: |
| resource = SC_R_I2C_2; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_I2C3_CLK: |
| resource = SC_R_I2C_3; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART0_CLK: |
| resource = SC_R_UART_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART1_CLK: |
| resource = SC_R_UART_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART2_CLK: |
| resource = SC_R_UART_2; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART3_CLK: |
| resource = SC_R_UART_3; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_SDHC0_IPG_CLK: |
| case IMX8QXP_SDHC0_CLK: |
| case IMX8QXP_SDHC0_DIV: |
| resource = SC_R_SDHC_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_SDHC1_SEL: |
| case IMX8QXP_SDHC0_SEL: |
| return 0; |
| case IMX8QXP_SDHC1_IPG_CLK: |
| case IMX8QXP_SDHC1_CLK: |
| case IMX8QXP_SDHC1_DIV: |
| resource = SC_R_SDHC_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_ENET0_IPG_CLK: |
| case IMX8QXP_ENET0_AHB_CLK: |
| case IMX8QXP_ENET0_REF_DIV: |
| case IMX8QXP_ENET0_PTP_CLK: |
| resource = SC_R_ENET_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_ENET1_IPG_CLK: |
| case IMX8QXP_ENET1_AHB_CLK: |
| case IMX8QXP_ENET1_REF_DIV: |
| case IMX8QXP_ENET1_PTP_CLK: |
| resource = SC_R_ENET_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| default: |
| if (clk->id < IMX8QXP_UART0_IPG_CLK || |
| clk->id >= IMX8QXP_CLK_END) { |
| printf("%s(Invalid clk ID #%lu)\n", |
| __func__, clk->id); |
| return -EINVAL; |
| } |
| return -ENOTSUPP; |
| }; |
| |
| ret = sc_pm_set_clock_rate(-1, resource, pm_clk, &new_rate); |
| if (ret) { |
| printf("%s err %d\n", __func__, ret); |
| return ret; |
| } |
| |
| return new_rate; |
| } |
| |
| static int __imx8_clk_enable(struct clk *clk, bool enable) |
| { |
| sc_pm_clk_t pm_clk; |
| u16 resource; |
| int ret; |
| |
| debug("%s(#%lu)\n", __func__, clk->id); |
| |
| switch (clk->id) { |
| case IMX8QXP_I2C0_CLK: |
| resource = SC_R_I2C_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_I2C1_CLK: |
| resource = SC_R_I2C_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_I2C2_CLK: |
| resource = SC_R_I2C_2; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_I2C3_CLK: |
| resource = SC_R_I2C_3; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART0_CLK: |
| resource = SC_R_UART_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART1_CLK: |
| resource = SC_R_UART_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART2_CLK: |
| resource = SC_R_UART_2; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_UART3_CLK: |
| resource = SC_R_UART_3; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_SDHC0_IPG_CLK: |
| case IMX8QXP_SDHC0_CLK: |
| case IMX8QXP_SDHC0_DIV: |
| resource = SC_R_SDHC_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_SDHC1_IPG_CLK: |
| case IMX8QXP_SDHC1_CLK: |
| case IMX8QXP_SDHC1_DIV: |
| resource = SC_R_SDHC_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_ENET0_IPG_CLK: |
| case IMX8QXP_ENET0_AHB_CLK: |
| case IMX8QXP_ENET0_REF_DIV: |
| case IMX8QXP_ENET0_PTP_CLK: |
| resource = SC_R_ENET_0; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| case IMX8QXP_ENET1_IPG_CLK: |
| case IMX8QXP_ENET1_AHB_CLK: |
| case IMX8QXP_ENET1_REF_DIV: |
| case IMX8QXP_ENET1_PTP_CLK: |
| resource = SC_R_ENET_1; |
| pm_clk = SC_PM_CLK_PER; |
| break; |
| default: |
| if (clk->id < IMX8QXP_UART0_IPG_CLK || |
| clk->id >= IMX8QXP_CLK_END) { |
| printf("%s(Invalid clk ID #%lu)\n", |
| __func__, clk->id); |
| return -EINVAL; |
| } |
| return -ENOTSUPP; |
| } |
| |
| ret = sc_pm_clock_enable(-1, resource, pm_clk, enable, 0); |
| if (ret) { |
| printf("%s err %d\n", __func__, ret); |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static int imx8_clk_disable(struct clk *clk) |
| { |
| return __imx8_clk_enable(clk, 0); |
| } |
| |
| static int imx8_clk_enable(struct clk *clk) |
| { |
| return __imx8_clk_enable(clk, 1); |
| } |
| |
| #if CONFIG_IS_ENABLED(CMD_CLK) |
| int soc_clk_dump(void) |
| { |
| struct udevice *dev; |
| struct clk clk; |
| unsigned long rate; |
| int i, ret; |
| |
| ret = uclass_get_device_by_driver(UCLASS_CLK, |
| DM_GET_DRIVER(imx8_clk), &dev); |
| if (ret) |
| return ret; |
| |
| printf("Clk\t\tHz\n"); |
| |
| for (i = 0; i < ARRAY_SIZE(imx8_clk_names); i++) { |
| clk.id = imx8_clk_names[i].id; |
| ret = clk_request(dev, &clk); |
| if (ret < 0) { |
| debug("%s clk_request() failed: %d\n", __func__, ret); |
| continue; |
| } |
| |
| ret = clk_get_rate(&clk); |
| rate = ret; |
| |
| clk_free(&clk); |
| |
| if (ret == -ENOTSUPP) { |
| printf("clk ID %lu not supported yet\n", |
| imx8_clk_names[i].id); |
| continue; |
| } |
| if (ret < 0) { |
| printf("%s %lu: get_rate err: %d\n", |
| __func__, imx8_clk_names[i].id, ret); |
| continue; |
| } |
| |
| printf("%s(%3lu):\t%lu\n", |
| imx8_clk_names[i].name, imx8_clk_names[i].id, rate); |
| } |
| |
| return 0; |
| } |
| #endif |
| |
| static struct clk_ops imx8_clk_ops = { |
| .set_rate = imx8_clk_set_rate, |
| .get_rate = imx8_clk_get_rate, |
| .enable = imx8_clk_enable, |
| .disable = imx8_clk_disable, |
| }; |
| |
| static int imx8_clk_probe(struct udevice *dev) |
| { |
| return 0; |
| } |
| |
| static const struct udevice_id imx8_clk_ids[] = { |
| { .compatible = "fsl,imx8qxp-clk" }, |
| { }, |
| }; |
| |
| U_BOOT_DRIVER(imx8_clk) = { |
| .name = "clk_imx8", |
| .id = UCLASS_CLK, |
| .of_match = imx8_clk_ids, |
| .ops = &imx8_clk_ops, |
| .probe = imx8_clk_probe, |
| .flags = DM_FLAG_PRE_RELOC, |
| }; |