[linux-2.6-block.git] / arch / arm / mach-w90x900 / mfp.c

/*
 * linux/arch/arm/mach-w90x900/mfp.c
 *
 * Copyright (c) 2008 Nuvoton technology corporation
 *
 * Wan ZongShun <mcuos.com@gmail.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation;version 2 of the License.
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/device.h>
#include <linux/list.h>
#include <linux/errno.h>
#include <linux/err.h>
#include <linux/string.h>
#include <linux/clk.h>
#include <linux/mutex.h>
#include <linux/io.h>

#include <mach/hardware.h>

#define REG_MFSEL	(W90X900_VA_GCR + 0xC)

#define GPSELF		(0x01 << 1)
#define GPSELC		(0x03 << 2)
#define GPSELD		(0x0f << 4)

#define GPSELEI0	(0x01 << 26)
#define GPSELEI1	(0x01 << 27)

#define GPIOG0TO1	(0x03 << 14)
#define GPIOG2TO3	(0x03 << 16)
#define GPIOG22TO23	(0x03 << 22)
#define GPIOG18TO20	(0x07 << 18)

#define ENSPI		(0x0a << 14)
#define ENI2C0		(0x01 << 14)
#define ENI2C1		(0x01 << 16)
#define ENAC97		(0x02 << 22)
#define ENSD1		(0x02 << 18)
#define ENSD0		(0x0a << 4)
#define ENKPI		(0x02 << 2)
#define ENNAND		(0x01 << 2)

static DEFINE_MUTEX(mfp_mutex);

void mfp_set_groupf(struct device *dev)
{
	unsigned long mfpen;
	const char *dev_id;

	BUG_ON(!dev);

	mutex_lock(&mfp_mutex);

	dev_id = dev_name(dev);

	mfpen = __raw_readl(REG_MFSEL);

	if (strcmp(dev_id, "nuc900-emc") == 0)
		mfpen |= GPSELF;/*enable mac*/
	else
		mfpen &= ~GPSELF;/*GPIOF[9:0]*/

	__raw_writel(mfpen, REG_MFSEL);

	mutex_unlock(&mfp_mutex);
}
EXPORT_SYMBOL(mfp_set_groupf);

void mfp_set_groupc(struct device *dev)
{
	unsigned long mfpen;
	const char *dev_id;

	BUG_ON(!dev);

	mutex_lock(&mfp_mutex);

	dev_id = dev_name(dev);

	mfpen = __raw_readl(REG_MFSEL);

	if (strcmp(dev_id, "nuc900-lcd") == 0)
		mfpen |= GPSELC;/*enable lcd*/
	else if (strcmp(dev_id, "nuc900-kpi") == 0) {
		mfpen &= (~GPSELC);/*enable kpi*/
		mfpen |= ENKPI;
	} else if (strcmp(dev_id, "nuc900-nand") == 0) {
		mfpen &= (~GPSELC);/*enable nand*/
		mfpen |= ENNAND;
	} else
		mfpen &= (~GPSELC);/*GPIOC[14:0]*/

	__raw_writel(mfpen, REG_MFSEL);

	mutex_unlock(&mfp_mutex);
}
EXPORT_SYMBOL(mfp_set_groupc);

void mfp_set_groupi(struct device *dev)
{
	unsigned long mfpen;
	const char *dev_id;

	BUG_ON(!dev);

	mutex_lock(&mfp_mutex);

	dev_id = dev_name(dev);

	mfpen = __raw_readl(REG_MFSEL);

	mfpen &= ~GPSELEI1;/*default gpio16*/

	if (strcmp(dev_id, "nuc900-wdog") == 0)
		mfpen |= GPSELEI1;/*enable wdog*/
	else if (strcmp(dev_id, "nuc900-atapi") == 0)
		mfpen |= GPSELEI0;/*enable atapi*/
	else if (strcmp(dev_id, "nuc900-keypad") == 0)
		mfpen &= ~GPSELEI0;/*enable keypad*/

	__raw_writel(mfpen, REG_MFSEL);

	mutex_unlock(&mfp_mutex);
}
EXPORT_SYMBOL(mfp_set_groupi);

void mfp_set_groupg(struct device *dev, const char *subname)
{
	unsigned long mfpen;
	const char *dev_id;

	BUG_ON((!dev) && (!subname));

	mutex_lock(&mfp_mutex);

	if (subname != NULL)
		dev_id = subname;
	else
		dev_id = dev_name(dev);

	mfpen = __raw_readl(REG_MFSEL);

	if (strcmp(dev_id, "nuc900-spi") == 0) {
		mfpen &= ~(GPIOG0TO1 | GPIOG2TO3);
		mfpen |= ENSPI;/*enable spi*/
	} else if (strcmp(dev_id, "nuc900-i2c0") == 0) {
		mfpen &= ~(GPIOG0TO1);
		mfpen |= ENI2C0;/*enable i2c0*/
	} else if (strcmp(dev_id, "nuc900-i2c1") == 0) {
		mfpen &= ~(GPIOG2TO3);
		mfpen |= ENI2C1;/*enable i2c1*/
	} else if (strcmp(dev_id, "nuc900-ac97") == 0) {
		mfpen &= ~(GPIOG22TO23);
		mfpen |= ENAC97;/*enable AC97*/
	} else if (strcmp(dev_id, "nuc900-mmc-port1") == 0) {
		mfpen &= ~(GPIOG18TO20);
		mfpen |= (ENSD1 | 0x01);/*enable sd1*/
	} else {
		mfpen &= ~(GPIOG0TO1 | GPIOG2TO3);/*GPIOG[3:0]*/
	}

	__raw_writel(mfpen, REG_MFSEL);

	mutex_unlock(&mfp_mutex);
}
EXPORT_SYMBOL(mfp_set_groupg);

