Blame view
drivers/clk/clk_sandbox.c
2.05 KB
d41ce506b
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 |
/* * (C) Copyright 2015 Google, Inc * * SPDX-License-Identifier: GPL-2.0 */ #include <common.h> #include <clk-uclass.h> #include <dm.h> #include <errno.h> #include <asm/clk.h> struct sandbox_clk_priv { ulong rate[SANDBOX_CLK_ID_COUNT]; bool enabled[SANDBOX_CLK_ID_COUNT]; }; static ulong sandbox_clk_get_rate(struct clk *clk) { struct sandbox_clk_priv *priv = dev_get_priv(clk->dev); if (clk->id >= SANDBOX_CLK_ID_COUNT) return -EINVAL; return priv->rate[clk->id]; } static ulong sandbox_clk_set_rate(struct clk *clk, ulong rate) { struct sandbox_clk_priv *priv = dev_get_priv(clk->dev); ulong old_rate; if (clk->id >= SANDBOX_CLK_ID_COUNT) return -EINVAL; if (!rate) return -EINVAL; old_rate = priv->rate[clk->id]; priv->rate[clk->id] = rate; return old_rate; } static int sandbox_clk_enable(struct clk *clk) { struct sandbox_clk_priv *priv = dev_get_priv(clk->dev); if (clk->id >= SANDBOX_CLK_ID_COUNT) return -EINVAL; priv->enabled[clk->id] = true; return 0; } static int sandbox_clk_disable(struct clk *clk) { struct sandbox_clk_priv *priv = dev_get_priv(clk->dev); if (clk->id >= SANDBOX_CLK_ID_COUNT) return -EINVAL; priv->enabled[clk->id] = false; return 0; } static struct clk_ops sandbox_clk_ops = { .get_rate = sandbox_clk_get_rate, .set_rate = sandbox_clk_set_rate, .enable = sandbox_clk_enable, .disable = sandbox_clk_disable, }; static const struct udevice_id sandbox_clk_ids[] = { { .compatible = "sandbox,clk" }, { } }; U_BOOT_DRIVER(clk_sandbox) = { .name = "clk_sandbox", .id = UCLASS_CLK, .of_match = sandbox_clk_ids, .ops = &sandbox_clk_ops, .priv_auto_alloc_size = sizeof(struct sandbox_clk_priv), }; ulong sandbox_clk_query_rate(struct udevice *dev, int id) { struct sandbox_clk_priv *priv = dev_get_priv(dev); if (id < 0 || id >= SANDBOX_CLK_ID_COUNT) return -EINVAL; return priv->rate[id]; } int sandbox_clk_query_enable(struct udevice *dev, int id) { struct sandbox_clk_priv *priv = dev_get_priv(dev); if (id < 0 || id >= SANDBOX_CLK_ID_COUNT) return -EINVAL; return priv->enabled[id]; } |