[people/ms/u-boot.git] / drivers / clk / clk_sandbox.c

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