void mfp_set_groupd(struct device *dev, const char *subname)
{
	unsigned long mfpen;
	const char *dev_id;

	BUG_ON((!dev) && (!subname));

	mutex_lock(&mfp_mutex);

	if (subname != NULL)
		dev_id = subname;
	else
		dev_id = dev_name(dev);

	mfpen = __raw_readl(REG_MFSEL);

	if (strcmp(dev_id, "nuc900-mmc-port0") == 0) {
		mfpen &= ~GPSELD;/*enable sd0*/
		mfpen |= ENSD0;
	} else
		mfpen &= (~GPSELD);

	__raw_writel(mfpen, REG_MFSEL);

	mutex_unlock(&mfp_mutex);
}
EXPORT_SYMBOL(mfp_set_groupd);
Commit	Line	Data
27eb9758	1	/*
35c9221a	2	* linux/arch/arm/mach-w90x900/mfp.c
27eb9758	3	*
	4	* Copyright (c) 2008 Nuvoton technology corporation
	5	*
	6	* Wan ZongShun <mcuos.com@gmail.com>
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License as published by
	10	* the Free Software Foundation;version 2 of the License.
	11	*/
	12
	13	#include <linux/module.h>
	14	#include <linux/kernel.h>
	15	#include <linux/device.h>
	16	#include <linux/list.h>
	17	#include <linux/errno.h>
	18	#include <linux/err.h>
	19	#include <linux/string.h>
	20	#include <linux/clk.h>
	21	#include <linux/mutex.h>
	22	#include <linux/io.h>
	23
	24	#include <mach/hardware.h>
	25
	26	#define REG_MFSEL (W90X900_VA_GCR + 0xC)
	27
	28	#define GPSELF (0x01 << 1)
27eb9758	29	#define GPSELC (0x03 << 2)
798681bf	30	#define GPSELD (0x0f << 4)
27eb9758	31
	32	#define GPSELEI0 (0x01 << 26)
	33	#define GPSELEI1 (0x01 << 27)
	34
3f3f1d9d	35	#define GPIOG0TO1 (0x03 << 14)
3f3f1d9d	36	#define GPIOG2TO3 (0x03 << 16)
3d34a0d8	37	#define GPIOG22TO23 (0x03 << 22)
798681bf	38	#define GPIOG18TO20 (0x07 << 18)
3d34a0d8	39
3f3f1d9d	40	#define ENSPI (0x0a << 14)
	41	#define ENI2C0 (0x01 << 14)
	42	#define ENI2C1 (0x01 << 16)
3d34a0d8	43	#define ENAC97 (0x02 << 22)
798681bf	44	#define ENSD1 (0x02 << 18)
	45	#define ENSD0 (0x0a << 4)
	46	#define ENKPI (0x02 << 2)
	47	#define ENNAND (0x01 << 2)
3f3f1d9d	48
f346becf	49	static DEFINE_MUTEX(mfp_mutex);
27eb9758	50
	51	void mfp_set_groupf(struct device *dev)
	52	{
	53	unsigned long mfpen;
	54	const char *dev_id;
	55
	56	BUG_ON(!dev);
	57
f346becf	58	mutex_lock(&mfp_mutex);
27eb9758	59
	60	dev_id = dev_name(dev);
	61
	62	mfpen = __raw_readl(REG_MFSEL);
	63
35c9221a	64	if (strcmp(dev_id, "nuc900-emc") == 0)
27eb9758	65	mfpen \|= GPSELF;/enable mac/
	66	else
	67	mfpen &= ~GPSELF;/GPIOF[9:0]/
	68
	69	__raw_writel(mfpen, REG_MFSEL);
	70
f346becf	71	mutex_unlock(&mfp_mutex);
27eb9758	72	}
	73	EXPORT_SYMBOL(mfp_set_groupf);
	74
	75	void mfp_set_groupc(struct device *dev)
	76	{
	77	unsigned long mfpen;
	78	const char *dev_id;
	79
	80	BUG_ON(!dev);
	81
f346becf	82	mutex_lock(&mfp_mutex);
27eb9758	83
	84	dev_id = dev_name(dev);
	85
	86	mfpen = __raw_readl(REG_MFSEL);
	87
35c9221a	88	if (strcmp(dev_id, "nuc900-lcd") == 0)
27eb9758	89	mfpen \|= GPSELC;/enable lcd/
35c9221a	90	else if (strcmp(dev_id, "nuc900-kpi") == 0) {
	91	mfpen &= (~GPSELC);/enable kpi/
	92	mfpen \|= ENKPI;
	93	} else if (strcmp(dev_id, "nuc900-nand") == 0) {
	94	mfpen &= (~GPSELC);/enable nand/
	95	mfpen \|= ENNAND;
	96	} else
	97	mfpen &= (~GPSELC);/GPIOC[14:0]/
27eb9758	98
	99	__raw_writel(mfpen, REG_MFSEL);
	100
f346becf	101	mutex_unlock(&mfp_mutex);
27eb9758	102	}
	103	EXPORT_SYMBOL(mfp_set_groupc);
	104
