1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
29e5935c0SWenyou Yang /*
39e5935c0SWenyou Yang * Copyright (C) 2016 Atmel Corporation
49e5935c0SWenyou Yang * Wenyou.Yang <wenyou.yang@atmel.com>
59e5935c0SWenyou Yang */
69e5935c0SWenyou Yang
79e5935c0SWenyou Yang #include <common.h>
89e5935c0SWenyou Yang #include <clk-uclass.h>
99d922450SSimon Glass #include <dm.h>
109e5935c0SWenyou Yang #include <linux/io.h>
119e5935c0SWenyou Yang #include <mach/at91_pmc.h>
129e5935c0SWenyou Yang #include "pmc.h"
139e5935c0SWenyou Yang
149e5935c0SWenyou Yang DECLARE_GLOBAL_DATA_PTR;
159e5935c0SWenyou Yang
169e5935c0SWenyou Yang #define GENERATED_SOURCE_MAX 6
179e5935c0SWenyou Yang #define GENERATED_MAX_DIV 255
189e5935c0SWenyou Yang
196cadaa04SWenyou Yang /**
206cadaa04SWenyou Yang * generated_clk_bind() - for the generated clock driver
216cadaa04SWenyou Yang * Recursively bind its children as clk devices.
226cadaa04SWenyou Yang *
236cadaa04SWenyou Yang * @return: 0 on success, or negative error code on failure
246cadaa04SWenyou Yang */
generated_clk_bind(struct udevice * dev)256cadaa04SWenyou Yang static int generated_clk_bind(struct udevice *dev)
266cadaa04SWenyou Yang {
276cadaa04SWenyou Yang return at91_clk_sub_device_bind(dev, "generic-clk");
286cadaa04SWenyou Yang }
296cadaa04SWenyou Yang
306cadaa04SWenyou Yang static const struct udevice_id generated_clk_match[] = {
316cadaa04SWenyou Yang { .compatible = "atmel,sama5d2-clk-generated" },
326cadaa04SWenyou Yang {}
336cadaa04SWenyou Yang };
346cadaa04SWenyou Yang
356cadaa04SWenyou Yang U_BOOT_DRIVER(generated_clk) = {
366cadaa04SWenyou Yang .name = "generated-clk",
376cadaa04SWenyou Yang .id = UCLASS_MISC,
386cadaa04SWenyou Yang .of_match = generated_clk_match,
396cadaa04SWenyou Yang .bind = generated_clk_bind,
406cadaa04SWenyou Yang };
416cadaa04SWenyou Yang
426cadaa04SWenyou Yang /*-------------------------------------------------------------*/
436cadaa04SWenyou Yang
446cadaa04SWenyou Yang struct generic_clk_priv {
459e5935c0SWenyou Yang u32 num_parents;
469e5935c0SWenyou Yang };
479e5935c0SWenyou Yang
generic_clk_get_rate(struct clk * clk)486cadaa04SWenyou Yang static ulong generic_clk_get_rate(struct clk *clk)
499e5935c0SWenyou Yang {
509e5935c0SWenyou Yang struct pmc_platdata *plat = dev_get_platdata(clk->dev);
519e5935c0SWenyou Yang struct at91_pmc *pmc = plat->reg_base;
529e5935c0SWenyou Yang struct clk parent;
536cadaa04SWenyou Yang ulong clk_rate;
549e5935c0SWenyou Yang u32 tmp, gckdiv;
5563a80b8dSWenyou Yang u8 clock_source, parent_index;
569e5935c0SWenyou Yang int ret;
579e5935c0SWenyou Yang
589e5935c0SWenyou Yang writel(clk->id & AT91_PMC_PCR_PID_MASK, &pmc->pcr);
599e5935c0SWenyou Yang tmp = readl(&pmc->pcr);
6063a80b8dSWenyou Yang clock_source = (tmp >> AT91_PMC_PCR_GCKCSS_OFFSET) &
619e5935c0SWenyou Yang AT91_PMC_PCR_GCKCSS_MASK;
629e5935c0SWenyou Yang gckdiv = (tmp >> AT91_PMC_PCR_GCKDIV_OFFSET) & AT91_PMC_PCR_GCKDIV_MASK;
639e5935c0SWenyou Yang
6463a80b8dSWenyou Yang parent_index = clock_source - 1;
6563a80b8dSWenyou Yang ret = clk_get_by_index(dev_get_parent(clk->dev), parent_index, &parent);
669e5935c0SWenyou Yang if (ret)
679e5935c0SWenyou Yang return 0;
689e5935c0SWenyou Yang
696cadaa04SWenyou Yang clk_rate = clk_get_rate(&parent) / (gckdiv + 1);
706cadaa04SWenyou Yang
716cadaa04SWenyou Yang clk_free(&parent);
726cadaa04SWenyou Yang
736cadaa04SWenyou Yang return clk_rate;
749e5935c0SWenyou Yang }
759e5935c0SWenyou Yang
generic_clk_set_rate(struct clk * clk,ulong rate)766cadaa04SWenyou Yang static ulong generic_clk_set_rate(struct clk *clk, ulong rate)
779e5935c0SWenyou Yang {
789e5935c0SWenyou Yang struct pmc_platdata *plat = dev_get_platdata(clk->dev);
799e5935c0SWenyou Yang struct at91_pmc *pmc = plat->reg_base;
806cadaa04SWenyou Yang struct generic_clk_priv *priv = dev_get_priv(clk->dev);
819e5935c0SWenyou Yang struct clk parent, best_parent;
829e5935c0SWenyou Yang ulong tmp_rate, best_rate = rate, parent_rate;
839e5935c0SWenyou Yang int tmp_diff, best_diff = -1;
849e5935c0SWenyou Yang u32 div, best_div = 0;
8563a80b8dSWenyou Yang u8 best_parent_index, best_clock_source = 0;
869e5935c0SWenyou Yang u8 i;
879e5935c0SWenyou Yang u32 tmp;
889e5935c0SWenyou Yang int ret;
899e5935c0SWenyou Yang
909e5935c0SWenyou Yang for (i = 0; i < priv->num_parents; i++) {
916cadaa04SWenyou Yang ret = clk_get_by_index(dev_get_parent(clk->dev), i, &parent);
929e5935c0SWenyou Yang if (ret)
939e5935c0SWenyou Yang return ret;
949e5935c0SWenyou Yang
959e5935c0SWenyou Yang parent_rate = clk_get_rate(&parent);
969e5935c0SWenyou Yang if (IS_ERR_VALUE(parent_rate))
979e5935c0SWenyou Yang return parent_rate;
989e5935c0SWenyou Yang
999e5935c0SWenyou Yang for (div = 1; div < GENERATED_MAX_DIV + 2; div++) {
1009e5935c0SWenyou Yang tmp_rate = DIV_ROUND_CLOSEST(parent_rate, div);
101eb1ed2b1SLudovic Desroches tmp_diff = abs(rate - tmp_rate);
1029e5935c0SWenyou Yang
1039e5935c0SWenyou Yang if (best_diff < 0 || best_diff > tmp_diff) {
1049e5935c0SWenyou Yang best_rate = tmp_rate;
1059e5935c0SWenyou Yang best_diff = tmp_diff;
1069e5935c0SWenyou Yang
1079e5935c0SWenyou Yang best_div = div - 1;
1089e5935c0SWenyou Yang best_parent = parent;
10963a80b8dSWenyou Yang best_parent_index = i;
11063a80b8dSWenyou Yang best_clock_source = best_parent_index + 1;
1119e5935c0SWenyou Yang }
1129e5935c0SWenyou Yang
1139e5935c0SWenyou Yang if (!best_diff || tmp_rate < rate)
1149e5935c0SWenyou Yang break;
1159e5935c0SWenyou Yang }
1169e5935c0SWenyou Yang
1179e5935c0SWenyou Yang if (!best_diff)
1189e5935c0SWenyou Yang break;
1199e5935c0SWenyou Yang }
1209e5935c0SWenyou Yang
1219e5935c0SWenyou Yang debug("GCK: best parent: %s, best_rate = %ld, best_div = %d\n",
1229e5935c0SWenyou Yang best_parent.dev->name, best_rate, best_div);
1239e5935c0SWenyou Yang
1249e5935c0SWenyou Yang ret = clk_enable(&best_parent);
1259e5935c0SWenyou Yang if (ret)
1269e5935c0SWenyou Yang return ret;
1279e5935c0SWenyou Yang
1289e5935c0SWenyou Yang writel(clk->id & AT91_PMC_PCR_PID_MASK, &pmc->pcr);
1299e5935c0SWenyou Yang tmp = readl(&pmc->pcr);
1309e5935c0SWenyou Yang tmp &= ~(AT91_PMC_PCR_GCKDIV | AT91_PMC_PCR_GCKCSS);
13163a80b8dSWenyou Yang tmp |= AT91_PMC_PCR_GCKCSS_(best_clock_source) |
1329e5935c0SWenyou Yang AT91_PMC_PCR_CMD_WRITE |
1339e5935c0SWenyou Yang AT91_PMC_PCR_GCKDIV_(best_div) |
1349e5935c0SWenyou Yang AT91_PMC_PCR_GCKEN;
1359e5935c0SWenyou Yang writel(tmp, &pmc->pcr);
1369e5935c0SWenyou Yang
1379e5935c0SWenyou Yang while (!(readl(&pmc->sr) & AT91_PMC_GCKRDY))
1389e5935c0SWenyou Yang ;
1399e5935c0SWenyou Yang
1409e5935c0SWenyou Yang return 0;
1419e5935c0SWenyou Yang }
1429e5935c0SWenyou Yang
1436cadaa04SWenyou Yang static struct clk_ops generic_clk_ops = {
1446cadaa04SWenyou Yang .of_xlate = at91_clk_of_xlate,
1456cadaa04SWenyou Yang .get_rate = generic_clk_get_rate,
1466cadaa04SWenyou Yang .set_rate = generic_clk_set_rate,
1479e5935c0SWenyou Yang };
1489e5935c0SWenyou Yang
generic_clk_ofdata_to_platdata(struct udevice * dev)1496cadaa04SWenyou Yang static int generic_clk_ofdata_to_platdata(struct udevice *dev)
1509e5935c0SWenyou Yang {
1516cadaa04SWenyou Yang struct generic_clk_priv *priv = dev_get_priv(dev);
1529e5935c0SWenyou Yang u32 cells[GENERATED_SOURCE_MAX];
1539e5935c0SWenyou Yang u32 num_parents;
1549e5935c0SWenyou Yang
1556cadaa04SWenyou Yang num_parents = fdtdec_get_int_array_count(gd->fdt_blob,
156e160f7d4SSimon Glass dev_of_offset(dev_get_parent(dev)), "clocks", cells,
1579e5935c0SWenyou Yang GENERATED_SOURCE_MAX);
1589e5935c0SWenyou Yang
1599e5935c0SWenyou Yang if (!num_parents)
1609e5935c0SWenyou Yang return -1;
1619e5935c0SWenyou Yang
1629e5935c0SWenyou Yang priv->num_parents = num_parents;
1639e5935c0SWenyou Yang
1649e5935c0SWenyou Yang return 0;
1659e5935c0SWenyou Yang }
1669e5935c0SWenyou Yang
1676cadaa04SWenyou Yang U_BOOT_DRIVER(generic_clk) = {
1686cadaa04SWenyou Yang .name = "generic-clk",
1699e5935c0SWenyou Yang .id = UCLASS_CLK,
1706cadaa04SWenyou Yang .probe = at91_clk_probe,
1716cadaa04SWenyou Yang .ofdata_to_platdata = generic_clk_ofdata_to_platdata,
1726cadaa04SWenyou Yang .priv_auto_alloc_size = sizeof(struct generic_clk_priv),
1739e5935c0SWenyou Yang .platdata_auto_alloc_size = sizeof(struct pmc_platdata),
1746cadaa04SWenyou Yang .ops = &generic_clk_ops,
1759e5935c0SWenyou Yang };
176