drivers/clk/clk_sandbox.c

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