[mirror_ubuntu-artful-kernel.git] / arch / arm / mach-lh7a40x / clocks.c

/* arch/arm/mach-lh7a40x/clocks.c
 *
 *  Copyright (C) 2004 Marc Singer
 *
 *  This program is free software; you can redistribute it and/or
 *  modify it under the terms of the GNU General Public License
 *  version 2 as published by the Free Software Foundation.
 *
 */
#include <mach/hardware.h>
#include <mach/clocks.h>
#include <linux/err.h>
#include <linux/device.h>
#include <linux/string.h>

struct module;

struct clk {
	struct list_head node;
	unsigned long rate;
	struct module *owner;
	const char *name;
};

/* ----- */

#define MAINDIV1(c)	(((c) >>  7) & 0x0f)
#define MAINDIV2(c)	(((c) >> 11) & 0x1f)
#define PS(c)		(((c) >> 18) & 0x03)
#define PREDIV(c)	(((c) >>  2) & 0x1f)
#define HCLKDIV(c)	(((c) >>  0) & 0x02)
#define PCLKDIV(c)	(((c) >> 16) & 0x03)

unsigned int fclkfreq_get (void)
{
	unsigned int clkset = CSC_CLKSET;
	unsigned int gclk
		= XTAL_IN
		/ (1 << PS(clkset))
		* (MAINDIV1(clkset) + 2)
		/ (PREDIV(clkset)   + 2)
		* (MAINDIV2(clkset) + 2)
		;
	return gclk;
}

unsigned int hclkfreq_get (void)
{
	unsigned int clkset = CSC_CLKSET;
	unsigned int hclk = fclkfreq_get () / (HCLKDIV(clkset) + 1);

	return hclk;
}

unsigned int pclkfreq_get (void)
{
	unsigned int clkset = CSC_CLKSET;
	int pclkdiv = PCLKDIV(clkset);
	unsigned int pclk;
	if (pclkdiv == 0x3)
		pclkdiv = 0x2;
	pclk = hclkfreq_get () / (1 << pclkdiv);

	return pclk;
}

/* ----- */

struct clk *clk_get (struct device *dev, const char *id)
{
	return dev && strcmp(dev_name(dev), "cldc-lh7a40x") == 0
		 ? NULL : ERR_PTR(-ENOENT);
}
EXPORT_SYMBOL(clk_get);

void clk_put (struct clk *clk)
{
}
EXPORT_SYMBOL(clk_put);

int clk_enable (struct clk *clk)
{
	return 0;
}
EXPORT_SYMBOL(clk_enable);

void clk_disable (struct clk *clk)
{
}
EXPORT_SYMBOL(clk_disable);

unsigned long clk_get_rate (struct clk *clk)
{
	return 0;
}
EXPORT_SYMBOL(clk_get_rate);

long clk_round_rate (struct clk *clk, unsigned long rate)
{
	return rate;
}
EXPORT_SYMBOL(clk_round_rate);

int clk_set_rate (struct clk *clk, unsigned long rate)
{
	return -EIO;
}
EXPORT_SYMBOL(clk_set_rate);
Commit	Line	Data
638b2666 MS	1	/* arch/arm/mach-lh7a40x/clocks.c
	2	*
	3	* Copyright (C) 2004 Marc Singer
	4	*
	5	* This program is free software; you can redistribute it and/or
	6	* modify it under the terms of the GNU General Public License
	7	* version 2 as published by the Free Software Foundation.
	8	*
	9	*/
a09e64fb RK	10	#include <mach/hardware.h>
a09e64fb RK	11	#include <mach/clocks.h>
638b2666	12	#include <linux/err.h>
657b366a PH	13	#include <linux/device.h>
657b366a PH	14	#include <linux/string.h>
638b2666 MS	15
638b2666 MS	16	struct module;
638b2666 MS	17
	18	struct clk {
	19	struct list_head node;
	20	unsigned long rate;
	21	struct module *owner;
	22	const char *name;
638b2666 MS	23	};
638b2666 MS	24
638b2666 MS	25	/* ----- */
	26
	27	#define MAINDIV1(c) (((c) >> 7) & 0x0f)
	28	#define MAINDIV2(c) (((c) >> 11) & 0x1f)
	29	#define PS(c) (((c) >> 18) & 0x03)
	30	#define PREDIV(c) (((c) >> 2) & 0x1f)
	31	#define HCLKDIV(c) (((c) >> 0) & 0x02)
	32	#define PCLKDIV(c) (((c) >> 16) & 0x03)
	33
638b2666 MS	34	unsigned int fclkfreq_get (void)
	35	{
	36	unsigned int clkset = CSC_CLKSET;
	37	unsigned int gclk
	38	= XTAL_IN
	39	/ (1 << PS(clkset))
	40	* (MAINDIV1(clkset) + 2)
	41	/ (PREDIV(clkset) + 2)
	42	* (MAINDIV2(clkset) + 2)
	43	;
	44	return gclk;
	45	}
	46
	47	unsigned int hclkfreq_get (void)
	48	{
	49	unsigned int clkset = CSC_CLKSET;
	50	unsigned int hclk = fclkfreq_get () / (HCLKDIV(clkset) + 1);
	51
	52	return hclk;
	53	}
	54
	55	unsigned int pclkfreq_get (void)
	56	{
	57	unsigned int clkset = CSC_CLKSET;
	58	int pclkdiv = PCLKDIV(clkset);
	59	unsigned int pclk;
	60	if (pclkdiv == 0x3)
	61	pclkdiv = 0x2;
	62	pclk = hclkfreq_get () / (1 << pclkdiv);
	63
	64	return pclk;
	65	}
	66
	67	/* ----- */
	68
638b2666 MS	69	struct clk clk_get (struct device dev, const char *id)
638b2666 MS	70	{
80a5931b RK	71	return dev && strcmp(dev_name(dev), "cldc-lh7a40x") == 0
80a5931b RK	72	? NULL : ERR_PTR(-ENOENT);
638b2666 MS	73	}
	74	EXPORT_SYMBOL(clk_get);
	75
	76	void clk_put (struct clk *clk)
	77	{
638b2666 MS	78	}
	79	EXPORT_SYMBOL(clk_put);
	80
	81	int clk_enable (struct clk *clk)
	82	{
	83	return 0;
	84	}
	85	EXPORT_SYMBOL(clk_enable);
	86
	87	void clk_disable (struct clk *clk)
	88	{
	89	}
	90	EXPORT_SYMBOL(clk_disable);
	91
638b2666 MS	92	unsigned long clk_get_rate (struct clk *clk)
638b2666 MS	93	{
80a5931b	94	return 0;
638b2666 MS	95	}
	96	EXPORT_SYMBOL(clk_get_rate);
	97
	98	long clk_round_rate (struct clk *clk, unsigned long rate)
	99	{
	100	return rate;
	101	}
	102	EXPORT_SYMBOL(clk_round_rate);
	103
	104	int clk_set_rate (struct clk *clk, unsigned long rate)
	105	{
80a5931b	106	return -EIO;
638b2666 MS	107	}
638b2666 MS	108	EXPORT_SYMBOL(clk_set_rate);