1/*
  2 * linux/arch/arm/mach-w90x900/mfp.c
  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)
 29#define GPSELC		(0x03 << 2)
 30#define GPSELD		(0x0f << 4)
 31
 32#define GPSELEI0	(0x01 << 26)
 33#define GPSELEI1	(0x01 << 27)
 34
 35#define GPIOG0TO1	(0x03 << 14)
 36#define GPIOG2TO3	(0x03 << 16)
 37#define GPIOG22TO23	(0x03 << 22)
 38#define GPIOG18TO20	(0x07 << 18)
 39
 40#define ENSPI		(0x0a << 14)
 41#define ENI2C0		(0x01 << 14)
 42#define ENI2C1		(0x01 << 16)
 43#define ENAC97		(0x02 << 22)
 44#define ENSD1		(0x02 << 18)
 45#define ENSD0		(0x0a << 4)
 46#define ENKPI		(0x02 << 2)
 47#define ENNAND		(0x01 << 2)
 48
 49static DEFINE_MUTEX(mfp_mutex);
 50
 51void mfp_set_groupf(struct device *dev)
 52{
 53	unsigned long mfpen;
 54	const char *dev_id;
 55
 56	BUG_ON(!dev);
 57
 58	mutex_lock(&mfp_mutex);
 59
 60	dev_id = dev_name(dev);
 61
 62	mfpen = __raw_readl(REG_MFSEL);
 63
 64	if (strcmp(dev_id, "nuc900-emc") == 0)
 65		mfpen |= GPSELF;/*enable mac*/
 66	else
 67		mfpen &= ~GPSELF;/*GPIOF[9:0]*/
 68
 69	__raw_writel(mfpen, REG_MFSEL);
 70
 71	mutex_unlock(&mfp_mutex);
 72}
 73EXPORT_SYMBOL(mfp_set_groupf);
 74
 75void mfp_set_groupc(struct device *dev)
 76{
 77	unsigned long mfpen;
 78	const char *dev_id;
 79
 80	BUG_ON(!dev);
 81
 82	mutex_lock(&mfp_mutex);
 83
 84	dev_id = dev_name(dev);
 85
 86	mfpen = __raw_readl(REG_MFSEL);
 87
 88	if (strcmp(dev_id, "nuc900-lcd") == 0)
 89		mfpen |= GPSELC;/*enable lcd*/
 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]*/
 98
 99	__raw_writel(mfpen, REG_MFSEL);
100
101	mutex_unlock(&mfp_mutex);
102}
103EXPORT_SYMBOL(mfp_set_groupc);
104
105void mfp_set_groupi(struct device *dev)
106{
107	unsigned long mfpen;
108	const char *dev_id;
109
110	BUG_ON(!dev);
111
112	mutex_lock(&mfp_mutex);
113
114	dev_id = dev_name(dev);
115
116	mfpen = __raw_readl(REG_MFSEL);
117
118	mfpen &= ~GPSELEI1;/*default gpio16*/
119
120	if (strcmp(dev_id, "nuc900-wdog") == 0)
121		mfpen |= GPSELEI1;/*enable wdog*/
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*/
126
127	__raw_writel(mfpen, REG_MFSEL);
128
129	mutex_unlock(&mfp_mutex);
130}
131EXPORT_SYMBOL(mfp_set_groupi);
132
133void mfp_set_groupg(struct device *dev, const char *subname)
134{
135	unsigned long mfpen;
136	const char *dev_id;
137
138	BUG_ON((!dev) && (!subname));
139
140	mutex_lock(&mfp_mutex);
141
142	if (subname != NULL)
143		dev_id = subname;
144	else
145		dev_id = dev_name(dev);
146
147	mfpen = __raw_readl(REG_MFSEL);
148
149	if (strcmp(dev_id, "nuc900-spi") == 0) {
150		mfpen &= ~(GPIOG0TO1 | GPIOG2TO3);
151		mfpen |= ENSPI;/*enable spi*/
152	} else if (strcmp(dev_id, "nuc900-i2c0") == 0) {
153		mfpen &= ~(GPIOG0TO1);
154		mfpen |= ENI2C0;/*enable i2c0*/
155	} else if (strcmp(dev_id, "nuc900-i2c1") == 0) {
156		mfpen &= ~(GPIOG2TO3);
157		mfpen |= ENI2C1;/*enable i2c1*/
158	} else if (strcmp(dev_id, "nuc900-ac97") == 0) {
159		mfpen &= ~(GPIOG22TO23);
160		mfpen |= ENAC97;/*enable AC97*/
161	} else if (strcmp(dev_id, "nuc900-mmc-port1") == 0) {
162		mfpen &= ~(GPIOG18TO20);
163		mfpen |= (ENSD1 | 0x01);/*enable sd1*/
164	} else {
165		mfpen &= ~(GPIOG0TO1 | GPIOG2TO3);/*GPIOG[3:0]*/
166	}
167
168	__raw_writel(mfpen, REG_MFSEL);
169
170	mutex_unlock(&mfp_mutex);
171}
172EXPORT_SYMBOL(mfp_set_groupg);
173
174void 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}
200EXPORT_SYMBOL(mfp_set_groupd);