0abe1856	105	void mfp_set_groupi(struct device *dev)
27eb9758	106	{
	107	unsigned long mfpen;
	108	const char *dev_id;
	109
	110	BUG_ON(!dev);
	111
f346becf	112	mutex_lock(&mfp_mutex);
27eb9758	113
	114	dev_id = dev_name(dev);
	115
	116	mfpen = __raw_readl(REG_MFSEL);
	117
0abe1856	118	mfpen &= ~GPSELEI1;/default gpio16/
0abe1856	119
35c9221a	120	if (strcmp(dev_id, "nuc900-wdog") == 0)
27eb9758	121	mfpen \|= GPSELEI1;/enable wdog/
35c9221a	122	else if (strcmp(dev_id, "nuc900-atapi") == 0)
	123	mfpen \|= GPSELEI0;/enable atapi/
	124	else if (strcmp(dev_id, "nuc900-keypad") == 0)
	125	mfpen &= ~GPSELEI0;/enable keypad/
27eb9758	126
	127	__raw_writel(mfpen, REG_MFSEL);
	128
f346becf	129	mutex_unlock(&mfp_mutex);
27eb9758	130	}
	131	EXPORT_SYMBOL(mfp_set_groupi);
	132
798681bf	133	void mfp_set_groupg(struct device dev, const char subname)
3f3f1d9d	134	{
	135	unsigned long mfpen;
	136	const char *dev_id;
	137
798681bf	138	BUG_ON((!dev) && (!subname));
3f3f1d9d	139
f346becf	140	mutex_lock(&mfp_mutex);
3f3f1d9d	141
798681bf	142	if (subname != NULL)
	143	dev_id = subname;
	144	else
	145	dev_id = dev_name(dev);
3f3f1d9d	146
	147	mfpen = __raw_readl(REG_MFSEL);
	148
35c9221a	149	if (strcmp(dev_id, "nuc900-spi") == 0) {
3f3f1d9d	150	mfpen &= ~(GPIOG0TO1 \| GPIOG2TO3);
3f3f1d9d	151	mfpen \|= ENSPI;/enable spi/
35c9221a	152	} else if (strcmp(dev_id, "nuc900-i2c0") == 0) {
3f3f1d9d	153	mfpen &= ~(GPIOG0TO1);
3f3f1d9d	154	mfpen \|= ENI2C0;/enable i2c0/
35c9221a	155	} else if (strcmp(dev_id, "nuc900-i2c1") == 0) {
3f3f1d9d	156	mfpen &= ~(GPIOG2TO3);
3f3f1d9d	157	mfpen \|= ENI2C1;/enable i2c1/
e37051dc	158	} else if (strcmp(dev_id, "nuc900-ac97") == 0) {
3d34a0d8	159	mfpen &= ~(GPIOG22TO23);
3d34a0d8	160	mfpen \|= ENAC97;/enable AC97/
798681bf	161	} else if (strcmp(dev_id, "nuc900-mmc-port1") == 0) {
	162	mfpen &= ~(GPIOG18TO20);
	163	mfpen \|= (ENSD1 \| 0x01);/enable sd1/
3f3f1d9d	164	} else {
	165	mfpen &= ~(GPIOG0TO1 \| GPIOG2TO3);/GPIOG[3:0]/
	166	}
	167
	168	__raw_writel(mfpen, REG_MFSEL);
	169
f346becf	170	mutex_unlock(&mfp_mutex);
3f3f1d9d	171	}
	172	EXPORT_SYMBOL(mfp_set_groupg);
	173
798681bf	174	void mfp_set_groupd(struct device dev, const char subname)
	175	{
	176	unsigned long mfpen;
	177	const char *dev_id;
	178
	179	BUG_ON((!dev) && (!subname));
	180
	181	mutex_lock(&mfp_mutex);
	182
	183	if (subname != NULL)
	184	dev_id = subname;
	185	else
	186	dev_id = dev_name(dev);
	187
	188	mfpen = __raw_readl(REG_MFSEL);
	189
	190	if (strcmp(dev_id, "nuc900-mmc-port0") == 0) {
	191	mfpen &= ~GPSELD;/enable sd0/
	192	mfpen \|= ENSD0;
	193	} else
	194	mfpen &= (~GPSELD);
	195
	196	__raw_writel(mfpen, REG_MFSEL);
	197
	198	mutex_unlock(&mfp_mutex);
	199	}
	200	EXPORT_SYMBOL(mfp_set_groupd);