1 #include <linux/types.h>
2 #include <linux/init.h>
3 #include <linux/delay.h>
4 #include <linux/kernel.h>
5 #include <linux/interrupt.h>
6 #include <linux/spinlock.h>
7 #include <linux/of_irq.h>
8 
9 #include <asm/pmac_feature.h>
10 #include <asm/pmac_pfunc.h>
11 
12 #undef DEBUG
13 #ifdef DEBUG
14 #define DBG(fmt...)	printk(fmt)
15 #else
16 #define DBG(fmt...)
17 #endif
18 
19 static irqreturn_t macio_gpio_irq(int irq, void *data)
20 {
21 	pmf_do_irq(data);
22 
23 	return IRQ_HANDLED;
24 }
25 
26 static int macio_do_gpio_irq_enable(struct pmf_function *func)
27 {
28 	unsigned int irq = irq_of_parse_and_map(func->node, 0);
29 	if (irq == NO_IRQ)
30 		return -EINVAL;
31 	return request_irq(irq, macio_gpio_irq, 0, func->node->name, func);
32 }
33 
34 static int macio_do_gpio_irq_disable(struct pmf_function *func)
35 {
36 	unsigned int irq = irq_of_parse_and_map(func->node, 0);
37 	if (irq == NO_IRQ)
38 		return -EINVAL;
39 	free_irq(irq, func);
40 	return 0;
41 }
42 
43 static int macio_do_gpio_write(PMF_STD_ARGS, u8 value, u8 mask)
44 {
45 	u8 __iomem *addr = (u8 __iomem *)func->driver_data;
46 	unsigned long flags;
47 	u8 tmp;
48 
49 	/* Check polarity */
50 	if (args && args->count && !args->u[0].v)
51 		value = ~value;
52 
53 	/* Toggle the GPIO */
54 	raw_spin_lock_irqsave(&feature_lock, flags);
55 	tmp = readb(addr);
56 	tmp = (tmp & ~mask) | (value & mask);
57 	DBG("Do write 0x%02x to GPIO %s (%p)\n",
58 	    tmp, func->node->full_name, addr);
59 	writeb(tmp, addr);
60 	raw_spin_unlock_irqrestore(&feature_lock, flags);
61 
62 	return 0;
63 }
64 
65 static int macio_do_gpio_read(PMF_STD_ARGS, u8 mask, int rshift, u8 xor)
66 {
67 	u8 __iomem *addr = (u8 __iomem *)func->driver_data;
68 	u32 value;
69 
70 	/* Check if we have room for reply */
71 	if (args == NULL || args->count == 0 || args->u[0].p == NULL)
72 		return -EINVAL;
73 
74 	value = readb(addr);
75 	*args->u[0].p = ((value & mask) >> rshift) ^ xor;
76 
77 	return 0;
78 }
79 
80 static int macio_do_delay(PMF_STD_ARGS, u32 duration)
81 {
82 	/* assume we can sleep ! */
83 	msleep((duration + 999) / 1000);
84 	return 0;
85 }
86 
87 static struct pmf_handlers macio_gpio_handlers = {
88 	.irq_enable	= macio_do_gpio_irq_enable,
89 	.irq_disable	= macio_do_gpio_irq_disable,
90 	.write_gpio	= macio_do_gpio_write,
91 	.read_gpio	= macio_do_gpio_read,
92 	.delay		= macio_do_delay,
93 };
94 
95 static void macio_gpio_init_one(struct macio_chip *macio)
96 {
97 	struct device_node *gparent, *gp;
98 
99 	/*
100 	 * Find the "gpio" parent node
101 	 */
102 
103 	for (gparent = NULL;
104 	     (gparent = of_get_next_child(macio->of_node, gparent)) != NULL;)
105 		if (strcmp(gparent->name, "gpio") == 0)
106 			break;
107 	if (gparent == NULL)
108 		return;
109 
110 	DBG("Installing GPIO functions for macio %s\n",
111 	    macio->of_node->full_name);
112 
113 	/*
114 	 * Ok, got one, we dont need anything special to track them down, so
115 	 * we just create them all
116 	 */
117 	for (gp = NULL; (gp = of_get_next_child(gparent, gp)) != NULL;) {
118 		const u32 *reg = of_get_property(gp, "reg", NULL);
119 		unsigned long offset;
120 		if (reg == NULL)
121 			continue;
122 		offset = *reg;
123 		/* Deal with old style device-tree. We can safely hard code the
124 		 * offset for now too even if it's a bit gross ...
125 		 */
126 		if (offset < 0x50)
127 			offset += 0x50;
128 		offset += (unsigned long)macio->base;
129 		pmf_register_driver(gp, &macio_gpio_handlers, (void *)offset);
130 	}
131 
132 	DBG("Calling initial GPIO functions for macio %s\n",
133 	    macio->of_node->full_name);
134 
135 	/* And now we run all the init ones */
136 	for (gp = NULL; (gp = of_get_next_child(gparent, gp)) != NULL;)
137 		pmf_do_functions(gp, NULL, 0, PMF_FLAGS_ON_INIT, NULL);
138 
139 	/* Note: We do not at this point implement the "at sleep" or "at wake"
140 	 * functions. I yet to find any for GPIOs anyway
141 	 */
142 }
143 
144 static int macio_do_write_reg32(PMF_STD_ARGS, u32 offset, u32 value, u32 mask)
145 {
146 	struct macio_chip *macio = func->driver_data;
147 	unsigned long flags;
148 
149 	raw_spin_lock_irqsave(&feature_lock, flags);
150 	MACIO_OUT32(offset, (MACIO_IN32(offset) & ~mask) | (value & mask));
151 	raw_spin_unlock_irqrestore(&feature_lock, flags);
152 	return 0;
153 }
154 
155 static int macio_do_read_reg32(PMF_STD_ARGS, u32 offset)
156 {
157 	struct macio_chip *macio = func->driver_data;
158 
159 	/* Check if we have room for reply */
160 	if (args == NULL || args->count == 0 || args->u[0].p == NULL)
161 		return -EINVAL;
162 
163 	*args->u[0].p = MACIO_IN32(offset);
164 	return 0;
165 }
166 
167 static int macio_do_write_reg8(PMF_STD_ARGS, u32 offset, u8 value, u8 mask)
168 {
169 	struct macio_chip *macio = func->driver_data;
170 	unsigned long flags;
171 
172 	raw_spin_lock_irqsave(&feature_lock, flags);
173 	MACIO_OUT8(offset, (MACIO_IN8(offset) & ~mask) | (value & mask));
174 	raw_spin_unlock_irqrestore(&feature_lock, flags);
175 	return 0;
176 }
177 
178 static int macio_do_read_reg8(PMF_STD_ARGS, u32 offset)
179 {
180 	struct macio_chip *macio = func->driver_data;
181 
182 	/* Check if we have room for reply */
183 	if (args == NULL || args->count == 0 || args->u[0].p == NULL)
184 		return -EINVAL;
185 
186 	*((u8 *)(args->u[0].p)) = MACIO_IN8(offset);
187 	return 0;
188 }
189 
190 static int macio_do_read_reg32_msrx(PMF_STD_ARGS, u32 offset, u32 mask,
191 				    u32 shift, u32 xor)
192 {
193 	struct macio_chip *macio = func->driver_data;
194 
195 	/* Check if we have room for reply */
196 	if (args == NULL || args->count == 0 || args->u[0].p == NULL)
197 		return -EINVAL;
198 
199 	*args->u[0].p = ((MACIO_IN32(offset) & mask) >> shift) ^ xor;
200 	return 0;
201 }
202 
203 static int macio_do_read_reg8_msrx(PMF_STD_ARGS, u32 offset, u32 mask,
204 				   u32 shift, u32 xor)
205 {
206 	struct macio_chip *macio = func->driver_data;
207 
208 	/* Check if we have room for reply */
209 	if (args == NULL || args->count == 0 || args->u[0].p == NULL)
210 		return -EINVAL;
211 
212 	*((u8 *)(args->u[0].p)) = ((MACIO_IN8(offset) & mask) >> shift) ^ xor;
213 	return 0;
214 }
215 
216 static int macio_do_write_reg32_slm(PMF_STD_ARGS, u32 offset, u32 shift,
217 				    u32 mask)
218 {
219 	struct macio_chip *macio = func->driver_data;
220 	unsigned long flags;
221 	u32 tmp, val;
222 
223 	/* Check args */
224 	if (args == NULL || args->count == 0)
225 		return -EINVAL;
226 
227 	raw_spin_lock_irqsave(&feature_lock, flags);
228 	tmp = MACIO_IN32(offset);
229 	val = args->u[0].v << shift;
230 	tmp = (tmp & ~mask) | (val & mask);
231 	MACIO_OUT32(offset, tmp);
232 	raw_spin_unlock_irqrestore(&feature_lock, flags);
233 	return 0;
234 }
235 
236 static int macio_do_write_reg8_slm(PMF_STD_ARGS, u32 offset, u32 shift,
237 				   u32 mask)
238 {
239 	struct macio_chip *macio = func->driver_data;
240 	unsigned long flags;
241 	u32 tmp, val;
242 
243 	/* Check args */
244 	if (args == NULL || args->count == 0)
245 		return -EINVAL;
246 
247 	raw_spin_lock_irqsave(&feature_lock, flags);
248 	tmp = MACIO_IN8(offset);
249 	val = args->u[0].v << shift;
250 	tmp = (tmp & ~mask) | (val & mask);
251 	MACIO_OUT8(offset, tmp);
252 	raw_spin_unlock_irqrestore(&feature_lock, flags);
253 	return 0;
254 }
255 
256 static struct pmf_handlers macio_mmio_handlers = {
257 	.write_reg32		= macio_do_write_reg32,
258 	.read_reg32		= macio_do_read_reg32,
259 	.write_reg8		= macio_do_write_reg8,
260 	.read_reg8		= macio_do_read_reg8,
261 	.read_reg32_msrx	= macio_do_read_reg32_msrx,
262 	.read_reg8_msrx		= macio_do_read_reg8_msrx,
263 	.write_reg32_slm	= macio_do_write_reg32_slm,
264 	.write_reg8_slm		= macio_do_write_reg8_slm,
265 	.delay			= macio_do_delay,
266 };
267 
268 static void macio_mmio_init_one(struct macio_chip *macio)
269 {
270 	DBG("Installing MMIO functions for macio %s\n",
271 	    macio->of_node->full_name);
272 
273 	pmf_register_driver(macio->of_node, &macio_mmio_handlers, macio);
274 }
275 
276 static struct device_node *unin_hwclock;
277 
278 static int unin_do_write_reg32(PMF_STD_ARGS, u32 offset, u32 value, u32 mask)
279 {
280 	unsigned long flags;
281 
282 	raw_spin_lock_irqsave(&feature_lock, flags);
283 	/* This is fairly bogus in darwin, but it should work for our needs
284 	 * implemeted that way:
285 	 */
286 	UN_OUT(offset, (UN_IN(offset) & ~mask) | (value & mask));
287 	raw_spin_unlock_irqrestore(&feature_lock, flags);
288 	return 0;
289 }
290 
291 
292 static struct pmf_handlers unin_mmio_handlers = {
293 	.write_reg32		= unin_do_write_reg32,
294 	.delay			= macio_do_delay,
295 };
296 
297 static void uninorth_install_pfunc(void)
298 {
299 	struct device_node *np;
300 
301 	DBG("Installing functions for UniN %s\n",
302 	    uninorth_node->full_name);
303 
304 	/*
305 	 * Install handlers for the bridge itself
306 	 */
307 	pmf_register_driver(uninorth_node, &unin_mmio_handlers, NULL);
308 	pmf_do_functions(uninorth_node, NULL, 0, PMF_FLAGS_ON_INIT, NULL);
309 
310 
311 	/*
312 	 * Install handlers for the hwclock child if any
313 	 */
314 	for (np = NULL; (np = of_get_next_child(uninorth_node, np)) != NULL;)
315 		if (strcmp(np->name, "hw-clock") == 0) {
316 			unin_hwclock = np;
317 			break;
318 		}
319 	if (unin_hwclock) {
320 		DBG("Installing functions for UniN clock %s\n",
321 		    unin_hwclock->full_name);
322 		pmf_register_driver(unin_hwclock, &unin_mmio_handlers, NULL);
323 		pmf_do_functions(unin_hwclock, NULL, 0, PMF_FLAGS_ON_INIT,
324 				 NULL);
325 	}
326 }
327 
328 /* We export this as the SMP code might init us early */
329 int __init pmac_pfunc_base_install(void)
330 {
331 	static int pfbase_inited;
332 	int i;
333 
334 	if (pfbase_inited)
335 		return 0;
336 	pfbase_inited = 1;
337 
338 	if (!machine_is(powermac))
339 		return 0;
340 
341 	DBG("Installing base platform functions...\n");
342 
343 	/*
344 	 * Locate mac-io chips and install handlers
345 	 */
346 	for (i = 0 ; i < MAX_MACIO_CHIPS; i++) {
347 		if (macio_chips[i].of_node) {
348 			macio_mmio_init_one(&macio_chips[i]);
349 			macio_gpio_init_one(&macio_chips[i]);
350 		}
351 	}
352 
353 	/*
354 	 * Install handlers for northbridge and direct mapped hwclock
355 	 * if any. We do not implement the config space access callback
356 	 * which is only ever used for functions that we do not call in
357 	 * the current driver (enabling/disabling cells in U2, mostly used
358 	 * to restore the PCI settings, we do that differently)
359 	 */
360 	if (uninorth_node && uninorth_base)
361 		uninorth_install_pfunc();
362 
363 	DBG("All base functions installed\n");
364 
365 	return 0;
366 }
367 machine_arch_initcall(powermac, pmac_pfunc_base_install);
368 
369 #ifdef CONFIG_PM
370 
371 /* Those can be called by pmac_feature. Ultimately, I should use a sysdev
372  * or a device, but for now, that's good enough until I sort out some
373  * ordering issues. Also, we do not bother with GPIOs, as so far I yet have
374  * to see a case where a GPIO function has the on-suspend or on-resume bit
375  */
376 void pmac_pfunc_base_suspend(void)
377 {
378 	int i;
379 
380 	for (i = 0 ; i < MAX_MACIO_CHIPS; i++) {
381 		if (macio_chips[i].of_node)
382 			pmf_do_functions(macio_chips[i].of_node, NULL, 0,
383 					 PMF_FLAGS_ON_SLEEP, NULL);
384 	}
385 	if (uninorth_node)
386 		pmf_do_functions(uninorth_node, NULL, 0,
387 				 PMF_FLAGS_ON_SLEEP, NULL);
388 	if (unin_hwclock)
389 		pmf_do_functions(unin_hwclock, NULL, 0,
390 				 PMF_FLAGS_ON_SLEEP, NULL);
391 }
392 
393 void pmac_pfunc_base_resume(void)
394 {
395 	int i;
396 
397 	if (unin_hwclock)
398 		pmf_do_functions(unin_hwclock, NULL, 0,
399 				 PMF_FLAGS_ON_WAKE, NULL);
400 	if (uninorth_node)
401 		pmf_do_functions(uninorth_node, NULL, 0,
402 				 PMF_FLAGS_ON_WAKE, NULL);
403 	for (i = 0 ; i < MAX_MACIO_CHIPS; i++) {
404 		if (macio_chips[i].of_node)
405 			pmf_do_functions(macio_chips[i].of_node, NULL, 0,
406 					 PMF_FLAGS_ON_WAKE, NULL);
407 	}
408 }
409 
410 #endif /* CONFIG_PM */
411