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
49 static DEFINE_MUTEX(mfp_mutex);
50
mfp_set_groupf(struct device * dev)51 void 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 }
73 EXPORT_SYMBOL(mfp_set_groupf);
74
mfp_set_groupc(struct device * dev)75 void 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 }
103 EXPORT_SYMBOL(mfp_set_groupc);
104
mfp_set_groupi(struct device * dev)105 void 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 }
131 EXPORT_SYMBOL(mfp_set_groupi);
132
mfp_set_groupg(struct device * dev,const char * subname)133 void 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 }
172 EXPORT_SYMBOL(mfp_set_groupg);
173
mfp_set_groupd(struct device * dev,const char * subname)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);
201