1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 *  Copyright (C) 1996-2001 Paul Mackerras (paulus@cs.anu.edu.au)
4 *                          Ben. Herrenschmidt (benh@kernel.crashing.org)
5 *
6 *  TODO:
7 *
8 *   - Replace mdelay with some schedule loop if possible
9 *   - Shorten some obfuscated delays on some routines (like modem
10 *     power)
11 *   - Refcount some clocks (see darwin)
12 *   - Split split split...
13 */
14#include <linux/types.h>
15#include <linux/init.h>
16#include <linux/delay.h>
17#include <linux/kernel.h>
18#include <linux/sched.h>
19#include <linux/of.h>
20#include <linux/of_address.h>
21#include <linux/spinlock.h>
22#include <linux/adb.h>
23#include <linux/pmu.h>
24#include <linux/ioport.h>
25#include <linux/export.h>
26#include <linux/pci.h>
27#include <asm/sections.h>
28#include <asm/errno.h>
29#include <asm/ohare.h>
30#include <asm/heathrow.h>
31#include <asm/keylargo.h>
32#include <asm/uninorth.h>
33#include <asm/io.h>
34#include <asm/machdep.h>
35#include <asm/pmac_feature.h>
36#include <asm/dbdma.h>
37#include <asm/pci-bridge.h>
38#include <asm/pmac_low_i2c.h>
39
40#include "pmac.h"
41
42#undef DEBUG_FEATURE
43
44#ifdef DEBUG_FEATURE
45#define DBG(fmt...) printk(KERN_DEBUG fmt)
46#else
47#define DBG(fmt...)
48#endif
49
50#ifdef CONFIG_PPC_BOOK3S_32
51extern int powersave_lowspeed;
52#endif
53
54extern int powersave_nap;
55extern struct device_node *k2_skiplist[2];
56
57/*
58 * We use a single global lock to protect accesses. Each driver has
59 * to take care of its own locking
60 */
61DEFINE_RAW_SPINLOCK(feature_lock);
62
63#define LOCK(flags)	raw_spin_lock_irqsave(&feature_lock, flags);
64#define UNLOCK(flags)	raw_spin_unlock_irqrestore(&feature_lock, flags);
65
66
67/*
68 * Instance of some macio stuffs
69 */
70struct macio_chip macio_chips[MAX_MACIO_CHIPS];
71
72struct macio_chip *macio_find(struct device_node *child, int type)
73{
74	while(child) {
75		int	i;
76
77		for (i=0; i < MAX_MACIO_CHIPS && macio_chips[i].of_node; i++)
78			if (child == macio_chips[i].of_node &&
79			    (!type || macio_chips[i].type == type))
80				return &macio_chips[i];
81		child = child->parent;
82	}
83	return NULL;
84}
85EXPORT_SYMBOL_GPL(macio_find);
86
87static const char *macio_names[] =
88{
89	"Unknown",
90	"Grand Central",
91	"OHare",
92	"OHareII",
93	"Heathrow",
94	"Gatwick",
95	"Paddington",
96	"Keylargo",
97	"Pangea",
98	"Intrepid",
99	"K2",
100	"Shasta",
101};
102
103
104struct device_node *uninorth_node;
105u32 __iomem *uninorth_base;
106
107static u32 uninorth_rev;
108static int uninorth_maj;
109static void __iomem *u3_ht_base;
110
111/*
112 * For each motherboard family, we have a table of functions pointers
113 * that handle the various features.
114 */
115
116typedef long (*feature_call)(struct device_node *node, long param, long value);
117
118struct feature_table_entry {
119	unsigned int	selector;
120	feature_call	function;
121};
122
123struct pmac_mb_def
124{
125	const char*			model_string;
126	const char*			model_name;
127	int				model_id;
128	struct feature_table_entry*	features;
129	unsigned long			board_flags;
130};
131static struct pmac_mb_def pmac_mb;
132
133/*
134 * Here are the chip specific feature functions
135 */
136
137#ifndef CONFIG_PPC64
138
139static int simple_feature_tweak(struct device_node *node, int type, int reg,
140				u32 mask, int value)
141{
142	struct macio_chip*	macio;
143	unsigned long		flags;
144
145	macio = macio_find(node, type);
146	if (!macio)
147		return -ENODEV;
148	LOCK(flags);
149	if (value)
150		MACIO_BIS(reg, mask);
151	else
152		MACIO_BIC(reg, mask);
153	(void)MACIO_IN32(reg);
154	UNLOCK(flags);
155
156	return 0;
157}
158
159static long ohare_htw_scc_enable(struct device_node *node, long param,
160				 long value)
161{
162	struct macio_chip*	macio;
163	unsigned long		chan_mask;
164	unsigned long		fcr;
165	unsigned long		flags;
166	int			htw, trans;
167	unsigned long		rmask;
168
169	macio = macio_find(node, 0);
170	if (!macio)
171		return -ENODEV;
172	if (of_node_name_eq(node, "ch-a"))
173		chan_mask = MACIO_FLAG_SCCA_ON;
174	else if (of_node_name_eq(node, "ch-b"))
175		chan_mask = MACIO_FLAG_SCCB_ON;
176	else
177		return -ENODEV;
178
179	htw = (macio->type == macio_heathrow || macio->type == macio_paddington
180		|| macio->type == macio_gatwick);
181	/* On these machines, the HRW_SCC_TRANS_EN_N bit mustn't be touched */
182	trans = (pmac_mb.model_id != PMAC_TYPE_YOSEMITE &&
183		 pmac_mb.model_id != PMAC_TYPE_YIKES);
184	if (value) {
185#ifdef CONFIG_ADB_PMU
186		if ((param & 0xfff) == PMAC_SCC_IRDA)
187			pmu_enable_irled(1);
188#endif /* CONFIG_ADB_PMU */
189		LOCK(flags);
190		fcr = MACIO_IN32(OHARE_FCR);
191		/* Check if scc cell need enabling */
192		if (!(fcr & OH_SCC_ENABLE)) {
193			fcr |= OH_SCC_ENABLE;
194			if (htw) {
195				/* Side effect: this will also power up the
196				 * modem, but it's too messy to figure out on which
197				 * ports this controls the transceiver and on which
198				 * it controls the modem
199				 */
200				if (trans)
201					fcr &= ~HRW_SCC_TRANS_EN_N;
202				MACIO_OUT32(OHARE_FCR, fcr);
203				fcr |= (rmask = HRW_RESET_SCC);
204				MACIO_OUT32(OHARE_FCR, fcr);
205			} else {
206				fcr |= (rmask = OH_SCC_RESET);
207				MACIO_OUT32(OHARE_FCR, fcr);
208			}
209			UNLOCK(flags);
210			(void)MACIO_IN32(OHARE_FCR);
211			mdelay(15);
212			LOCK(flags);
213			fcr &= ~rmask;
214			MACIO_OUT32(OHARE_FCR, fcr);
215		}
216		if (chan_mask & MACIO_FLAG_SCCA_ON)
217			fcr |= OH_SCCA_IO;
218		if (chan_mask & MACIO_FLAG_SCCB_ON)
219			fcr |= OH_SCCB_IO;
220		MACIO_OUT32(OHARE_FCR, fcr);
221		macio->flags |= chan_mask;
222		UNLOCK(flags);
223		if (param & PMAC_SCC_FLAG_XMON)
224			macio->flags |= MACIO_FLAG_SCC_LOCKED;
225	} else {
226		if (macio->flags & MACIO_FLAG_SCC_LOCKED)
227			return -EPERM;
228		LOCK(flags);
229		fcr = MACIO_IN32(OHARE_FCR);
230		if (chan_mask & MACIO_FLAG_SCCA_ON)
231			fcr &= ~OH_SCCA_IO;
232		if (chan_mask & MACIO_FLAG_SCCB_ON)
233			fcr &= ~OH_SCCB_IO;
234		MACIO_OUT32(OHARE_FCR, fcr);
235		if ((fcr & (OH_SCCA_IO | OH_SCCB_IO)) == 0) {
236			fcr &= ~OH_SCC_ENABLE;
237			if (htw && trans)
238				fcr |= HRW_SCC_TRANS_EN_N;
239			MACIO_OUT32(OHARE_FCR, fcr);
240		}
241		macio->flags &= ~(chan_mask);
242		UNLOCK(flags);
243		mdelay(10);
244#ifdef CONFIG_ADB_PMU
245		if ((param & 0xfff) == PMAC_SCC_IRDA)
246			pmu_enable_irled(0);
247#endif /* CONFIG_ADB_PMU */
248	}
249	return 0;
250}
251
252static long ohare_floppy_enable(struct device_node *node, long param,
253				long value)
254{
255	return simple_feature_tweak(node, macio_ohare,
256		OHARE_FCR, OH_FLOPPY_ENABLE, value);
257}
258
259static long ohare_mesh_enable(struct device_node *node, long param, long value)
260{
261	return simple_feature_tweak(node, macio_ohare,
262		OHARE_FCR, OH_MESH_ENABLE, value);
263}
264
265static long ohare_ide_enable(struct device_node *node, long param, long value)
266{
267	switch(param) {
268	case 0:
269		/* For some reason, setting the bit in set_initial_features()
270		 * doesn't stick. I'm still investigating... --BenH.
271		 */
272		if (value)
273			simple_feature_tweak(node, macio_ohare,
274				OHARE_FCR, OH_IOBUS_ENABLE, 1);
275		return simple_feature_tweak(node, macio_ohare,
276			OHARE_FCR, OH_IDE0_ENABLE, value);
277	case 1:
278		return simple_feature_tweak(node, macio_ohare,
279			OHARE_FCR, OH_BAY_IDE_ENABLE, value);
280	default:
281		return -ENODEV;
282	}
283}
284
285static long ohare_ide_reset(struct device_node *node, long param, long value)
286{
287	switch(param) {
288	case 0:
289		return simple_feature_tweak(node, macio_ohare,
290			OHARE_FCR, OH_IDE0_RESET_N, !value);
291	case 1:
292		return simple_feature_tweak(node, macio_ohare,
293			OHARE_FCR, OH_IDE1_RESET_N, !value);
294	default:
295		return -ENODEV;
296	}
297}
298
299static long ohare_sleep_state(struct device_node *node, long param, long value)
300{
301	struct macio_chip*	macio = &macio_chips[0];
302
303	if ((pmac_mb.board_flags & PMAC_MB_CAN_SLEEP) == 0)
304		return -EPERM;
305	if (value == 1) {
306		MACIO_BIC(OHARE_FCR, OH_IOBUS_ENABLE);
307	} else if (value == 0) {
308		MACIO_BIS(OHARE_FCR, OH_IOBUS_ENABLE);
309	}
310
311	return 0;
312}
313
314static long heathrow_modem_enable(struct device_node *node, long param,
315				  long value)
316{
317	struct macio_chip*	macio;
318	u8			gpio;
319	unsigned long		flags;
320
321	macio = macio_find(node, macio_unknown);
322	if (!macio)
323		return -ENODEV;
324	gpio = MACIO_IN8(HRW_GPIO_MODEM_RESET) & ~1;
325	if (!value) {
326		LOCK(flags);
327		MACIO_OUT8(HRW_GPIO_MODEM_RESET, gpio);
328		UNLOCK(flags);
329		(void)MACIO_IN8(HRW_GPIO_MODEM_RESET);
330		mdelay(250);
331	}
332	if (pmac_mb.model_id != PMAC_TYPE_YOSEMITE &&
333	    pmac_mb.model_id != PMAC_TYPE_YIKES) {
334		LOCK(flags);
335		if (value)
336			MACIO_BIC(HEATHROW_FCR, HRW_SCC_TRANS_EN_N);
337		else
338			MACIO_BIS(HEATHROW_FCR, HRW_SCC_TRANS_EN_N);
339		UNLOCK(flags);
340		(void)MACIO_IN32(HEATHROW_FCR);
341		mdelay(250);
342	}
343	if (value) {
344		LOCK(flags);
345		MACIO_OUT8(HRW_GPIO_MODEM_RESET, gpio | 1);
346		(void)MACIO_IN8(HRW_GPIO_MODEM_RESET);
347		UNLOCK(flags); mdelay(250); LOCK(flags);
348		MACIO_OUT8(HRW_GPIO_MODEM_RESET, gpio);
349		(void)MACIO_IN8(HRW_GPIO_MODEM_RESET);
350		UNLOCK(flags); mdelay(250); LOCK(flags);
351		MACIO_OUT8(HRW_GPIO_MODEM_RESET, gpio | 1);
352		(void)MACIO_IN8(HRW_GPIO_MODEM_RESET);
353		UNLOCK(flags); mdelay(250);
354	}
355	return 0;
356}
357
358static long heathrow_floppy_enable(struct device_node *node, long param,
359				   long value)
360{
361	return simple_feature_tweak(node, macio_unknown,
362		HEATHROW_FCR,
363		HRW_SWIM_ENABLE|HRW_BAY_FLOPPY_ENABLE,
364		value);
365}
366
367static long heathrow_mesh_enable(struct device_node *node, long param,
368				 long value)
369{
370	struct macio_chip*	macio;
371	unsigned long		flags;
372
373	macio = macio_find(node, macio_unknown);
374	if (!macio)
375		return -ENODEV;
376	LOCK(flags);
377	/* Set clear mesh cell enable */
378	if (value)
379		MACIO_BIS(HEATHROW_FCR, HRW_MESH_ENABLE);
380	else
381		MACIO_BIC(HEATHROW_FCR, HRW_MESH_ENABLE);
382	(void)MACIO_IN32(HEATHROW_FCR);
383	udelay(10);
384	/* Set/Clear termination power */
385	if (value)
386		MACIO_BIC(HEATHROW_MBCR, 0x04000000);
387	else
388		MACIO_BIS(HEATHROW_MBCR, 0x04000000);
389	(void)MACIO_IN32(HEATHROW_MBCR);
390	udelay(10);
391	UNLOCK(flags);
392
393	return 0;
394}
395
396static long heathrow_ide_enable(struct device_node *node, long param,
397				long value)
398{
399	switch(param) {
400	case 0:
401		return simple_feature_tweak(node, macio_unknown,
402			HEATHROW_FCR, HRW_IDE0_ENABLE, value);
403	case 1:
404		return simple_feature_tweak(node, macio_unknown,
405			HEATHROW_FCR, HRW_BAY_IDE_ENABLE, value);
406	default:
407		return -ENODEV;
408	}
409}
410
411static long heathrow_ide_reset(struct device_node *node, long param,
412			       long value)
413{
414	switch(param) {
415	case 0:
416		return simple_feature_tweak(node, macio_unknown,
417			HEATHROW_FCR, HRW_IDE0_RESET_N, !value);
418	case 1:
419		return simple_feature_tweak(node, macio_unknown,
420			HEATHROW_FCR, HRW_IDE1_RESET_N, !value);
421	default:
422		return -ENODEV;
423	}
424}
425
426static long heathrow_bmac_enable(struct device_node *node, long param,
427				 long value)
428{
429	struct macio_chip*	macio;
430	unsigned long		flags;
431
432	macio = macio_find(node, 0);
433	if (!macio)
434		return -ENODEV;
435	if (value) {
436		LOCK(flags);
437		MACIO_BIS(HEATHROW_FCR, HRW_BMAC_IO_ENABLE);
438		MACIO_BIS(HEATHROW_FCR, HRW_BMAC_RESET);
439		UNLOCK(flags);
440		(void)MACIO_IN32(HEATHROW_FCR);
441		mdelay(10);
442		LOCK(flags);
443		MACIO_BIC(HEATHROW_FCR, HRW_BMAC_RESET);
444		UNLOCK(flags);
445		(void)MACIO_IN32(HEATHROW_FCR);
446		mdelay(10);
447	} else {
448		LOCK(flags);
449		MACIO_BIC(HEATHROW_FCR, HRW_BMAC_IO_ENABLE);
450		UNLOCK(flags);
451	}
452	return 0;
453}
454
455static long heathrow_sound_enable(struct device_node *node, long param,
456				  long value)
457{
458	struct macio_chip*	macio;
459	unsigned long		flags;
460
461	/* B&W G3 and Yikes don't support that properly (the
462	 * sound appear to never come back after being shut down).
463	 */
464	if (pmac_mb.model_id == PMAC_TYPE_YOSEMITE ||
465	    pmac_mb.model_id == PMAC_TYPE_YIKES)
466		return 0;
467
468	macio = macio_find(node, 0);
469	if (!macio)
470		return -ENODEV;
471	if (value) {
472		LOCK(flags);
473		MACIO_BIS(HEATHROW_FCR, HRW_SOUND_CLK_ENABLE);
474		MACIO_BIC(HEATHROW_FCR, HRW_SOUND_POWER_N);
475		UNLOCK(flags);
476		(void)MACIO_IN32(HEATHROW_FCR);
477	} else {
478		LOCK(flags);
479		MACIO_BIS(HEATHROW_FCR, HRW_SOUND_POWER_N);
480		MACIO_BIC(HEATHROW_FCR, HRW_SOUND_CLK_ENABLE);
481		UNLOCK(flags);
482	}
483	return 0;
484}
485
486static u32 save_fcr[6];
487static u32 save_mbcr;
488static struct dbdma_regs save_dbdma[13];
489static struct dbdma_regs save_alt_dbdma[13];
490
491static void dbdma_save(struct macio_chip *macio, struct dbdma_regs *save)
492{
493	int i;
494
495	/* Save state & config of DBDMA channels */
496	for (i = 0; i < 13; i++) {
497		volatile struct dbdma_regs __iomem * chan = (void __iomem *)
498			(macio->base + ((0x8000+i*0x100)>>2));
499		save[i].cmdptr_hi = in_le32(&chan->cmdptr_hi);
500		save[i].cmdptr = in_le32(&chan->cmdptr);
501		save[i].intr_sel = in_le32(&chan->intr_sel);
502		save[i].br_sel = in_le32(&chan->br_sel);
503		save[i].wait_sel = in_le32(&chan->wait_sel);
504	}
505}
506
507static void dbdma_restore(struct macio_chip *macio, struct dbdma_regs *save)
508{
509	int i;
510
511	/* Save state & config of DBDMA channels */
512	for (i = 0; i < 13; i++) {
513		volatile struct dbdma_regs __iomem * chan = (void __iomem *)
514			(macio->base + ((0x8000+i*0x100)>>2));
515		out_le32(&chan->control, (ACTIVE|DEAD|WAKE|FLUSH|PAUSE|RUN)<<16);
516		while (in_le32(&chan->status) & ACTIVE)
517			mb();
518		out_le32(&chan->cmdptr_hi, save[i].cmdptr_hi);
519		out_le32(&chan->cmdptr, save[i].cmdptr);
520		out_le32(&chan->intr_sel, save[i].intr_sel);
521		out_le32(&chan->br_sel, save[i].br_sel);
522		out_le32(&chan->wait_sel, save[i].wait_sel);
523	}
524}
525
526static void heathrow_sleep(struct macio_chip *macio, int secondary)
527{
528	if (secondary) {
529		dbdma_save(macio, save_alt_dbdma);
530		save_fcr[2] = MACIO_IN32(0x38);
531		save_fcr[3] = MACIO_IN32(0x3c);
532	} else {
533		dbdma_save(macio, save_dbdma);
534		save_fcr[0] = MACIO_IN32(0x38);
535		save_fcr[1] = MACIO_IN32(0x3c);
536		save_mbcr = MACIO_IN32(0x34);
537		/* Make sure sound is shut down */
538		MACIO_BIS(HEATHROW_FCR, HRW_SOUND_POWER_N);
539		MACIO_BIC(HEATHROW_FCR, HRW_SOUND_CLK_ENABLE);
540		/* This seems to be necessary as well or the fan
541		 * keeps coming up and battery drains fast */
542		MACIO_BIC(HEATHROW_FCR, HRW_IOBUS_ENABLE);
543		MACIO_BIC(HEATHROW_FCR, HRW_IDE0_RESET_N);
544		/* Make sure eth is down even if module or sleep
545		 * won't work properly */
546		MACIO_BIC(HEATHROW_FCR, HRW_BMAC_IO_ENABLE | HRW_BMAC_RESET);
547	}
548	/* Make sure modem is shut down */
549	MACIO_OUT8(HRW_GPIO_MODEM_RESET,
550		MACIO_IN8(HRW_GPIO_MODEM_RESET) & ~1);
551	MACIO_BIS(HEATHROW_FCR, HRW_SCC_TRANS_EN_N);
552	MACIO_BIC(HEATHROW_FCR, OH_SCCA_IO|OH_SCCB_IO|HRW_SCC_ENABLE);
553
554	/* Let things settle */
555	(void)MACIO_IN32(HEATHROW_FCR);
556}
557
558static void heathrow_wakeup(struct macio_chip *macio, int secondary)
559{
560	if (secondary) {
561		MACIO_OUT32(0x38, save_fcr[2]);
562		(void)MACIO_IN32(0x38);
563		mdelay(1);
564		MACIO_OUT32(0x3c, save_fcr[3]);
565		(void)MACIO_IN32(0x38);
566		mdelay(10);
567		dbdma_restore(macio, save_alt_dbdma);
568	} else {
569		MACIO_OUT32(0x38, save_fcr[0] | HRW_IOBUS_ENABLE);
570		(void)MACIO_IN32(0x38);
571		mdelay(1);
572		MACIO_OUT32(0x3c, save_fcr[1]);
573		(void)MACIO_IN32(0x38);
574		mdelay(1);
575		MACIO_OUT32(0x34, save_mbcr);
576		(void)MACIO_IN32(0x38);
577		mdelay(10);
578		dbdma_restore(macio, save_dbdma);
579	}
580}
581
582static long heathrow_sleep_state(struct device_node *node, long param,
583				 long value)
584{
585	if ((pmac_mb.board_flags & PMAC_MB_CAN_SLEEP) == 0)
586		return -EPERM;
587	if (value == 1) {
588		if (macio_chips[1].type == macio_gatwick)
589			heathrow_sleep(&macio_chips[0], 1);
590		heathrow_sleep(&macio_chips[0], 0);
591	} else if (value == 0) {
592		heathrow_wakeup(&macio_chips[0], 0);
593		if (macio_chips[1].type == macio_gatwick)
594			heathrow_wakeup(&macio_chips[0], 1);
595	}
596	return 0;
597}
598
599static long core99_scc_enable(struct device_node *node, long param, long value)
600{
601	struct macio_chip*	macio;
602	unsigned long		flags;
603	unsigned long		chan_mask;
604	u32			fcr;
605
606	macio = macio_find(node, 0);
607	if (!macio)
608		return -ENODEV;
609	if (of_node_name_eq(node, "ch-a"))
610		chan_mask = MACIO_FLAG_SCCA_ON;
611	else if (of_node_name_eq(node, "ch-b"))
612		chan_mask = MACIO_FLAG_SCCB_ON;
613	else
614		return -ENODEV;
615
616	if (value) {
617		int need_reset_scc = 0;
618		int need_reset_irda = 0;
619
620		LOCK(flags);
621		fcr = MACIO_IN32(KEYLARGO_FCR0);
622		/* Check if scc cell need enabling */
623		if (!(fcr & KL0_SCC_CELL_ENABLE)) {
624			fcr |= KL0_SCC_CELL_ENABLE;
625			need_reset_scc = 1;
626		}
627		if (chan_mask & MACIO_FLAG_SCCA_ON) {
628			fcr |= KL0_SCCA_ENABLE;
629			/* Don't enable line drivers for I2S modem */
630			if ((param & 0xfff) == PMAC_SCC_I2S1)
631				fcr &= ~KL0_SCC_A_INTF_ENABLE;
632			else
633				fcr |= KL0_SCC_A_INTF_ENABLE;
634		}
635		if (chan_mask & MACIO_FLAG_SCCB_ON) {
636			fcr |= KL0_SCCB_ENABLE;
637			/* Perform irda specific inits */
638			if ((param & 0xfff) == PMAC_SCC_IRDA) {
639				fcr &= ~KL0_SCC_B_INTF_ENABLE;
640				fcr |= KL0_IRDA_ENABLE;
641				fcr |= KL0_IRDA_CLK32_ENABLE | KL0_IRDA_CLK19_ENABLE;
642				fcr |= KL0_IRDA_SOURCE1_SEL;
643				fcr &= ~(KL0_IRDA_FAST_CONNECT|KL0_IRDA_DEFAULT1|KL0_IRDA_DEFAULT0);
644				fcr &= ~(KL0_IRDA_SOURCE2_SEL|KL0_IRDA_HIGH_BAND);
645				need_reset_irda = 1;
646			} else
647				fcr |= KL0_SCC_B_INTF_ENABLE;
648		}
649		MACIO_OUT32(KEYLARGO_FCR0, fcr);
650		macio->flags |= chan_mask;
651		if (need_reset_scc)  {
652			MACIO_BIS(KEYLARGO_FCR0, KL0_SCC_RESET);
653			(void)MACIO_IN32(KEYLARGO_FCR0);
654			UNLOCK(flags);
655			mdelay(15);
656			LOCK(flags);
657			MACIO_BIC(KEYLARGO_FCR0, KL0_SCC_RESET);
658		}
659		if (need_reset_irda)  {
660			MACIO_BIS(KEYLARGO_FCR0, KL0_IRDA_RESET);
661			(void)MACIO_IN32(KEYLARGO_FCR0);
662			UNLOCK(flags);
663			mdelay(15);
664			LOCK(flags);
665			MACIO_BIC(KEYLARGO_FCR0, KL0_IRDA_RESET);
666		}
667		UNLOCK(flags);
668		if (param & PMAC_SCC_FLAG_XMON)
669			macio->flags |= MACIO_FLAG_SCC_LOCKED;
670	} else {
671		if (macio->flags & MACIO_FLAG_SCC_LOCKED)
672			return -EPERM;
673		LOCK(flags);
674		fcr = MACIO_IN32(KEYLARGO_FCR0);
675		if (chan_mask & MACIO_FLAG_SCCA_ON)
676			fcr &= ~KL0_SCCA_ENABLE;
677		if (chan_mask & MACIO_FLAG_SCCB_ON) {
678			fcr &= ~KL0_SCCB_ENABLE;
679			/* Perform irda specific clears */
680			if ((param & 0xfff) == PMAC_SCC_IRDA) {
681				fcr &= ~KL0_IRDA_ENABLE;
682				fcr &= ~(KL0_IRDA_CLK32_ENABLE | KL0_IRDA_CLK19_ENABLE);
683				fcr &= ~(KL0_IRDA_FAST_CONNECT|KL0_IRDA_DEFAULT1|KL0_IRDA_DEFAULT0);
684				fcr &= ~(KL0_IRDA_SOURCE1_SEL|KL0_IRDA_SOURCE2_SEL|KL0_IRDA_HIGH_BAND);
685			}
686		}
687		MACIO_OUT32(KEYLARGO_FCR0, fcr);
688		if ((fcr & (KL0_SCCA_ENABLE | KL0_SCCB_ENABLE)) == 0) {
689			fcr &= ~KL0_SCC_CELL_ENABLE;
690			MACIO_OUT32(KEYLARGO_FCR0, fcr);
691		}
692		macio->flags &= ~(chan_mask);
693		UNLOCK(flags);
694		mdelay(10);
695	}
696	return 0;
697}
698
699static long
700core99_modem_enable(struct device_node *node, long param, long value)
701{
702	struct macio_chip*	macio;
703	u8			gpio;
704	unsigned long		flags;
705
706	/* Hack for internal USB modem */
707	if (node == NULL) {
708		if (macio_chips[0].type != macio_keylargo)
709			return -ENODEV;
710		node = macio_chips[0].of_node;
711	}
712	macio = macio_find(node, 0);
713	if (!macio)
714		return -ENODEV;
715	gpio = MACIO_IN8(KL_GPIO_MODEM_RESET);
716	gpio |= KEYLARGO_GPIO_OUTPUT_ENABLE;
717	gpio &= ~KEYLARGO_GPIO_OUTOUT_DATA;
718
719	if (!value) {
720		LOCK(flags);
721		MACIO_OUT8(KL_GPIO_MODEM_RESET, gpio);
722		UNLOCK(flags);
723		(void)MACIO_IN8(KL_GPIO_MODEM_RESET);
724		mdelay(250);
725	}
726	LOCK(flags);
727	if (value) {
728		MACIO_BIC(KEYLARGO_FCR2, KL2_ALT_DATA_OUT);
729		UNLOCK(flags);
730		(void)MACIO_IN32(KEYLARGO_FCR2);
731		mdelay(250);
732	} else {
733		MACIO_BIS(KEYLARGO_FCR2, KL2_ALT_DATA_OUT);
734		UNLOCK(flags);
735	}
736	if (value) {
737		LOCK(flags);
738		MACIO_OUT8(KL_GPIO_MODEM_RESET, gpio | KEYLARGO_GPIO_OUTOUT_DATA);
739		(void)MACIO_IN8(KL_GPIO_MODEM_RESET);
740		UNLOCK(flags); mdelay(250); LOCK(flags);
741		MACIO_OUT8(KL_GPIO_MODEM_RESET, gpio);
742		(void)MACIO_IN8(KL_GPIO_MODEM_RESET);
743		UNLOCK(flags); mdelay(250); LOCK(flags);
744		MACIO_OUT8(KL_GPIO_MODEM_RESET, gpio | KEYLARGO_GPIO_OUTOUT_DATA);
745		(void)MACIO_IN8(KL_GPIO_MODEM_RESET);
746		UNLOCK(flags); mdelay(250);
747	}
748	return 0;
749}
750
751static long
752pangea_modem_enable(struct device_node *node, long param, long value)
753{
754	struct macio_chip*	macio;
755	u8			gpio;
756	unsigned long		flags;
757
758	/* Hack for internal USB modem */
759	if (node == NULL) {
760		if (macio_chips[0].type != macio_pangea &&
761		    macio_chips[0].type != macio_intrepid)
762			return -ENODEV;
763		node = macio_chips[0].of_node;
764	}
765	macio = macio_find(node, 0);
766	if (!macio)
767		return -ENODEV;
768	gpio = MACIO_IN8(KL_GPIO_MODEM_RESET);
769	gpio |= KEYLARGO_GPIO_OUTPUT_ENABLE;
770	gpio &= ~KEYLARGO_GPIO_OUTOUT_DATA;
771
772	if (!value) {
773		LOCK(flags);
774		MACIO_OUT8(KL_GPIO_MODEM_RESET, gpio);
775		UNLOCK(flags);
776		(void)MACIO_IN8(KL_GPIO_MODEM_RESET);
777		mdelay(250);
778	}
779	LOCK(flags);
780	if (value) {
781		MACIO_OUT8(KL_GPIO_MODEM_POWER,
782			KEYLARGO_GPIO_OUTPUT_ENABLE);
783		UNLOCK(flags);
784		(void)MACIO_IN32(KEYLARGO_FCR2);
785		mdelay(250);
786	} else {
787		MACIO_OUT8(KL_GPIO_MODEM_POWER,
788			KEYLARGO_GPIO_OUTPUT_ENABLE | KEYLARGO_GPIO_OUTOUT_DATA);
789		UNLOCK(flags);
790	}
791	if (value) {
792		LOCK(flags);
793		MACIO_OUT8(KL_GPIO_MODEM_RESET, gpio | KEYLARGO_GPIO_OUTOUT_DATA);
794		(void)MACIO_IN8(KL_GPIO_MODEM_RESET);
795		UNLOCK(flags); mdelay(250); LOCK(flags);
796		MACIO_OUT8(KL_GPIO_MODEM_RESET, gpio);
797		(void)MACIO_IN8(KL_GPIO_MODEM_RESET);
798		UNLOCK(flags); mdelay(250); LOCK(flags);
799		MACIO_OUT8(KL_GPIO_MODEM_RESET, gpio | KEYLARGO_GPIO_OUTOUT_DATA);
800		(void)MACIO_IN8(KL_GPIO_MODEM_RESET);
801		UNLOCK(flags); mdelay(250);
802	}
803	return 0;
804}
805
806static long
807core99_ata100_enable(struct device_node *node, long value)
808{
809	unsigned long flags;
810	struct pci_dev *pdev = NULL;
811	u8 pbus, pid;
812	int rc;
813
814	if (uninorth_rev < 0x24)
815		return -ENODEV;
816
817	LOCK(flags);
818	if (value)
819		UN_BIS(UNI_N_CLOCK_CNTL, UNI_N_CLOCK_CNTL_ATA100);
820	else
821		UN_BIC(UNI_N_CLOCK_CNTL, UNI_N_CLOCK_CNTL_ATA100);
822	(void)UN_IN(UNI_N_CLOCK_CNTL);
823	UNLOCK(flags);
824	udelay(20);
825
826	if (value) {
827		if (pci_device_from_OF_node(node, &pbus, &pid) == 0)
828			pdev = pci_get_domain_bus_and_slot(0, pbus, pid);
829		if (pdev == NULL)
830			return 0;
831		rc = pci_enable_device(pdev);
832		if (rc == 0)
833			pci_set_master(pdev);
834		pci_dev_put(pdev);
835		if (rc)
836			return rc;
837	}
838	return 0;
839}
840
841static long
842core99_ide_enable(struct device_node *node, long param, long value)
843{
844	/* Bus ID 0 to 2 are KeyLargo based IDE, busID 3 is U2
845	 * based ata-100
846	 */
847	switch(param) {
848	    case 0:
849		return simple_feature_tweak(node, macio_unknown,
850			KEYLARGO_FCR1, KL1_EIDE0_ENABLE, value);
851	    case 1:
852		return simple_feature_tweak(node, macio_unknown,
853			KEYLARGO_FCR1, KL1_EIDE1_ENABLE, value);
854	    case 2:
855		return simple_feature_tweak(node, macio_unknown,
856			KEYLARGO_FCR1, KL1_UIDE_ENABLE, value);
857	    case 3:
858		return core99_ata100_enable(node, value);
859	    default:
860		return -ENODEV;
861	}
862}
863
864static long
865core99_ide_reset(struct device_node *node, long param, long value)
866{
867	switch(param) {
868	    case 0:
869		return simple_feature_tweak(node, macio_unknown,
870			KEYLARGO_FCR1, KL1_EIDE0_RESET_N, !value);
871	    case 1:
872		return simple_feature_tweak(node, macio_unknown,
873			KEYLARGO_FCR1, KL1_EIDE1_RESET_N, !value);
874	    case 2:
875		return simple_feature_tweak(node, macio_unknown,
876			KEYLARGO_FCR1, KL1_UIDE_RESET_N, !value);
877	    default:
878		return -ENODEV;
879	}
880}
881
882static long
883core99_gmac_enable(struct device_node *node, long param, long value)
884{
885	unsigned long flags;
886
887	LOCK(flags);
888	if (value)
889		UN_BIS(UNI_N_CLOCK_CNTL, UNI_N_CLOCK_CNTL_GMAC);
890	else
891		UN_BIC(UNI_N_CLOCK_CNTL, UNI_N_CLOCK_CNTL_GMAC);
892	(void)UN_IN(UNI_N_CLOCK_CNTL);
893	UNLOCK(flags);
894	udelay(20);
895
896	return 0;
897}
898
899static long
900core99_gmac_phy_reset(struct device_node *node, long param, long value)
901{
902	unsigned long flags;
903	struct macio_chip *macio;
904
905	macio = &macio_chips[0];
906	if (macio->type != macio_keylargo && macio->type != macio_pangea &&
907	    macio->type != macio_intrepid)
908		return -ENODEV;
909
910	LOCK(flags);
911	MACIO_OUT8(KL_GPIO_ETH_PHY_RESET, KEYLARGO_GPIO_OUTPUT_ENABLE);
912	(void)MACIO_IN8(KL_GPIO_ETH_PHY_RESET);
913	UNLOCK(flags);
914	mdelay(10);
915	LOCK(flags);
916	MACIO_OUT8(KL_GPIO_ETH_PHY_RESET, /*KEYLARGO_GPIO_OUTPUT_ENABLE | */
917		KEYLARGO_GPIO_OUTOUT_DATA);
918	UNLOCK(flags);
919	mdelay(10);
920
921	return 0;
922}
923
924static long
925core99_sound_chip_enable(struct device_node *node, long param, long value)
926{
927	struct macio_chip*	macio;
928	unsigned long		flags;
929
930	macio = macio_find(node, 0);
931	if (!macio)
932		return -ENODEV;
933
934	/* Do a better probe code, screamer G4 desktops &
935	 * iMacs can do that too, add a recalibrate  in
936	 * the driver as well
937	 */
938	if (pmac_mb.model_id == PMAC_TYPE_PISMO ||
939	    pmac_mb.model_id == PMAC_TYPE_TITANIUM) {
940		LOCK(flags);
941		if (value)
942			MACIO_OUT8(KL_GPIO_SOUND_POWER,
943				KEYLARGO_GPIO_OUTPUT_ENABLE |
944				KEYLARGO_GPIO_OUTOUT_DATA);
945		else
946			MACIO_OUT8(KL_GPIO_SOUND_POWER,
947				KEYLARGO_GPIO_OUTPUT_ENABLE);
948		(void)MACIO_IN8(KL_GPIO_SOUND_POWER);
949		UNLOCK(flags);
950	}
951	return 0;
952}
953
954static long
955core99_airport_enable(struct device_node *node, long param, long value)
956{
957	struct macio_chip*	macio;
958	unsigned long		flags;
959	int			state;
960
961	macio = macio_find(node, 0);
962	if (!macio)
963		return -ENODEV;
964
965	/* Hint: we allow passing of macio itself for the sake of the
966	 * sleep code
967	 */
968	if (node != macio->of_node &&
969	    (!node->parent || node->parent != macio->of_node))
970		return -ENODEV;
971	state = (macio->flags & MACIO_FLAG_AIRPORT_ON) != 0;
972	if (value == state)
973		return 0;
974	if (value) {
975		/* This code is a reproduction of OF enable-cardslot
976		 * and init-wireless methods, slightly hacked until
977		 * I got it working.
978		 */
979		LOCK(flags);
980		MACIO_OUT8(KEYLARGO_GPIO_0+0xf, 5);
981		(void)MACIO_IN8(KEYLARGO_GPIO_0+0xf);
982		UNLOCK(flags);
983		mdelay(10);
984		LOCK(flags);
985		MACIO_OUT8(KEYLARGO_GPIO_0+0xf, 4);
986		(void)MACIO_IN8(KEYLARGO_GPIO_0+0xf);
987		UNLOCK(flags);
988
989		mdelay(10);
990
991		LOCK(flags);
992		MACIO_BIC(KEYLARGO_FCR2, KL2_CARDSEL_16);
993		(void)MACIO_IN32(KEYLARGO_FCR2);
994		udelay(10);
995		MACIO_OUT8(KEYLARGO_GPIO_EXTINT_0+0xb, 0);
996		(void)MACIO_IN8(KEYLARGO_GPIO_EXTINT_0+0xb);
997		udelay(10);
998		MACIO_OUT8(KEYLARGO_GPIO_EXTINT_0+0xa, 0x28);
999		(void)MACIO_IN8(KEYLARGO_GPIO_EXTINT_0+0xa);
1000		udelay(10);
1001		MACIO_OUT8(KEYLARGO_GPIO_EXTINT_0+0xd, 0x28);
1002		(void)MACIO_IN8(KEYLARGO_GPIO_EXTINT_0+0xd);
1003		udelay(10);
1004		MACIO_OUT8(KEYLARGO_GPIO_0+0xd, 0x28);
1005		(void)MACIO_IN8(KEYLARGO_GPIO_0+0xd);
1006		udelay(10);
1007		MACIO_OUT8(KEYLARGO_GPIO_0+0xe, 0x28);
1008		(void)MACIO_IN8(KEYLARGO_GPIO_0+0xe);
1009		UNLOCK(flags);
1010		udelay(10);
1011		MACIO_OUT32(0x1c000, 0);
1012		mdelay(1);
1013		MACIO_OUT8(0x1a3e0, 0x41);
1014		(void)MACIO_IN8(0x1a3e0);
1015		udelay(10);
1016		LOCK(flags);
1017		MACIO_BIS(KEYLARGO_FCR2, KL2_CARDSEL_16);
1018		(void)MACIO_IN32(KEYLARGO_FCR2);
1019		UNLOCK(flags);
1020		mdelay(100);
1021
1022		macio->flags |= MACIO_FLAG_AIRPORT_ON;
1023	} else {
1024		LOCK(flags);
1025		MACIO_BIC(KEYLARGO_FCR2, KL2_CARDSEL_16);
1026		(void)MACIO_IN32(KEYLARGO_FCR2);
1027		MACIO_OUT8(KL_GPIO_AIRPORT_0, 0);
1028		MACIO_OUT8(KL_GPIO_AIRPORT_1, 0);
1029		MACIO_OUT8(KL_GPIO_AIRPORT_2, 0);
1030		MACIO_OUT8(KL_GPIO_AIRPORT_3, 0);
1031		MACIO_OUT8(KL_GPIO_AIRPORT_4, 0);
1032		(void)MACIO_IN8(KL_GPIO_AIRPORT_4);
1033		UNLOCK(flags);
1034
1035		macio->flags &= ~MACIO_FLAG_AIRPORT_ON;
1036	}
1037	return 0;
1038}
1039
1040#ifdef CONFIG_SMP
1041static long
1042core99_reset_cpu(struct device_node *node, long param, long value)
1043{
1044	unsigned int reset_io = 0;
1045	unsigned long flags;
1046	struct macio_chip *macio;
1047	struct device_node *np;
1048	const int dflt_reset_lines[] = {	KL_GPIO_RESET_CPU0,
1049						KL_GPIO_RESET_CPU1,
1050						KL_GPIO_RESET_CPU2,
1051						KL_GPIO_RESET_CPU3 };
1052
1053	macio = &macio_chips[0];
1054	if (macio->type != macio_keylargo)
1055		return -ENODEV;
1056
1057	for_each_of_cpu_node(np) {
1058		const u32 *rst = of_get_property(np, "soft-reset", NULL);
1059		if (!rst)
1060			continue;
1061		if (param == of_get_cpu_hwid(np, 0)) {
1062			of_node_put(np);
1063			reset_io = *rst;
1064			break;
1065		}
1066	}
1067	if (np == NULL || reset_io == 0)
1068		reset_io = dflt_reset_lines[param];
1069
1070	LOCK(flags);
1071	MACIO_OUT8(reset_io, KEYLARGO_GPIO_OUTPUT_ENABLE);
1072	(void)MACIO_IN8(reset_io);
1073	udelay(1);
1074	MACIO_OUT8(reset_io, 0);
1075	(void)MACIO_IN8(reset_io);
1076	UNLOCK(flags);
1077
1078	return 0;
1079}
1080#endif /* CONFIG_SMP */
1081
1082static long
1083core99_usb_enable(struct device_node *node, long param, long value)
1084{
1085	struct macio_chip *macio;
1086	unsigned long flags;
1087	const char *prop;
1088	int number;
1089	u32 reg;
1090
1091	macio = &macio_chips[0];
1092	if (macio->type != macio_keylargo && macio->type != macio_pangea &&
1093	    macio->type != macio_intrepid)
1094		return -ENODEV;
1095
1096	prop = of_get_property(node, "AAPL,clock-id", NULL);
1097	if (!prop)
1098		return -ENODEV;
1099	if (strncmp(prop, "usb0u048", 8) == 0)
1100		number = 0;
1101	else if (strncmp(prop, "usb1u148", 8) == 0)
1102		number = 2;
1103	else if (strncmp(prop, "usb2u248", 8) == 0)
1104		number = 4;
1105	else
1106		return -ENODEV;
1107
1108	/* Sorry for the brute-force locking, but this is only used during
1109	 * sleep and the timing seem to be critical
1110	 */
1111	LOCK(flags);
1112	if (value) {
1113		/* Turn ON */
1114		if (number == 0) {
1115			MACIO_BIC(KEYLARGO_FCR0, (KL0_USB0_PAD_SUSPEND0 | KL0_USB0_PAD_SUSPEND1));
1116			(void)MACIO_IN32(KEYLARGO_FCR0);
1117			UNLOCK(flags);
1118			mdelay(1);
1119			LOCK(flags);
1120			MACIO_BIS(KEYLARGO_FCR0, KL0_USB0_CELL_ENABLE);
1121		} else if (number == 2) {
1122			MACIO_BIC(KEYLARGO_FCR0, (KL0_USB1_PAD_SUSPEND0 | KL0_USB1_PAD_SUSPEND1));
1123			UNLOCK(flags);
1124			(void)MACIO_IN32(KEYLARGO_FCR0);
1125			mdelay(1);
1126			LOCK(flags);
1127			MACIO_BIS(KEYLARGO_FCR0, KL0_USB1_CELL_ENABLE);
1128		} else if (number == 4) {
1129			MACIO_BIC(KEYLARGO_FCR1, (KL1_USB2_PAD_SUSPEND0 | KL1_USB2_PAD_SUSPEND1));
1130			UNLOCK(flags);
1131			(void)MACIO_IN32(KEYLARGO_FCR1);
1132			mdelay(1);
1133			LOCK(flags);
1134			MACIO_BIS(KEYLARGO_FCR1, KL1_USB2_CELL_ENABLE);
1135		}
1136		if (number < 4) {
1137			reg = MACIO_IN32(KEYLARGO_FCR4);
1138			reg &=	~(KL4_PORT_WAKEUP_ENABLE(number) | KL4_PORT_RESUME_WAKE_EN(number) |
1139				KL4_PORT_CONNECT_WAKE_EN(number) | KL4_PORT_DISCONNECT_WAKE_EN(number));
1140			reg &=	~(KL4_PORT_WAKEUP_ENABLE(number+1) | KL4_PORT_RESUME_WAKE_EN(number+1) |
1141				KL4_PORT_CONNECT_WAKE_EN(number+1) | KL4_PORT_DISCONNECT_WAKE_EN(number+1));
1142			MACIO_OUT32(KEYLARGO_FCR4, reg);
1143			(void)MACIO_IN32(KEYLARGO_FCR4);
1144			udelay(10);
1145		} else {
1146			reg = MACIO_IN32(KEYLARGO_FCR3);
1147			reg &=	~(KL3_IT_PORT_WAKEUP_ENABLE(0) | KL3_IT_PORT_RESUME_WAKE_EN(0) |
1148				KL3_IT_PORT_CONNECT_WAKE_EN(0) | KL3_IT_PORT_DISCONNECT_WAKE_EN(0));
1149			reg &=	~(KL3_IT_PORT_WAKEUP_ENABLE(1) | KL3_IT_PORT_RESUME_WAKE_EN(1) |
1150				KL3_IT_PORT_CONNECT_WAKE_EN(1) | KL3_IT_PORT_DISCONNECT_WAKE_EN(1));
1151			MACIO_OUT32(KEYLARGO_FCR3, reg);
1152			(void)MACIO_IN32(KEYLARGO_FCR3);
1153			udelay(10);
1154		}
1155		if (macio->type == macio_intrepid) {
1156			/* wait for clock stopped bits to clear */
1157			u32 test0 = 0, test1 = 0;
1158			u32 status0, status1;
1159			int timeout = 1000;
1160
1161			UNLOCK(flags);
1162			switch (number) {
1163			case 0:
1164				test0 = UNI_N_CLOCK_STOPPED_USB0;
1165				test1 = UNI_N_CLOCK_STOPPED_USB0PCI;
1166				break;
1167			case 2:
1168				test0 = UNI_N_CLOCK_STOPPED_USB1;
1169				test1 = UNI_N_CLOCK_STOPPED_USB1PCI;
1170				break;
1171			case 4:
1172				test0 = UNI_N_CLOCK_STOPPED_USB2;
1173				test1 = UNI_N_CLOCK_STOPPED_USB2PCI;
1174				break;
1175			}
1176			do {
1177				if (--timeout <= 0) {
1178					printk(KERN_ERR "core99_usb_enable: "
1179					       "Timeout waiting for clocks\n");
1180					break;
1181				}
1182				mdelay(1);
1183				status0 = UN_IN(UNI_N_CLOCK_STOP_STATUS0);
1184				status1 = UN_IN(UNI_N_CLOCK_STOP_STATUS1);
1185			} while ((status0 & test0) | (status1 & test1));
1186			LOCK(flags);
1187		}
1188	} else {
1189		/* Turn OFF */
1190		if (number < 4) {
1191			reg = MACIO_IN32(KEYLARGO_FCR4);
1192			reg |=	KL4_PORT_WAKEUP_ENABLE(number) | KL4_PORT_RESUME_WAKE_EN(number) |
1193				KL4_PORT_CONNECT_WAKE_EN(number) | KL4_PORT_DISCONNECT_WAKE_EN(number);
1194			reg |=	KL4_PORT_WAKEUP_ENABLE(number+1) | KL4_PORT_RESUME_WAKE_EN(number+1) |
1195				KL4_PORT_CONNECT_WAKE_EN(number+1) | KL4_PORT_DISCONNECT_WAKE_EN(number+1);
1196			MACIO_OUT32(KEYLARGO_FCR4, reg);
1197			(void)MACIO_IN32(KEYLARGO_FCR4);
1198			udelay(1);
1199		} else {
1200			reg = MACIO_IN32(KEYLARGO_FCR3);
1201			reg |=	KL3_IT_PORT_WAKEUP_ENABLE(0) | KL3_IT_PORT_RESUME_WAKE_EN(0) |
1202				KL3_IT_PORT_CONNECT_WAKE_EN(0) | KL3_IT_PORT_DISCONNECT_WAKE_EN(0);
1203			reg |=	KL3_IT_PORT_WAKEUP_ENABLE(1) | KL3_IT_PORT_RESUME_WAKE_EN(1) |
1204				KL3_IT_PORT_CONNECT_WAKE_EN(1) | KL3_IT_PORT_DISCONNECT_WAKE_EN(1);
1205			MACIO_OUT32(KEYLARGO_FCR3, reg);
1206			(void)MACIO_IN32(KEYLARGO_FCR3);
1207			udelay(1);
1208		}
1209		if (number == 0) {
1210			if (macio->type != macio_intrepid)
1211				MACIO_BIC(KEYLARGO_FCR0, KL0_USB0_CELL_ENABLE);
1212			(void)MACIO_IN32(KEYLARGO_FCR0);
1213			udelay(1);
1214			MACIO_BIS(KEYLARGO_FCR0, (KL0_USB0_PAD_SUSPEND0 | KL0_USB0_PAD_SUSPEND1));
1215			(void)MACIO_IN32(KEYLARGO_FCR0);
1216		} else if (number == 2) {
1217			if (macio->type != macio_intrepid)
1218				MACIO_BIC(KEYLARGO_FCR0, KL0_USB1_CELL_ENABLE);
1219			(void)MACIO_IN32(KEYLARGO_FCR0);
1220			udelay(1);
1221			MACIO_BIS(KEYLARGO_FCR0, (KL0_USB1_PAD_SUSPEND0 | KL0_USB1_PAD_SUSPEND1));
1222			(void)MACIO_IN32(KEYLARGO_FCR0);
1223		} else if (number == 4) {
1224			udelay(1);
1225			MACIO_BIS(KEYLARGO_FCR1, (KL1_USB2_PAD_SUSPEND0 | KL1_USB2_PAD_SUSPEND1));
1226			(void)MACIO_IN32(KEYLARGO_FCR1);
1227		}
1228		udelay(1);
1229	}
1230	UNLOCK(flags);
1231
1232	return 0;
1233}
1234
1235static long
1236core99_firewire_enable(struct device_node *node, long param, long value)
1237{
1238	unsigned long flags;
1239	struct macio_chip *macio;
1240
1241	macio = &macio_chips[0];
1242	if (macio->type != macio_keylargo && macio->type != macio_pangea &&
1243	    macio->type != macio_intrepid)
1244		return -ENODEV;
1245	if (!(macio->flags & MACIO_FLAG_FW_SUPPORTED))
1246		return -ENODEV;
1247
1248	LOCK(flags);
1249	if (value) {
1250		UN_BIS(UNI_N_CLOCK_CNTL, UNI_N_CLOCK_CNTL_FW);
1251		(void)UN_IN(UNI_N_CLOCK_CNTL);
1252	} else {
1253		UN_BIC(UNI_N_CLOCK_CNTL, UNI_N_CLOCK_CNTL_FW);
1254		(void)UN_IN(UNI_N_CLOCK_CNTL);
1255	}
1256	UNLOCK(flags);
1257	mdelay(1);
1258
1259	return 0;
1260}
1261
1262static long
1263core99_firewire_cable_power(struct device_node *node, long param, long value)
1264{
1265	unsigned long flags;
1266	struct macio_chip *macio;
1267
1268	/* Trick: we allow NULL node */
1269	if ((pmac_mb.board_flags & PMAC_MB_HAS_FW_POWER) == 0)
1270		return -ENODEV;
1271	macio = &macio_chips[0];
1272	if (macio->type != macio_keylargo && macio->type != macio_pangea &&
1273	    macio->type != macio_intrepid)
1274		return -ENODEV;
1275	if (!(macio->flags & MACIO_FLAG_FW_SUPPORTED))
1276		return -ENODEV;
1277
1278	LOCK(flags);
1279	if (value) {
1280		MACIO_OUT8(KL_GPIO_FW_CABLE_POWER , 0);
1281		MACIO_IN8(KL_GPIO_FW_CABLE_POWER);
1282		udelay(10);
1283	} else {
1284		MACIO_OUT8(KL_GPIO_FW_CABLE_POWER , 4);
1285		MACIO_IN8(KL_GPIO_FW_CABLE_POWER); udelay(10);
1286	}
1287	UNLOCK(flags);
1288	mdelay(1);
1289
1290	return 0;
1291}
1292
1293static long
1294intrepid_aack_delay_enable(struct device_node *node, long param, long value)
1295{
1296	unsigned long flags;
1297
1298	if (uninorth_rev < 0xd2)
1299		return -ENODEV;
1300
1301	LOCK(flags);
1302	if (param)
1303		UN_BIS(UNI_N_AACK_DELAY, UNI_N_AACK_DELAY_ENABLE);
1304	else
1305		UN_BIC(UNI_N_AACK_DELAY, UNI_N_AACK_DELAY_ENABLE);
1306	UNLOCK(flags);
1307
1308	return 0;
1309}
1310
1311
1312#endif /* CONFIG_PPC64 */
1313
1314static long
1315core99_read_gpio(struct device_node *node, long param, long value)
1316{
1317	struct macio_chip *macio = &macio_chips[0];
1318
1319	return MACIO_IN8(param);
1320}
1321
1322
1323static long
1324core99_write_gpio(struct device_node *node, long param, long value)
1325{
1326	struct macio_chip *macio = &macio_chips[0];
1327
1328	MACIO_OUT8(param, (u8)(value & 0xff));
1329	return 0;
1330}
1331
1332#ifdef CONFIG_PPC64
1333static long g5_gmac_enable(struct device_node *node, long param, long value)
1334{
1335	struct macio_chip *macio = &macio_chips[0];
1336	unsigned long flags;
1337
1338	if (node == NULL)
1339		return -ENODEV;
1340
1341	LOCK(flags);
1342	if (value) {
1343		MACIO_BIS(KEYLARGO_FCR1, K2_FCR1_GMAC_CLK_ENABLE);
1344		mb();
1345		k2_skiplist[0] = NULL;
1346	} else {
1347		k2_skiplist[0] = node;
1348		mb();
1349		MACIO_BIC(KEYLARGO_FCR1, K2_FCR1_GMAC_CLK_ENABLE);
1350	}
1351
1352	UNLOCK(flags);
1353	mdelay(1);
1354
1355	return 0;
1356}
1357
1358static long g5_fw_enable(struct device_node *node, long param, long value)
1359{
1360	struct macio_chip *macio = &macio_chips[0];
1361	unsigned long flags;
1362
1363	if (node == NULL)
1364		return -ENODEV;
1365
1366	LOCK(flags);
1367	if (value) {
1368		MACIO_BIS(KEYLARGO_FCR1, K2_FCR1_FW_CLK_ENABLE);
1369		mb();
1370		k2_skiplist[1] = NULL;
1371	} else {
1372		k2_skiplist[1] = node;
1373		mb();
1374		MACIO_BIC(KEYLARGO_FCR1, K2_FCR1_FW_CLK_ENABLE);
1375	}
1376
1377	UNLOCK(flags);
1378	mdelay(1);
1379
1380	return 0;
1381}
1382
1383static long g5_mpic_enable(struct device_node *node, long param, long value)
1384{
1385	unsigned long flags;
1386	struct device_node *parent = of_get_parent(node);
1387	int is_u3;
1388
1389	if (parent == NULL)
1390		return 0;
1391	is_u3 = of_node_name_eq(parent, "u3") || of_node_name_eq(parent, "u4");
1392	of_node_put(parent);
1393	if (!is_u3)
1394		return 0;
1395
1396	LOCK(flags);
1397	UN_BIS(U3_TOGGLE_REG, U3_MPIC_RESET | U3_MPIC_OUTPUT_ENABLE);
1398	UNLOCK(flags);
1399
1400	return 0;
1401}
1402
1403static long g5_eth_phy_reset(struct device_node *node, long param, long value)
1404{
1405	struct macio_chip *macio = &macio_chips[0];
1406	struct device_node *phy;
1407	int need_reset;
1408
1409	/*
1410	 * We must not reset the combo PHYs, only the BCM5221 found in
1411	 * the iMac G5.
1412	 */
1413	phy = of_get_next_child(node, NULL);
1414	if (!phy)
1415		return -ENODEV;
1416	need_reset = of_device_is_compatible(phy, "B5221");
1417	of_node_put(phy);
1418	if (!need_reset)
1419		return 0;
1420
1421	/* PHY reset is GPIO 29, not in device-tree unfortunately */
1422	MACIO_OUT8(K2_GPIO_EXTINT_0 + 29,
1423		   KEYLARGO_GPIO_OUTPUT_ENABLE | KEYLARGO_GPIO_OUTOUT_DATA);
1424	/* Thankfully, this is now always called at a time when we can
1425	 * schedule by sungem.
1426	 */
1427	msleep(10);
1428	MACIO_OUT8(K2_GPIO_EXTINT_0 + 29, 0);
1429
1430	return 0;
1431}
1432
1433static long g5_i2s_enable(struct device_node *node, long param, long value)
1434{
1435	/* Very crude implementation for now */
1436	struct macio_chip *macio = &macio_chips[0];
1437	unsigned long flags;
1438	int cell;
1439	u32 fcrs[3][3] = {
1440		{ 0,
1441		  K2_FCR1_I2S0_CELL_ENABLE |
1442		  K2_FCR1_I2S0_CLK_ENABLE_BIT | K2_FCR1_I2S0_ENABLE,
1443		  KL3_I2S0_CLK18_ENABLE
1444		},
1445		{ KL0_SCC_A_INTF_ENABLE,
1446		  K2_FCR1_I2S1_CELL_ENABLE |
1447		  K2_FCR1_I2S1_CLK_ENABLE_BIT | K2_FCR1_I2S1_ENABLE,
1448		  KL3_I2S1_CLK18_ENABLE
1449		},
1450		{ KL0_SCC_B_INTF_ENABLE,
1451		  SH_FCR1_I2S2_CELL_ENABLE |
1452		  SH_FCR1_I2S2_CLK_ENABLE_BIT | SH_FCR1_I2S2_ENABLE,
1453		  SH_FCR3_I2S2_CLK18_ENABLE
1454		},
1455	};
1456
1457	if (macio->type != macio_keylargo2 && macio->type != macio_shasta)
1458		return -ENODEV;
1459	if (strncmp(node->name, "i2s-", 4))
1460		return -ENODEV;
1461	cell = node->name[4] - 'a';
1462	switch(cell) {
1463	case 0:
1464	case 1:
1465		break;
1466	case 2:
1467		if (macio->type == macio_shasta)
1468			break;
1469		fallthrough;
1470	default:
1471		return -ENODEV;
1472	}
1473
1474	LOCK(flags);
1475	if (value) {
1476		MACIO_BIC(KEYLARGO_FCR0, fcrs[cell][0]);
1477		MACIO_BIS(KEYLARGO_FCR1, fcrs[cell][1]);
1478		MACIO_BIS(KEYLARGO_FCR3, fcrs[cell][2]);
1479	} else {
1480		MACIO_BIC(KEYLARGO_FCR3, fcrs[cell][2]);
1481		MACIO_BIC(KEYLARGO_FCR1, fcrs[cell][1]);
1482		MACIO_BIS(KEYLARGO_FCR0, fcrs[cell][0]);
1483	}
1484	udelay(10);
1485	UNLOCK(flags);
1486
1487	return 0;
1488}
1489
1490
1491#ifdef CONFIG_SMP
1492static long g5_reset_cpu(struct device_node *node, long param, long value)
1493{
1494	unsigned int reset_io = 0;
1495	unsigned long flags;
1496	struct macio_chip *macio;
1497	struct device_node *np;
1498
1499	macio = &macio_chips[0];
1500	if (macio->type != macio_keylargo2 && macio->type != macio_shasta)
1501		return -ENODEV;
1502
1503	for_each_of_cpu_node(np) {
1504		const u32 *rst = of_get_property(np, "soft-reset", NULL);
1505		if (!rst)
1506			continue;
1507		if (param == of_get_cpu_hwid(np, 0)) {
1508			of_node_put(np);
1509			reset_io = *rst;
1510			break;
1511		}
1512	}
1513	if (np == NULL || reset_io == 0)
1514		return -ENODEV;
1515
1516	LOCK(flags);
1517	MACIO_OUT8(reset_io, KEYLARGO_GPIO_OUTPUT_ENABLE);
1518	(void)MACIO_IN8(reset_io);
1519	udelay(1);
1520	MACIO_OUT8(reset_io, 0);
1521	(void)MACIO_IN8(reset_io);
1522	UNLOCK(flags);
1523
1524	return 0;
1525}
1526#endif /* CONFIG_SMP */
1527
1528/*
1529 * This can be called from pmac_smp so isn't static
1530 *
1531 * This takes the second CPU off the bus on dual CPU machines
1532 * running UP
1533 */
1534void __init g5_phy_disable_cpu1(void)
1535{
1536	if (uninorth_maj == 3)
1537		UN_OUT(U3_API_PHY_CONFIG_1, 0);
1538}
1539#endif /* CONFIG_PPC64 */
1540
1541#ifndef CONFIG_PPC64
1542
1543
1544#ifdef CONFIG_PM
1545static u32 save_gpio_levels[2];
1546static u8 save_gpio_extint[KEYLARGO_GPIO_EXTINT_CNT];
1547static u8 save_gpio_normal[KEYLARGO_GPIO_CNT];
1548static u32 save_unin_clock_ctl;
1549
1550static void keylargo_shutdown(struct macio_chip *macio, int sleep_mode)
1551{
1552	u32 temp;
1553
1554	if (sleep_mode) {
1555		mdelay(1);
1556		MACIO_BIS(KEYLARGO_FCR0, KL0_USB_REF_SUSPEND);
1557		(void)MACIO_IN32(KEYLARGO_FCR0);
1558		mdelay(1);
1559	}
1560
1561	MACIO_BIC(KEYLARGO_FCR0,KL0_SCCA_ENABLE | KL0_SCCB_ENABLE |
1562				KL0_SCC_CELL_ENABLE |
1563				KL0_IRDA_ENABLE | KL0_IRDA_CLK32_ENABLE |
1564				KL0_IRDA_CLK19_ENABLE);
1565
1566	MACIO_BIC(KEYLARGO_MBCR, KL_MBCR_MB0_DEV_MASK);
1567	MACIO_BIS(KEYLARGO_MBCR, KL_MBCR_MB0_IDE_ENABLE);
1568
1569	MACIO_BIC(KEYLARGO_FCR1,
1570		KL1_AUDIO_SEL_22MCLK | KL1_AUDIO_CLK_ENABLE_BIT |
1571		KL1_AUDIO_CLK_OUT_ENABLE | KL1_AUDIO_CELL_ENABLE |
1572		KL1_I2S0_CELL_ENABLE | KL1_I2S0_CLK_ENABLE_BIT |
1573		KL1_I2S0_ENABLE | KL1_I2S1_CELL_ENABLE |
1574		KL1_I2S1_CLK_ENABLE_BIT | KL1_I2S1_ENABLE |
1575		KL1_EIDE0_ENABLE | KL1_EIDE0_RESET_N |
1576		KL1_EIDE1_ENABLE | KL1_EIDE1_RESET_N |
1577		KL1_UIDE_ENABLE);
1578
1579	MACIO_BIS(KEYLARGO_FCR2, KL2_ALT_DATA_OUT);
1580	MACIO_BIC(KEYLARGO_FCR2, KL2_IOBUS_ENABLE);
1581
1582	temp = MACIO_IN32(KEYLARGO_FCR3);
1583	if (macio->rev >= 2) {
1584		temp |= KL3_SHUTDOWN_PLL2X;
1585		if (sleep_mode)
1586			temp |= KL3_SHUTDOWN_PLL_TOTAL;
1587	}
1588
1589	temp |= KL3_SHUTDOWN_PLLKW6 | KL3_SHUTDOWN_PLLKW4 |
1590		KL3_SHUTDOWN_PLLKW35;
1591	if (sleep_mode)
1592		temp |= KL3_SHUTDOWN_PLLKW12;
1593	temp &= ~(KL3_CLK66_ENABLE | KL3_CLK49_ENABLE | KL3_CLK45_ENABLE
1594		| KL3_CLK31_ENABLE | KL3_I2S1_CLK18_ENABLE | KL3_I2S0_CLK18_ENABLE);
1595	if (sleep_mode)
1596		temp &= ~(KL3_TIMER_CLK18_ENABLE | KL3_VIA_CLK16_ENABLE);
1597	MACIO_OUT32(KEYLARGO_FCR3, temp);
1598
1599	/* Flush posted writes & wait a bit */
1600	(void)MACIO_IN32(KEYLARGO_FCR0); mdelay(1);
1601}
1602
1603static void pangea_shutdown(struct macio_chip *macio, int sleep_mode)
1604{
1605	u32 temp;
1606
1607	MACIO_BIC(KEYLARGO_FCR0,KL0_SCCA_ENABLE | KL0_SCCB_ENABLE |
1608				KL0_SCC_CELL_ENABLE |
1609				KL0_USB0_CELL_ENABLE | KL0_USB1_CELL_ENABLE);
1610
1611	MACIO_BIC(KEYLARGO_FCR1,
1612		KL1_AUDIO_SEL_22MCLK | KL1_AUDIO_CLK_ENABLE_BIT |
1613		KL1_AUDIO_CLK_OUT_ENABLE | KL1_AUDIO_CELL_ENABLE |
1614		KL1_I2S0_CELL_ENABLE | KL1_I2S0_CLK_ENABLE_BIT |
1615		KL1_I2S0_ENABLE | KL1_I2S1_CELL_ENABLE |
1616		KL1_I2S1_CLK_ENABLE_BIT | KL1_I2S1_ENABLE |
1617		KL1_UIDE_ENABLE);
1618	if (pmac_mb.board_flags & PMAC_MB_MOBILE)
1619		MACIO_BIC(KEYLARGO_FCR1, KL1_UIDE_RESET_N);
1620
1621	MACIO_BIS(KEYLARGO_FCR2, KL2_ALT_DATA_OUT);
1622
1623	temp = MACIO_IN32(KEYLARGO_FCR3);
1624	temp |= KL3_SHUTDOWN_PLLKW6 | KL3_SHUTDOWN_PLLKW4 |
1625		KL3_SHUTDOWN_PLLKW35;
1626	temp &= ~(KL3_CLK49_ENABLE | KL3_CLK45_ENABLE | KL3_CLK31_ENABLE
1627		| KL3_I2S0_CLK18_ENABLE | KL3_I2S1_CLK18_ENABLE);
1628	if (sleep_mode)
1629		temp &= ~(KL3_VIA_CLK16_ENABLE | KL3_TIMER_CLK18_ENABLE);
1630	MACIO_OUT32(KEYLARGO_FCR3, temp);
1631
1632	/* Flush posted writes & wait a bit */
1633	(void)MACIO_IN32(KEYLARGO_FCR0); mdelay(1);
1634}
1635
1636static void intrepid_shutdown(struct macio_chip *macio, int sleep_mode)
1637{
1638	u32 temp;
1639
1640	MACIO_BIC(KEYLARGO_FCR0,KL0_SCCA_ENABLE | KL0_SCCB_ENABLE |
1641		  KL0_SCC_CELL_ENABLE);
1642
1643	MACIO_BIC(KEYLARGO_FCR1,
1644		KL1_I2S0_CELL_ENABLE | KL1_I2S0_CLK_ENABLE_BIT |
1645		KL1_I2S0_ENABLE | KL1_I2S1_CELL_ENABLE |
1646		KL1_I2S1_CLK_ENABLE_BIT | KL1_I2S1_ENABLE |
1647		KL1_EIDE0_ENABLE);
1648	if (pmac_mb.board_flags & PMAC_MB_MOBILE)
1649		MACIO_BIC(KEYLARGO_FCR1, KL1_UIDE_RESET_N);
1650
1651	temp = MACIO_IN32(KEYLARGO_FCR3);
1652	temp &= ~(KL3_CLK49_ENABLE | KL3_CLK45_ENABLE |
1653		  KL3_I2S1_CLK18_ENABLE | KL3_I2S0_CLK18_ENABLE);
1654	if (sleep_mode)
1655		temp &= ~(KL3_TIMER_CLK18_ENABLE | KL3_IT_VIA_CLK32_ENABLE);
1656	MACIO_OUT32(KEYLARGO_FCR3, temp);
1657
1658	/* Flush posted writes & wait a bit */
1659	(void)MACIO_IN32(KEYLARGO_FCR0);
1660	mdelay(10);
1661}
1662
1663
1664static int
1665core99_sleep(void)
1666{
1667	struct macio_chip *macio;
1668	int i;
1669
1670	macio = &macio_chips[0];
1671	if (macio->type != macio_keylargo && macio->type != macio_pangea &&
1672	    macio->type != macio_intrepid)
1673		return -ENODEV;
1674
1675	/* We power off the wireless slot in case it was not done
1676	 * by the driver. We don't power it on automatically however
1677	 */
1678	if (macio->flags & MACIO_FLAG_AIRPORT_ON)
1679		core99_airport_enable(macio->of_node, 0, 0);
1680
1681	/* We power off the FW cable. Should be done by the driver... */
1682	if (macio->flags & MACIO_FLAG_FW_SUPPORTED) {
1683		core99_firewire_enable(NULL, 0, 0);
1684		core99_firewire_cable_power(NULL, 0, 0);
1685	}
1686
1687	/* We make sure int. modem is off (in case driver lost it) */
1688	if (macio->type == macio_keylargo)
1689		core99_modem_enable(macio->of_node, 0, 0);
1690	else
1691		pangea_modem_enable(macio->of_node, 0, 0);
1692
1693	/* We make sure the sound is off as well */
1694	core99_sound_chip_enable(macio->of_node, 0, 0);
1695
1696	/*
1697	 * Save various bits of KeyLargo
1698	 */
1699
1700	/* Save the state of the various GPIOs */
1701	save_gpio_levels[0] = MACIO_IN32(KEYLARGO_GPIO_LEVELS0);
1702	save_gpio_levels[1] = MACIO_IN32(KEYLARGO_GPIO_LEVELS1);
1703	for (i=0; i<KEYLARGO_GPIO_EXTINT_CNT; i++)
1704		save_gpio_extint[i] = MACIO_IN8(KEYLARGO_GPIO_EXTINT_0+i);
1705	for (i=0; i<KEYLARGO_GPIO_CNT; i++)
1706		save_gpio_normal[i] = MACIO_IN8(KEYLARGO_GPIO_0+i);
1707
1708	/* Save the FCRs */
1709	if (macio->type == macio_keylargo)
1710		save_mbcr = MACIO_IN32(KEYLARGO_MBCR);
1711	save_fcr[0] = MACIO_IN32(KEYLARGO_FCR0);
1712	save_fcr[1] = MACIO_IN32(KEYLARGO_FCR1);
1713	save_fcr[2] = MACIO_IN32(KEYLARGO_FCR2);
1714	save_fcr[3] = MACIO_IN32(KEYLARGO_FCR3);
1715	save_fcr[4] = MACIO_IN32(KEYLARGO_FCR4);
1716	if (macio->type == macio_pangea || macio->type == macio_intrepid)
1717		save_fcr[5] = MACIO_IN32(KEYLARGO_FCR5);
1718
1719	/* Save state & config of DBDMA channels */
1720	dbdma_save(macio, save_dbdma);
1721
1722	/*
1723	 * Turn off as much as we can
1724	 */
1725	if (macio->type == macio_pangea)
1726		pangea_shutdown(macio, 1);
1727	else if (macio->type == macio_intrepid)
1728		intrepid_shutdown(macio, 1);
1729	else if (macio->type == macio_keylargo)
1730		keylargo_shutdown(macio, 1);
1731
1732	/*
1733	 * Put the host bridge to sleep
1734	 */
1735
1736	save_unin_clock_ctl = UN_IN(UNI_N_CLOCK_CNTL);
1737	/* Note: do not switch GMAC off, driver does it when necessary, WOL must keep it
1738	 * enabled !
1739	 */
1740	UN_OUT(UNI_N_CLOCK_CNTL, save_unin_clock_ctl &
1741	       ~(/*UNI_N_CLOCK_CNTL_GMAC|*/UNI_N_CLOCK_CNTL_FW/*|UNI_N_CLOCK_CNTL_PCI*/));
1742	udelay(100);
1743	UN_OUT(UNI_N_HWINIT_STATE, UNI_N_HWINIT_STATE_SLEEPING);
1744	UN_OUT(UNI_N_POWER_MGT, UNI_N_POWER_MGT_SLEEP);
1745	mdelay(10);
1746
1747	/*
1748	 * FIXME: A bit of black magic with OpenPIC (don't ask me why)
1749	 */
1750	if (pmac_mb.model_id == PMAC_TYPE_SAWTOOTH) {
1751		MACIO_BIS(0x506e0, 0x00400000);
1752		MACIO_BIS(0x506e0, 0x80000000);
1753	}
1754	return 0;
1755}
1756
1757static int
1758core99_wake_up(void)
1759{
1760	struct macio_chip *macio;
1761	int i;
1762
1763	macio = &macio_chips[0];
1764	if (macio->type != macio_keylargo && macio->type != macio_pangea &&
1765	    macio->type != macio_intrepid)
1766		return -ENODEV;
1767
1768	/*
1769	 * Wakeup the host bridge
1770	 */
1771	UN_OUT(UNI_N_POWER_MGT, UNI_N_POWER_MGT_NORMAL);
1772	udelay(10);
1773	UN_OUT(UNI_N_HWINIT_STATE, UNI_N_HWINIT_STATE_RUNNING);
1774	udelay(10);
1775
1776	/*
1777	 * Restore KeyLargo
1778	 */
1779
1780	if (macio->type == macio_keylargo) {
1781		MACIO_OUT32(KEYLARGO_MBCR, save_mbcr);
1782		(void)MACIO_IN32(KEYLARGO_MBCR); udelay(10);
1783	}
1784	MACIO_OUT32(KEYLARGO_FCR0, save_fcr[0]);
1785	(void)MACIO_IN32(KEYLARGO_FCR0); udelay(10);
1786	MACIO_OUT32(KEYLARGO_FCR1, save_fcr[1]);
1787	(void)MACIO_IN32(KEYLARGO_FCR1); udelay(10);
1788	MACIO_OUT32(KEYLARGO_FCR2, save_fcr[2]);
1789	(void)MACIO_IN32(KEYLARGO_FCR2); udelay(10);
1790	MACIO_OUT32(KEYLARGO_FCR3, save_fcr[3]);
1791	(void)MACIO_IN32(KEYLARGO_FCR3); udelay(10);
1792	MACIO_OUT32(KEYLARGO_FCR4, save_fcr[4]);
1793	(void)MACIO_IN32(KEYLARGO_FCR4); udelay(10);
1794	if (macio->type == macio_pangea || macio->type == macio_intrepid) {
1795		MACIO_OUT32(KEYLARGO_FCR5, save_fcr[5]);
1796		(void)MACIO_IN32(KEYLARGO_FCR5); udelay(10);
1797	}
1798
1799	dbdma_restore(macio, save_dbdma);
1800
1801	MACIO_OUT32(KEYLARGO_GPIO_LEVELS0, save_gpio_levels[0]);
1802	MACIO_OUT32(KEYLARGO_GPIO_LEVELS1, save_gpio_levels[1]);
1803	for (i=0; i<KEYLARGO_GPIO_EXTINT_CNT; i++)
1804		MACIO_OUT8(KEYLARGO_GPIO_EXTINT_0+i, save_gpio_extint[i]);
1805	for (i=0; i<KEYLARGO_GPIO_CNT; i++)
1806		MACIO_OUT8(KEYLARGO_GPIO_0+i, save_gpio_normal[i]);
1807
1808	/* FIXME more black magic with OpenPIC ... */
1809	if (pmac_mb.model_id == PMAC_TYPE_SAWTOOTH) {
1810		MACIO_BIC(0x506e0, 0x00400000);
1811		MACIO_BIC(0x506e0, 0x80000000);
1812	}
1813
1814	UN_OUT(UNI_N_CLOCK_CNTL, save_unin_clock_ctl);
1815	udelay(100);
1816
1817	return 0;
1818}
1819
1820#endif /* CONFIG_PM */
1821
1822static long
1823core99_sleep_state(struct device_node *node, long param, long value)
1824{
1825	/* Param == 1 means to enter the "fake sleep" mode that is
1826	 * used for CPU speed switch
1827	 */
1828	if (param == 1) {
1829		if (value == 1) {
1830			UN_OUT(UNI_N_HWINIT_STATE, UNI_N_HWINIT_STATE_SLEEPING);
1831			UN_OUT(UNI_N_POWER_MGT, UNI_N_POWER_MGT_IDLE2);
1832		} else {
1833			UN_OUT(UNI_N_POWER_MGT, UNI_N_POWER_MGT_NORMAL);
1834			udelay(10);
1835			UN_OUT(UNI_N_HWINIT_STATE, UNI_N_HWINIT_STATE_RUNNING);
1836			udelay(10);
1837		}
1838		return 0;
1839	}
1840	if ((pmac_mb.board_flags & PMAC_MB_CAN_SLEEP) == 0)
1841		return -EPERM;
1842
1843#ifdef CONFIG_PM
1844	if (value == 1)
1845		return core99_sleep();
1846	else if (value == 0)
1847		return core99_wake_up();
1848
1849#endif /* CONFIG_PM */
1850	return 0;
1851}
1852
1853#endif /* CONFIG_PPC64 */
1854
1855static long
1856generic_dev_can_wake(struct device_node *node, long param, long value)
1857{
1858	/* Todo: eventually check we are really dealing with on-board
1859	 * video device ...
1860	 */
1861
1862	if (pmac_mb.board_flags & PMAC_MB_MAY_SLEEP)
1863		pmac_mb.board_flags |= PMAC_MB_CAN_SLEEP;
1864	return 0;
1865}
1866
1867static long generic_get_mb_info(struct device_node *node, long param, long value)
1868{
1869	switch(param) {
1870		case PMAC_MB_INFO_MODEL:
1871			return pmac_mb.model_id;
1872		case PMAC_MB_INFO_FLAGS:
1873			return pmac_mb.board_flags;
1874		case PMAC_MB_INFO_NAME:
1875			/* hack hack hack... but should work */
1876			*((const char **)value) = pmac_mb.model_name;
1877			return 0;
1878	}
1879	return -EINVAL;
1880}
1881
1882
1883/*
1884 * Table definitions
1885 */
1886
1887/* Used on any machine
1888 */
1889static struct feature_table_entry any_features[] = {
1890	{ PMAC_FTR_GET_MB_INFO,		generic_get_mb_info },
1891	{ PMAC_FTR_DEVICE_CAN_WAKE,	generic_dev_can_wake },
1892	{ 0, NULL }
1893};
1894
1895#ifndef CONFIG_PPC64
1896
1897/* OHare based motherboards. Currently, we only use these on the
1898 * 2400,3400 and 3500 series powerbooks. Some older desktops seem
1899 * to have issues with turning on/off those asic cells
1900 */
1901static struct feature_table_entry ohare_features[] = {
1902	{ PMAC_FTR_SCC_ENABLE,		ohare_htw_scc_enable },
1903	{ PMAC_FTR_SWIM3_ENABLE,	ohare_floppy_enable },
1904	{ PMAC_FTR_MESH_ENABLE,		ohare_mesh_enable },
1905	{ PMAC_FTR_IDE_ENABLE,		ohare_ide_enable},
1906	{ PMAC_FTR_IDE_RESET,		ohare_ide_reset},
1907	{ PMAC_FTR_SLEEP_STATE,		ohare_sleep_state },
1908	{ 0, NULL }
1909};
1910
1911/* Heathrow desktop machines (Beige G3).
1912 * Separated as some features couldn't be properly tested
1913 * and the serial port control bits appear to confuse it.
1914 */
1915static struct feature_table_entry heathrow_desktop_features[] = {
1916	{ PMAC_FTR_SWIM3_ENABLE,	heathrow_floppy_enable },
1917	{ PMAC_FTR_MESH_ENABLE,		heathrow_mesh_enable },
1918	{ PMAC_FTR_IDE_ENABLE,		heathrow_ide_enable },
1919	{ PMAC_FTR_IDE_RESET,		heathrow_ide_reset },
1920	{ PMAC_FTR_BMAC_ENABLE,		heathrow_bmac_enable },
1921	{ 0, NULL }
1922};
1923
1924/* Heathrow based laptop, that is the Wallstreet and mainstreet
1925 * powerbooks.
1926 */
1927static struct feature_table_entry heathrow_laptop_features[] = {
1928	{ PMAC_FTR_SCC_ENABLE,		ohare_htw_scc_enable },
1929	{ PMAC_FTR_MODEM_ENABLE,	heathrow_modem_enable },
1930	{ PMAC_FTR_SWIM3_ENABLE,	heathrow_floppy_enable },
1931	{ PMAC_FTR_MESH_ENABLE,		heathrow_mesh_enable },
1932	{ PMAC_FTR_IDE_ENABLE,		heathrow_ide_enable },
1933	{ PMAC_FTR_IDE_RESET,		heathrow_ide_reset },
1934	{ PMAC_FTR_BMAC_ENABLE,		heathrow_bmac_enable },
1935	{ PMAC_FTR_SOUND_CHIP_ENABLE,	heathrow_sound_enable },
1936	{ PMAC_FTR_SLEEP_STATE,		heathrow_sleep_state },
1937	{ 0, NULL }
1938};
1939
1940/* Paddington based machines
1941 * The lombard (101) powerbook, first iMac models, B&W G3 and Yikes G4.
1942 */
1943static struct feature_table_entry paddington_features[] = {
1944	{ PMAC_FTR_SCC_ENABLE,		ohare_htw_scc_enable },
1945	{ PMAC_FTR_MODEM_ENABLE,	heathrow_modem_enable },
1946	{ PMAC_FTR_SWIM3_ENABLE,	heathrow_floppy_enable },
1947	{ PMAC_FTR_MESH_ENABLE,		heathrow_mesh_enable },
1948	{ PMAC_FTR_IDE_ENABLE,		heathrow_ide_enable },
1949	{ PMAC_FTR_IDE_RESET,		heathrow_ide_reset },
1950	{ PMAC_FTR_BMAC_ENABLE,		heathrow_bmac_enable },
1951	{ PMAC_FTR_SOUND_CHIP_ENABLE,	heathrow_sound_enable },
1952	{ PMAC_FTR_SLEEP_STATE,		heathrow_sleep_state },
1953	{ 0, NULL }
1954};
1955
1956/* Core99 & MacRISC 2 machines (all machines released since the
1957 * iBook (included), that is all AGP machines, except pangea
1958 * chipset. The pangea chipset is the "combo" UniNorth/KeyLargo
1959 * used on iBook2 & iMac "flow power".
1960 */
1961static struct feature_table_entry core99_features[] = {
1962	{ PMAC_FTR_SCC_ENABLE,		core99_scc_enable },
1963	{ PMAC_FTR_MODEM_ENABLE,	core99_modem_enable },
1964	{ PMAC_FTR_IDE_ENABLE,		core99_ide_enable },
1965	{ PMAC_FTR_IDE_RESET,		core99_ide_reset },
1966	{ PMAC_FTR_GMAC_ENABLE,		core99_gmac_enable },
1967	{ PMAC_FTR_GMAC_PHY_RESET,	core99_gmac_phy_reset },
1968	{ PMAC_FTR_SOUND_CHIP_ENABLE,	core99_sound_chip_enable },
1969	{ PMAC_FTR_AIRPORT_ENABLE,	core99_airport_enable },
1970	{ PMAC_FTR_USB_ENABLE,		core99_usb_enable },
1971	{ PMAC_FTR_1394_ENABLE,		core99_firewire_enable },
1972	{ PMAC_FTR_1394_CABLE_POWER,	core99_firewire_cable_power },
1973#ifdef CONFIG_PM
1974	{ PMAC_FTR_SLEEP_STATE,		core99_sleep_state },
1975#endif
1976#ifdef CONFIG_SMP
1977	{ PMAC_FTR_RESET_CPU,		core99_reset_cpu },
1978#endif /* CONFIG_SMP */
1979	{ PMAC_FTR_READ_GPIO,		core99_read_gpio },
1980	{ PMAC_FTR_WRITE_GPIO,		core99_write_gpio },
1981	{ 0, NULL }
1982};
1983
1984/* RackMac
1985 */
1986static struct feature_table_entry rackmac_features[] = {
1987	{ PMAC_FTR_SCC_ENABLE,		core99_scc_enable },
1988	{ PMAC_FTR_IDE_ENABLE,		core99_ide_enable },
1989	{ PMAC_FTR_IDE_RESET,		core99_ide_reset },
1990	{ PMAC_FTR_GMAC_ENABLE,		core99_gmac_enable },
1991	{ PMAC_FTR_GMAC_PHY_RESET,	core99_gmac_phy_reset },
1992	{ PMAC_FTR_USB_ENABLE,		core99_usb_enable },
1993	{ PMAC_FTR_1394_ENABLE,		core99_firewire_enable },
1994	{ PMAC_FTR_1394_CABLE_POWER,	core99_firewire_cable_power },
1995	{ PMAC_FTR_SLEEP_STATE,		core99_sleep_state },
1996#ifdef CONFIG_SMP
1997	{ PMAC_FTR_RESET_CPU,		core99_reset_cpu },
1998#endif /* CONFIG_SMP */
1999	{ PMAC_FTR_READ_GPIO,		core99_read_gpio },
2000	{ PMAC_FTR_WRITE_GPIO,		core99_write_gpio },
2001	{ 0, NULL }
2002};
2003
2004/* Pangea features
2005 */
2006static struct feature_table_entry pangea_features[] = {
2007	{ PMAC_FTR_SCC_ENABLE,		core99_scc_enable },
2008	{ PMAC_FTR_MODEM_ENABLE,	pangea_modem_enable },
2009	{ PMAC_FTR_IDE_ENABLE,		core99_ide_enable },
2010	{ PMAC_FTR_IDE_RESET,		core99_ide_reset },
2011	{ PMAC_FTR_GMAC_ENABLE,		core99_gmac_enable },
2012	{ PMAC_FTR_GMAC_PHY_RESET,	core99_gmac_phy_reset },
2013	{ PMAC_FTR_SOUND_CHIP_ENABLE,	core99_sound_chip_enable },
2014	{ PMAC_FTR_AIRPORT_ENABLE,	core99_airport_enable },
2015	{ PMAC_FTR_USB_ENABLE,		core99_usb_enable },
2016	{ PMAC_FTR_1394_ENABLE,		core99_firewire_enable },
2017	{ PMAC_FTR_1394_CABLE_POWER,	core99_firewire_cable_power },
2018	{ PMAC_FTR_SLEEP_STATE,		core99_sleep_state },
2019	{ PMAC_FTR_READ_GPIO,		core99_read_gpio },
2020	{ PMAC_FTR_WRITE_GPIO,		core99_write_gpio },
2021	{ 0, NULL }
2022};
2023
2024/* Intrepid features
2025 */
2026static struct feature_table_entry intrepid_features[] = {
2027	{ PMAC_FTR_SCC_ENABLE,		core99_scc_enable },
2028	{ PMAC_FTR_MODEM_ENABLE,	pangea_modem_enable },
2029	{ PMAC_FTR_IDE_ENABLE,		core99_ide_enable },
2030	{ PMAC_FTR_IDE_RESET,		core99_ide_reset },
2031	{ PMAC_FTR_GMAC_ENABLE,		core99_gmac_enable },
2032	{ PMAC_FTR_GMAC_PHY_RESET,	core99_gmac_phy_reset },
2033	{ PMAC_FTR_SOUND_CHIP_ENABLE,	core99_sound_chip_enable },
2034	{ PMAC_FTR_AIRPORT_ENABLE,	core99_airport_enable },
2035	{ PMAC_FTR_USB_ENABLE,		core99_usb_enable },
2036	{ PMAC_FTR_1394_ENABLE,		core99_firewire_enable },
2037	{ PMAC_FTR_1394_CABLE_POWER,	core99_firewire_cable_power },
2038	{ PMAC_FTR_SLEEP_STATE,		core99_sleep_state },
2039	{ PMAC_FTR_READ_GPIO,		core99_read_gpio },
2040	{ PMAC_FTR_WRITE_GPIO,		core99_write_gpio },
2041	{ PMAC_FTR_AACK_DELAY_ENABLE,	intrepid_aack_delay_enable },
2042	{ 0, NULL }
2043};
2044
2045#else /* CONFIG_PPC64 */
2046
2047/* G5 features
2048 */
2049static struct feature_table_entry g5_features[] = {
2050	{ PMAC_FTR_GMAC_ENABLE,		g5_gmac_enable },
2051	{ PMAC_FTR_1394_ENABLE,		g5_fw_enable },
2052	{ PMAC_FTR_ENABLE_MPIC,		g5_mpic_enable },
2053	{ PMAC_FTR_GMAC_PHY_RESET,	g5_eth_phy_reset },
2054	{ PMAC_FTR_SOUND_CHIP_ENABLE,	g5_i2s_enable },
2055#ifdef CONFIG_SMP
2056	{ PMAC_FTR_RESET_CPU,		g5_reset_cpu },
2057#endif /* CONFIG_SMP */
2058	{ PMAC_FTR_READ_GPIO,		core99_read_gpio },
2059	{ PMAC_FTR_WRITE_GPIO,		core99_write_gpio },
2060	{ 0, NULL }
2061};
2062
2063#endif /* CONFIG_PPC64 */
2064
2065static struct pmac_mb_def pmac_mb_defs[] = {
2066#ifndef CONFIG_PPC64
2067	/*
2068	 * Desktops
2069	 */
2070
2071	{	"AAPL,8500",			"PowerMac 8500/8600",
2072		PMAC_TYPE_PSURGE,		NULL,
2073		0
2074	},
2075	{	"AAPL,9500",			"PowerMac 9500/9600",
2076		PMAC_TYPE_PSURGE,		NULL,
2077		0
2078	},
2079	{	"AAPL,7200",			"PowerMac 7200",
2080		PMAC_TYPE_PSURGE,		NULL,
2081		0
2082	},
2083	{	"AAPL,7300",			"PowerMac 7200/7300",
2084		PMAC_TYPE_PSURGE,		NULL,
2085		0
2086	},
2087	{	"AAPL,7500",			"PowerMac 7500",
2088		PMAC_TYPE_PSURGE,		NULL,
2089		0
2090	},
2091	{	"AAPL,ShinerESB",		"Apple Network Server",
2092		PMAC_TYPE_ANS,			NULL,
2093		0
2094	},
2095	{	"AAPL,e407",			"Alchemy",
2096		PMAC_TYPE_ALCHEMY,		NULL,
2097		0
2098	},
2099	{	"AAPL,e411",			"Gazelle",
2100		PMAC_TYPE_GAZELLE,		NULL,
2101		0
2102	},
2103	{	"AAPL,Gossamer",		"PowerMac G3 (Gossamer)",
2104		PMAC_TYPE_GOSSAMER,		heathrow_desktop_features,
2105		0
2106	},
2107	{	"AAPL,PowerMac G3",		"PowerMac G3 (Silk)",
2108		PMAC_TYPE_SILK,			heathrow_desktop_features,
2109		0
2110	},
2111	{	"PowerMac1,1",			"Blue&White G3",
2112		PMAC_TYPE_YOSEMITE,		paddington_features,
2113		0
2114	},
2115	{	"PowerMac1,2",			"PowerMac G4 PCI Graphics",
2116		PMAC_TYPE_YIKES,		paddington_features,
2117		0
2118	},
2119	{	"PowerMac2,1",			"iMac FireWire",
2120		PMAC_TYPE_FW_IMAC,		core99_features,
2121		PMAC_MB_MAY_SLEEP | PMAC_MB_OLD_CORE99
2122	},
2123	{	"PowerMac2,2",			"iMac FireWire",
2124		PMAC_TYPE_FW_IMAC,		core99_features,
2125		PMAC_MB_MAY_SLEEP | PMAC_MB_OLD_CORE99
2126	},
2127	{	"PowerMac3,1",			"PowerMac G4 AGP Graphics",
2128		PMAC_TYPE_SAWTOOTH,		core99_features,
2129		PMAC_MB_OLD_CORE99
2130	},
2131	{	"PowerMac3,2",			"PowerMac G4 AGP Graphics",
2132		PMAC_TYPE_SAWTOOTH,		core99_features,
2133		PMAC_MB_MAY_SLEEP | PMAC_MB_OLD_CORE99
2134	},
2135	{	"PowerMac3,3",			"PowerMac G4 AGP Graphics",
2136		PMAC_TYPE_SAWTOOTH,		core99_features,
2137		PMAC_MB_MAY_SLEEP | PMAC_MB_OLD_CORE99
2138	},
2139	{	"PowerMac3,4",			"PowerMac G4 Silver",
2140		PMAC_TYPE_QUICKSILVER,		core99_features,
2141		PMAC_MB_MAY_SLEEP
2142	},
2143	{	"PowerMac3,5",			"PowerMac G4 Silver",
2144		PMAC_TYPE_QUICKSILVER,		core99_features,
2145		PMAC_MB_MAY_SLEEP
2146	},
2147	{	"PowerMac3,6",			"PowerMac G4 Windtunnel",
2148		PMAC_TYPE_WINDTUNNEL,		core99_features,
2149		PMAC_MB_MAY_SLEEP,
2150	},
2151	{	"PowerMac4,1",			"iMac \"Flower Power\"",
2152		PMAC_TYPE_PANGEA_IMAC,		pangea_features,
2153		PMAC_MB_MAY_SLEEP
2154	},
2155	{	"PowerMac4,2",			"Flat panel iMac",
2156		PMAC_TYPE_FLAT_PANEL_IMAC,	pangea_features,
2157		PMAC_MB_CAN_SLEEP
2158	},
2159	{	"PowerMac4,4",			"eMac",
2160		PMAC_TYPE_EMAC,			core99_features,
2161		PMAC_MB_MAY_SLEEP
2162	},
2163	{	"PowerMac5,1",			"PowerMac G4 Cube",
2164		PMAC_TYPE_CUBE,			core99_features,
2165		PMAC_MB_MAY_SLEEP | PMAC_MB_OLD_CORE99
2166	},
2167	{	"PowerMac6,1",			"Flat panel iMac",
2168		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2169		PMAC_MB_MAY_SLEEP,
2170	},
2171	{	"PowerMac6,3",			"Flat panel iMac",
2172		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2173		PMAC_MB_MAY_SLEEP,
2174	},
2175	{	"PowerMac6,4",			"eMac",
2176		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2177		PMAC_MB_MAY_SLEEP,
2178	},
2179	{	"PowerMac10,1",			"Mac mini",
2180		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2181		PMAC_MB_MAY_SLEEP,
2182	},
2183	{       "PowerMac10,2",                 "Mac mini (Late 2005)",
2184		PMAC_TYPE_UNKNOWN_INTREPID,     intrepid_features,
2185		PMAC_MB_MAY_SLEEP,
2186	},
2187 	{	"iMac,1",			"iMac (first generation)",
2188		PMAC_TYPE_ORIG_IMAC,		paddington_features,
2189		0
2190	},
2191
2192	/*
2193	 * Xserve's
2194	 */
2195
2196	{	"RackMac1,1",			"XServe",
2197		PMAC_TYPE_RACKMAC,		rackmac_features,
2198		0,
2199	},
2200	{	"RackMac1,2",			"XServe rev. 2",
2201		PMAC_TYPE_RACKMAC,		rackmac_features,
2202		0,
2203	},
2204
2205	/*
2206	 * Laptops
2207	 */
2208
2209	{	"AAPL,3400/2400",		"PowerBook 3400",
2210		PMAC_TYPE_HOOPER,		ohare_features,
2211		PMAC_MB_CAN_SLEEP | PMAC_MB_MOBILE
2212	},
2213	{	"AAPL,3500",			"PowerBook 3500",
2214		PMAC_TYPE_KANGA,		ohare_features,
2215		PMAC_MB_CAN_SLEEP | PMAC_MB_MOBILE
2216	},
2217	{	"AAPL,PowerBook1998",		"PowerBook Wallstreet",
2218		PMAC_TYPE_WALLSTREET,		heathrow_laptop_features,
2219		PMAC_MB_CAN_SLEEP | PMAC_MB_MOBILE
2220	},
2221	{	"PowerBook1,1",			"PowerBook 101 (Lombard)",
2222		PMAC_TYPE_101_PBOOK,		paddington_features,
2223		PMAC_MB_CAN_SLEEP | PMAC_MB_MOBILE
2224	},
2225	{	"PowerBook2,1",			"iBook (first generation)",
2226		PMAC_TYPE_ORIG_IBOOK,		core99_features,
2227		PMAC_MB_CAN_SLEEP | PMAC_MB_OLD_CORE99 | PMAC_MB_MOBILE
2228	},
2229	{	"PowerBook2,2",			"iBook FireWire",
2230		PMAC_TYPE_FW_IBOOK,		core99_features,
2231		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER |
2232		PMAC_MB_OLD_CORE99 | PMAC_MB_MOBILE
2233	},
2234	{	"PowerBook3,1",			"PowerBook Pismo",
2235		PMAC_TYPE_PISMO,		core99_features,
2236		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER |
2237		PMAC_MB_OLD_CORE99 | PMAC_MB_MOBILE
2238	},
2239	{	"PowerBook3,2",			"PowerBook Titanium",
2240		PMAC_TYPE_TITANIUM,		core99_features,
2241		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE
2242	},
2243	{	"PowerBook3,3",			"PowerBook Titanium II",
2244		PMAC_TYPE_TITANIUM2,		core99_features,
2245		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE
2246	},
2247	{	"PowerBook3,4",			"PowerBook Titanium III",
2248		PMAC_TYPE_TITANIUM3,		core99_features,
2249		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE
2250	},
2251	{	"PowerBook3,5",			"PowerBook Titanium IV",
2252		PMAC_TYPE_TITANIUM4,		core99_features,
2253		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE
2254	},
2255	{	"PowerBook4,1",			"iBook 2",
2256		PMAC_TYPE_IBOOK2,		pangea_features,
2257		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE
2258	},
2259	{	"PowerBook4,2",			"iBook 2",
2260		PMAC_TYPE_IBOOK2,		pangea_features,
2261		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE
2262	},
2263	{	"PowerBook4,3",			"iBook 2 rev. 2",
2264		PMAC_TYPE_IBOOK2,		pangea_features,
2265		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE
2266	},
2267	{	"PowerBook5,1",			"PowerBook G4 17\"",
2268		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2269		PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2270	},
2271	{	"PowerBook5,2",			"PowerBook G4 15\"",
2272		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2273		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2274	},
2275	{	"PowerBook5,3",			"PowerBook G4 17\"",
2276		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2277		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2278	},
2279	{	"PowerBook5,4",			"PowerBook G4 15\"",
2280		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2281		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2282	},
2283	{	"PowerBook5,5",			"PowerBook G4 17\"",
2284		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2285		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2286	},
2287	{	"PowerBook5,6",			"PowerBook G4 15\"",
2288		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2289		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2290	},
2291	{	"PowerBook5,7",			"PowerBook G4 17\"",
2292		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2293		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2294	},
2295	{	"PowerBook5,8",			"PowerBook G4 15\"",
2296		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2297		PMAC_MB_MAY_SLEEP  | PMAC_MB_MOBILE,
2298	},
2299	{	"PowerBook5,9",			"PowerBook G4 17\"",
2300		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2301		PMAC_MB_MAY_SLEEP | PMAC_MB_MOBILE,
2302	},
2303	{	"PowerBook6,1",			"PowerBook G4 12\"",
2304		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2305		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2306	},
2307	{	"PowerBook6,2",			"PowerBook G4",
2308		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2309		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2310	},
2311	{	"PowerBook6,3",			"iBook G4",
2312		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2313		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2314	},
2315	{	"PowerBook6,4",			"PowerBook G4 12\"",
2316		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2317		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2318	},
2319	{	"PowerBook6,5",			"iBook G4",
2320		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2321		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2322	},
2323	{	"PowerBook6,7",			"iBook G4",
2324		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2325		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2326	},
2327	{	"PowerBook6,8",			"PowerBook G4 12\"",
2328		PMAC_TYPE_UNKNOWN_INTREPID,	intrepid_features,
2329		PMAC_MB_MAY_SLEEP | PMAC_MB_HAS_FW_POWER | PMAC_MB_MOBILE,
2330	},
2331#else /* CONFIG_PPC64 */
2332	{	"PowerMac7,2",			"PowerMac G5",
2333		PMAC_TYPE_POWERMAC_G5,		g5_features,
2334		0,
2335	},
2336#ifdef CONFIG_PPC64
2337	{	"PowerMac7,3",			"PowerMac G5",
2338		PMAC_TYPE_POWERMAC_G5,		g5_features,
2339		0,
2340	},
2341	{	"PowerMac8,1",			"iMac G5",
2342		PMAC_TYPE_IMAC_G5,		g5_features,
2343		0,
2344	},
2345	{	"PowerMac9,1",			"PowerMac G5",
2346		PMAC_TYPE_POWERMAC_G5_U3L,	g5_features,
2347		0,
2348	},
2349	{	"PowerMac11,2",			"PowerMac G5 Dual Core",
2350		PMAC_TYPE_POWERMAC_G5_U3L,	g5_features,
2351		0,
2352	},
2353	{	"PowerMac12,1",			"iMac G5 (iSight)",
2354		PMAC_TYPE_POWERMAC_G5_U3L,	g5_features,
2355		0,
2356	},
2357	{       "RackMac3,1",                   "XServe G5",
2358		PMAC_TYPE_XSERVE_G5,		g5_features,
2359		0,
2360	},
2361#endif /* CONFIG_PPC64 */
2362#endif /* CONFIG_PPC64 */
2363};
2364
2365/*
2366 * The toplevel feature_call callback
2367 */
2368long pmac_do_feature_call(unsigned int selector, ...)
2369{
2370	struct device_node *node;
2371	long param, value;
2372	int i;
2373	feature_call func = NULL;
2374	va_list args;
2375
2376	if (pmac_mb.features)
2377		for (i=0; pmac_mb.features[i].function; i++)
2378			if (pmac_mb.features[i].selector == selector) {
2379				func = pmac_mb.features[i].function;
2380				break;
2381			}
2382	if (!func)
2383		for (i=0; any_features[i].function; i++)
2384			if (any_features[i].selector == selector) {
2385				func = any_features[i].function;
2386				break;
2387			}
2388	if (!func)
2389		return -ENODEV;
2390
2391	va_start(args, selector);
2392	node = (struct device_node*)va_arg(args, void*);
2393	param = va_arg(args, long);
2394	value = va_arg(args, long);
2395	va_end(args);
2396
2397	return func(node, param, value);
2398}
2399
2400static int __init probe_motherboard(void)
2401{
2402	int i;
2403	struct macio_chip *macio = &macio_chips[0];
2404	const char *model = NULL;
2405	struct device_node *dt;
2406	int ret = 0;
2407
2408	/* Lookup known motherboard type in device-tree. First try an
2409	 * exact match on the "model" property, then try a "compatible"
2410	 * match is none is found.
2411	 */
2412	dt = of_find_node_by_name(NULL, "device-tree");
2413	if (dt != NULL)
2414		model = of_get_property(dt, "model", NULL);
2415	for(i=0; model && i<ARRAY_SIZE(pmac_mb_defs); i++) {
2416	    if (strcmp(model, pmac_mb_defs[i].model_string) == 0) {
2417		pmac_mb = pmac_mb_defs[i];
2418		goto found;
2419	    }
2420	}
2421	for(i=0; i<ARRAY_SIZE(pmac_mb_defs); i++) {
2422	    if (of_machine_is_compatible(pmac_mb_defs[i].model_string)) {
2423		pmac_mb = pmac_mb_defs[i];
2424		goto found;
2425	    }
2426	}
2427
2428	/* Fallback to selection depending on mac-io chip type */
2429	switch(macio->type) {
2430#ifndef CONFIG_PPC64
2431	    case macio_grand_central:
2432		pmac_mb.model_id = PMAC_TYPE_PSURGE;
2433		pmac_mb.model_name = "Unknown PowerSurge";
2434		break;
2435	    case macio_ohare:
2436		pmac_mb.model_id = PMAC_TYPE_UNKNOWN_OHARE;
2437		pmac_mb.model_name = "Unknown OHare-based";
2438		break;
2439	    case macio_heathrow:
2440		pmac_mb.model_id = PMAC_TYPE_UNKNOWN_HEATHROW;
2441		pmac_mb.model_name = "Unknown Heathrow-based";
2442		pmac_mb.features = heathrow_desktop_features;
2443		break;
2444	    case macio_paddington:
2445		pmac_mb.model_id = PMAC_TYPE_UNKNOWN_PADDINGTON;
2446		pmac_mb.model_name = "Unknown Paddington-based";
2447		pmac_mb.features = paddington_features;
2448		break;
2449	    case macio_keylargo:
2450		pmac_mb.model_id = PMAC_TYPE_UNKNOWN_CORE99;
2451		pmac_mb.model_name = "Unknown Keylargo-based";
2452		pmac_mb.features = core99_features;
2453		break;
2454	    case macio_pangea:
2455		pmac_mb.model_id = PMAC_TYPE_UNKNOWN_PANGEA;
2456		pmac_mb.model_name = "Unknown Pangea-based";
2457		pmac_mb.features = pangea_features;
2458		break;
2459	    case macio_intrepid:
2460		pmac_mb.model_id = PMAC_TYPE_UNKNOWN_INTREPID;
2461		pmac_mb.model_name = "Unknown Intrepid-based";
2462		pmac_mb.features = intrepid_features;
2463		break;
2464#else /* CONFIG_PPC64 */
2465	case macio_keylargo2:
2466		pmac_mb.model_id = PMAC_TYPE_UNKNOWN_K2;
2467		pmac_mb.model_name = "Unknown K2-based";
2468		pmac_mb.features = g5_features;
2469		break;
2470	case macio_shasta:
2471		pmac_mb.model_id = PMAC_TYPE_UNKNOWN_SHASTA;
2472		pmac_mb.model_name = "Unknown Shasta-based";
2473		pmac_mb.features = g5_features;
2474		break;
2475#endif /* CONFIG_PPC64 */
2476	default:
2477		ret = -ENODEV;
2478		goto done;
2479	}
2480found:
2481#ifndef CONFIG_PPC64
2482	/* Fixup Hooper vs. Comet */
2483	if (pmac_mb.model_id == PMAC_TYPE_HOOPER) {
2484		u32 __iomem * mach_id_ptr = ioremap(0xf3000034, 4);
2485		if (!mach_id_ptr) {
2486			ret = -ENODEV;
2487			goto done;
2488		}
2489		/* Here, I used to disable the media-bay on comet. It
2490		 * appears this is wrong, the floppy connector is actually
2491		 * a kind of media-bay and works with the current driver.
2492		 */
2493		if (__raw_readl(mach_id_ptr) & 0x20000000UL)
2494			pmac_mb.model_id = PMAC_TYPE_COMET;
2495		iounmap(mach_id_ptr);
2496	}
2497
2498	/* Set default value of powersave_nap on machines that support it.
2499	 * It appears that uninorth rev 3 has a problem with it, we don't
2500	 * enable it on those. In theory, the flush-on-lock property is
2501	 * supposed to be set when not supported, but I'm not very confident
2502	 * that all Apple OF revs did it properly, I do it the paranoid way.
2503	 */
2504	if (uninorth_base && uninorth_rev > 3) {
2505		struct device_node *np;
2506
2507		for_each_of_cpu_node(np) {
2508			int cpu_count = 1;
2509
2510			/* Nap mode not supported on SMP */
2511			if (of_property_read_bool(np, "flush-on-lock") ||
2512			    (cpu_count > 1)) {
2513				powersave_nap = 0;
2514				of_node_put(np);
2515				break;
2516			}
2517
2518			cpu_count++;
2519			powersave_nap = 1;
2520		}
2521	}
2522	if (powersave_nap)
2523		printk(KERN_DEBUG "Processor NAP mode on idle enabled.\n");
2524
2525	/* On CPUs that support it (750FX), lowspeed by default during
2526	 * NAP mode
2527	 */
2528	powersave_lowspeed = 1;
2529
2530#else /* CONFIG_PPC64 */
2531	powersave_nap = 1;
2532#endif  /* CONFIG_PPC64 */
2533
2534	/* Check for "mobile" machine */
2535	if (model && (strncmp(model, "PowerBook", 9) == 0
2536		   || strncmp(model, "iBook", 5) == 0))
2537		pmac_mb.board_flags |= PMAC_MB_MOBILE;
2538
2539
2540	printk(KERN_INFO "PowerMac motherboard: %s\n", pmac_mb.model_name);
2541done:
2542	of_node_put(dt);
2543	return ret;
2544}
2545
2546/* Initialize the Core99 UniNorth host bridge and memory controller
2547 */
2548static void __init probe_uninorth(void)
2549{
2550	struct resource res;
2551	unsigned long actrl;
2552
2553	/* Locate core99 Uni-N */
2554	uninorth_node = of_find_node_by_name(NULL, "uni-n");
2555	uninorth_maj = 1;
2556
2557	/* Locate G5 u3 */
2558	if (uninorth_node == NULL) {
2559		uninorth_node = of_find_node_by_name(NULL, "u3");
2560		uninorth_maj = 3;
2561	}
2562	/* Locate G5 u4 */
2563	if (uninorth_node == NULL) {
2564		uninorth_node = of_find_node_by_name(NULL, "u4");
2565		uninorth_maj = 4;
2566	}
2567	if (uninorth_node == NULL) {
2568		uninorth_maj = 0;
2569		return;
2570	}
2571
2572	if (of_address_to_resource(uninorth_node, 0, &res))
2573		return;
2574
2575	uninorth_base = ioremap(res.start, 0x40000);
2576	if (uninorth_base == NULL)
2577		return;
2578	uninorth_rev = in_be32(UN_REG(UNI_N_VERSION));
2579	if (uninorth_maj == 3 || uninorth_maj == 4) {
2580		u3_ht_base = ioremap(res.start + U3_HT_CONFIG_BASE, 0x1000);
2581		if (u3_ht_base == NULL) {
2582			iounmap(uninorth_base);
2583			return;
2584		}
2585	}
2586
2587	printk(KERN_INFO "Found %s memory controller & host bridge"
2588	       " @ 0x%08x revision: 0x%02x\n", uninorth_maj == 3 ? "U3" :
2589	       uninorth_maj == 4 ? "U4" : "UniNorth",
2590	       (unsigned int)res.start, uninorth_rev);
2591	printk(KERN_INFO "Mapped at 0x%08lx\n", (unsigned long)uninorth_base);
2592
2593	/* Set the arbitrer QAck delay according to what Apple does
2594	 */
2595	if (uninorth_rev < 0x11) {
2596		actrl = UN_IN(UNI_N_ARB_CTRL) & ~UNI_N_ARB_CTRL_QACK_DELAY_MASK;
2597		actrl |= ((uninorth_rev < 3) ? UNI_N_ARB_CTRL_QACK_DELAY105 :
2598			UNI_N_ARB_CTRL_QACK_DELAY) <<
2599			UNI_N_ARB_CTRL_QACK_DELAY_SHIFT;
2600		UN_OUT(UNI_N_ARB_CTRL, actrl);
2601	}
2602
2603	/* Some more magic as done by them in recent MacOS X on UniNorth
2604	 * revs 1.5 to 2.O and Pangea. Seem to toggle the UniN Maxbus/PCI
2605	 * memory timeout
2606	 */
2607	if ((uninorth_rev >= 0x11 && uninorth_rev <= 0x24) ||
2608	    uninorth_rev == 0xc0)
2609		UN_OUT(0x2160, UN_IN(0x2160) & 0x00ffffff);
2610}
2611
2612static void __init probe_one_macio(const char *name, const char *compat, int type)
2613{
2614	struct device_node*	node;
2615	int			i;
2616	volatile u32 __iomem	*base;
2617	const u32		*addrp, *revp;
2618	phys_addr_t		addr;
2619	u64			size;
2620
2621	for_each_node_by_name(node, name) {
2622		if (!compat)
2623			break;
2624		if (of_device_is_compatible(node, compat))
2625			break;
2626	}
2627	if (!node)
2628		return;
2629	for(i=0; i<MAX_MACIO_CHIPS; i++) {
2630		if (!macio_chips[i].of_node)
2631			break;
2632		if (macio_chips[i].of_node == node)
2633			goto out_put;
2634	}
2635
2636	if (i >= MAX_MACIO_CHIPS) {
2637		printk(KERN_ERR "pmac_feature: Please increase MAX_MACIO_CHIPS !\n");
2638		printk(KERN_ERR "pmac_feature: %pOF skipped\n", node);
2639		goto out_put;
2640	}
2641	addrp = of_get_pci_address(node, 0, &size, NULL);
2642	if (addrp == NULL) {
2643		printk(KERN_ERR "pmac_feature: %pOF: can't find base !\n",
2644		       node);
2645		goto out_put;
2646	}
2647	addr = of_translate_address(node, addrp);
2648	if (addr == 0) {
2649		printk(KERN_ERR "pmac_feature: %pOF, can't translate base !\n",
2650		       node);
2651		goto out_put;
2652	}
2653	base = ioremap(addr, (unsigned long)size);
2654	if (!base) {
2655		printk(KERN_ERR "pmac_feature: %pOF, can't map mac-io chip !\n",
2656		       node);
2657		goto out_put;
2658	}
2659	if (type == macio_keylargo || type == macio_keylargo2) {
2660		const u32 *did = of_get_property(node, "device-id", NULL);
2661		if (*did == 0x00000025)
2662			type = macio_pangea;
2663		if (*did == 0x0000003e)
2664			type = macio_intrepid;
2665		if (*did == 0x0000004f)
2666			type = macio_shasta;
2667	}
2668	macio_chips[i].of_node	= node;
2669	macio_chips[i].type	= type;
2670	macio_chips[i].base	= base;
2671	macio_chips[i].flags	= MACIO_FLAG_SCCA_ON | MACIO_FLAG_SCCB_ON;
2672	macio_chips[i].name	= macio_names[type];
2673	revp = of_get_property(node, "revision-id", NULL);
2674	if (revp)
2675		macio_chips[i].rev = *revp;
2676	printk(KERN_INFO "Found a %s mac-io controller, rev: %d, mapped at 0x%p\n",
2677		macio_names[type], macio_chips[i].rev, macio_chips[i].base);
2678
2679	return;
2680
2681out_put:
2682	of_node_put(node);
2683}
2684
2685static int __init
2686probe_macios(void)
2687{
2688	/* Warning, ordering is important */
2689	probe_one_macio("gc", NULL, macio_grand_central);
2690	probe_one_macio("ohare", NULL, macio_ohare);
2691	probe_one_macio("pci106b,7", NULL, macio_ohareII);
2692	probe_one_macio("mac-io", "keylargo", macio_keylargo);
2693	probe_one_macio("mac-io", "paddington", macio_paddington);
2694	probe_one_macio("mac-io", "gatwick", macio_gatwick);
2695	probe_one_macio("mac-io", "heathrow", macio_heathrow);
2696	probe_one_macio("mac-io", "K2-Keylargo", macio_keylargo2);
2697
2698	/* Make sure the "main" macio chip appear first */
2699	if (macio_chips[0].type == macio_gatwick
2700	    && macio_chips[1].type == macio_heathrow) {
2701		struct macio_chip temp = macio_chips[0];
2702		macio_chips[0] = macio_chips[1];
2703		macio_chips[1] = temp;
2704	}
2705	if (macio_chips[0].type == macio_ohareII
2706	    && macio_chips[1].type == macio_ohare) {
2707		struct macio_chip temp = macio_chips[0];
2708		macio_chips[0] = macio_chips[1];
2709		macio_chips[1] = temp;
2710	}
2711	macio_chips[0].lbus.index = 0;
2712	macio_chips[1].lbus.index = 1;
2713
2714	return (macio_chips[0].of_node == NULL) ? -ENODEV : 0;
2715}
2716
2717static void __init
2718initial_serial_shutdown(struct device_node *np)
2719{
2720	int len;
2721	const struct slot_names_prop {
2722		int	count;
2723		char	name[1];
2724	} *slots;
2725	const char *conn;
2726	int port_type = PMAC_SCC_ASYNC;
2727	int modem = 0;
2728
2729	slots = of_get_property(np, "slot-names", &len);
2730	conn = of_get_property(np, "AAPL,connector", &len);
2731	if (conn && (strcmp(conn, "infrared") == 0))
2732		port_type = PMAC_SCC_IRDA;
2733	else if (of_device_is_compatible(np, "cobalt"))
2734		modem = 1;
2735	else if (slots && slots->count > 0) {
2736		if (strcmp(slots->name, "IrDA") == 0)
2737			port_type = PMAC_SCC_IRDA;
2738		else if (strcmp(slots->name, "Modem") == 0)
2739			modem = 1;
2740	}
2741	if (modem)
2742		pmac_call_feature(PMAC_FTR_MODEM_ENABLE, np, 0, 0);
2743	pmac_call_feature(PMAC_FTR_SCC_ENABLE, np, port_type, 0);
2744}
2745
2746static void __init
2747set_initial_features(void)
2748{
2749	struct device_node *np;
2750
2751	/* That hack appears to be necessary for some StarMax motherboards
2752	 * but I'm not too sure it was audited for side-effects on other
2753	 * ohare based machines...
2754	 * Since I still have difficulties figuring the right way to
2755	 * differentiate them all and since that hack was there for a long
2756	 * time, I'll keep it around
2757	 */
2758	if (macio_chips[0].type == macio_ohare) {
2759		struct macio_chip *macio = &macio_chips[0];
2760		np = of_find_node_by_name(NULL, "via-pmu");
2761		if (np)
2762			MACIO_BIS(OHARE_FCR, OH_IOBUS_ENABLE);
2763		else
2764			MACIO_OUT32(OHARE_FCR, STARMAX_FEATURES);
2765		of_node_put(np);
2766	} else if (macio_chips[1].type == macio_ohare) {
2767		struct macio_chip *macio = &macio_chips[1];
2768		MACIO_BIS(OHARE_FCR, OH_IOBUS_ENABLE);
2769	}
2770
2771#ifdef CONFIG_PPC64
2772	if (macio_chips[0].type == macio_keylargo2 ||
2773	    macio_chips[0].type == macio_shasta) {
2774#ifndef CONFIG_SMP
2775		/* On SMP machines running UP, we have the second CPU eating
2776		 * bus cycles. We need to take it off the bus. This is done
2777		 * from pmac_smp for SMP kernels running on one CPU
2778		 */
2779		np = of_find_node_by_type(NULL, "cpu");
2780		if (np != NULL)
2781			np = of_find_node_by_type(np, "cpu");
2782		if (np != NULL) {
2783			g5_phy_disable_cpu1();
2784			of_node_put(np);
2785		}
2786#endif /* CONFIG_SMP */
2787		/* Enable GMAC for now for PCI probing. It will be disabled
2788		 * later on after PCI probe
2789		 */
2790		for_each_node_by_name(np, "ethernet")
2791			if (of_device_is_compatible(np, "K2-GMAC"))
2792				g5_gmac_enable(np, 0, 1);
2793
2794		/* Enable FW before PCI probe. Will be disabled later on
2795		 * Note: We should have a batter way to check that we are
2796		 * dealing with uninorth internal cell and not a PCI cell
2797		 * on the external PCI. The code below works though.
2798		 */
2799		for_each_node_by_name(np, "firewire") {
2800			if (of_device_is_compatible(np, "pci106b,5811")) {
2801				macio_chips[0].flags |= MACIO_FLAG_FW_SUPPORTED;
2802				g5_fw_enable(np, 0, 1);
2803			}
2804		}
2805	}
2806#else /* CONFIG_PPC64 */
2807
2808	if (macio_chips[0].type == macio_keylargo ||
2809	    macio_chips[0].type == macio_pangea ||
2810	    macio_chips[0].type == macio_intrepid) {
2811		/* Enable GMAC for now for PCI probing. It will be disabled
2812		 * later on after PCI probe
2813		 */
2814		for_each_node_by_name(np, "ethernet") {
2815			if (np->parent
2816			    && of_device_is_compatible(np->parent, "uni-north")
2817			    && of_device_is_compatible(np, "gmac"))
2818				core99_gmac_enable(np, 0, 1);
2819		}
2820
2821		/* Enable FW before PCI probe. Will be disabled later on
2822		 * Note: We should have a batter way to check that we are
2823		 * dealing with uninorth internal cell and not a PCI cell
2824		 * on the external PCI. The code below works though.
2825		 */
2826		for_each_node_by_name(np, "firewire") {
2827			if (np->parent
2828			    && of_device_is_compatible(np->parent, "uni-north")
2829			    && (of_device_is_compatible(np, "pci106b,18") ||
2830			        of_device_is_compatible(np, "pci106b,30") ||
2831			        of_device_is_compatible(np, "pci11c1,5811"))) {
2832				macio_chips[0].flags |= MACIO_FLAG_FW_SUPPORTED;
2833				core99_firewire_enable(np, 0, 1);
2834			}
2835		}
2836
2837		/* Enable ATA-100 before PCI probe. */
2838		for_each_node_by_name(np, "ata-6") {
2839			if (np->parent
2840			    && of_device_is_compatible(np->parent, "uni-north")
2841			    && of_device_is_compatible(np, "kauai-ata")) {
2842				core99_ata100_enable(np, 1);
2843			}
2844		}
2845
2846		/* Switch airport off */
2847		for_each_node_by_name(np, "radio") {
2848			if (np->parent == macio_chips[0].of_node) {
2849				macio_chips[0].flags |= MACIO_FLAG_AIRPORT_ON;
2850				core99_airport_enable(np, 0, 0);
2851			}
2852		}
2853	}
2854
2855	/* On all machines that support sound PM, switch sound off */
2856	if (macio_chips[0].of_node)
2857		pmac_do_feature_call(PMAC_FTR_SOUND_CHIP_ENABLE,
2858			macio_chips[0].of_node, 0, 0);
2859
2860	/* While on some desktop G3s, we turn it back on */
2861	if (macio_chips[0].of_node && macio_chips[0].type == macio_heathrow
2862		&& (pmac_mb.model_id == PMAC_TYPE_GOSSAMER ||
2863		    pmac_mb.model_id == PMAC_TYPE_SILK)) {
2864		struct macio_chip *macio = &macio_chips[0];
2865		MACIO_BIS(HEATHROW_FCR, HRW_SOUND_CLK_ENABLE);
2866		MACIO_BIC(HEATHROW_FCR, HRW_SOUND_POWER_N);
2867	}
2868
2869#endif /* CONFIG_PPC64 */
2870
2871	/* On all machines, switch modem & serial ports off */
2872	for_each_node_by_name(np, "ch-a")
2873		initial_serial_shutdown(np);
2874	for_each_node_by_name(np, "ch-b")
2875		initial_serial_shutdown(np);
2876}
2877
2878void __init
2879pmac_feature_init(void)
2880{
2881	/* Detect the UniNorth memory controller */
2882	probe_uninorth();
2883
2884	/* Probe mac-io controllers */
2885	if (probe_macios()) {
2886		printk(KERN_WARNING "No mac-io chip found\n");
2887		return;
2888	}
2889
2890	/* Probe machine type */
2891	if (probe_motherboard())
2892		printk(KERN_WARNING "Unknown PowerMac !\n");
2893
2894	/* Set some initial features (turn off some chips that will
2895	 * be later turned on)
2896	 */
2897	set_initial_features();
2898}
2899
2900#if 0
2901static void dump_HT_speeds(char *name, u32 cfg, u32 frq)
2902{
2903	int	freqs[16] = { 200,300,400,500,600,800,1000,0,0,0,0,0,0,0,0,0 };
2904	int	bits[8] = { 8,16,0,32,2,4,0,0 };
2905	int	freq = (frq >> 8) & 0xf;
2906
2907	if (freqs[freq] == 0)
2908		printk("%s: Unknown HT link frequency %x\n", name, freq);
2909	else
2910		printk("%s: %d MHz on main link, (%d in / %d out) bits width\n",
2911		       name, freqs[freq],
2912		       bits[(cfg >> 28) & 0x7], bits[(cfg >> 24) & 0x7]);
2913}
2914
2915void __init pmac_check_ht_link(void)
2916{
2917	u32	ufreq, freq, ucfg, cfg;
2918	struct device_node *pcix_node;
2919	u8	px_bus, px_devfn;
2920	struct pci_controller *px_hose;
2921
2922	(void)in_be32(u3_ht_base + U3_HT_LINK_COMMAND);
2923	ucfg = cfg = in_be32(u3_ht_base + U3_HT_LINK_CONFIG);
2924	ufreq = freq = in_be32(u3_ht_base + U3_HT_LINK_FREQ);
2925	dump_HT_speeds("U3 HyperTransport", cfg, freq);
2926
2927	pcix_node = of_find_compatible_node(NULL, "pci", "pci-x");
2928	if (pcix_node == NULL) {
2929		printk("No PCI-X bridge found\n");
2930		return;
2931	}
2932	if (pci_device_from_OF_node(pcix_node, &px_bus, &px_devfn) != 0) {
2933		printk("PCI-X bridge found but not matched to pci\n");
2934		return;
2935	}
2936	px_hose = pci_find_hose_for_OF_device(pcix_node);
2937	if (px_hose == NULL) {
2938		printk("PCI-X bridge found but not matched to host\n");
2939		return;
2940	}
2941	early_read_config_dword(px_hose, px_bus, px_devfn, 0xc4, &cfg);
2942	early_read_config_dword(px_hose, px_bus, px_devfn, 0xcc, &freq);
2943	dump_HT_speeds("PCI-X HT Uplink", cfg, freq);
2944	early_read_config_dword(px_hose, px_bus, px_devfn, 0xc8, &cfg);
2945	early_read_config_dword(px_hose, px_bus, px_devfn, 0xd0, &freq);
2946	dump_HT_speeds("PCI-X HT Downlink", cfg, freq);
2947}
2948#endif /* 0 */
2949
2950/*
2951 * Early video resume hook
2952 */
2953
2954static void (*pmac_early_vresume_proc)(void *data);
2955static void *pmac_early_vresume_data;
2956
2957void pmac_set_early_video_resume(void (*proc)(void *data), void *data)
2958{
2959	if (!machine_is(powermac))
2960		return;
2961	preempt_disable();
2962	pmac_early_vresume_proc = proc;
2963	pmac_early_vresume_data = data;
2964	preempt_enable();
2965}
2966EXPORT_SYMBOL(pmac_set_early_video_resume);
2967
2968void pmac_call_early_video_resume(void)
2969{
2970	if (pmac_early_vresume_proc)
2971		pmac_early_vresume_proc(pmac_early_vresume_data);
2972}
2973
2974/*
2975 * AGP related suspend/resume code
2976 */
2977
2978static struct pci_dev *pmac_agp_bridge;
2979static int (*pmac_agp_suspend)(struct pci_dev *bridge);
2980static int (*pmac_agp_resume)(struct pci_dev *bridge);
2981
2982void pmac_register_agp_pm(struct pci_dev *bridge,
2983				 int (*suspend)(struct pci_dev *bridge),
2984				 int (*resume)(struct pci_dev *bridge))
2985{
2986	if (suspend || resume) {
2987		pmac_agp_bridge = bridge;
2988		pmac_agp_suspend = suspend;
2989		pmac_agp_resume = resume;
2990		return;
2991	}
2992	if (bridge != pmac_agp_bridge)
2993		return;
2994	pmac_agp_suspend = pmac_agp_resume = NULL;
2995	return;
2996}
2997EXPORT_SYMBOL(pmac_register_agp_pm);
2998
2999void pmac_suspend_agp_for_card(struct pci_dev *dev)
3000{
3001	if (pmac_agp_bridge == NULL || pmac_agp_suspend == NULL)
3002		return;
3003	if (pmac_agp_bridge->bus != dev->bus)
3004		return;
3005	pmac_agp_suspend(pmac_agp_bridge);
3006}
3007EXPORT_SYMBOL(pmac_suspend_agp_for_card);
3008
3009void pmac_resume_agp_for_card(struct pci_dev *dev)
3010{
3011	if (pmac_agp_bridge == NULL || pmac_agp_resume == NULL)
3012		return;
3013	if (pmac_agp_bridge->bus != dev->bus)
3014		return;
3015	pmac_agp_resume(pmac_agp_bridge);
3016}
3017EXPORT_SYMBOL(pmac_resume_agp_for_card);
3018
3019int pmac_get_uninorth_variant(void)
3020{
3021	return uninorth_maj;
3022}
3023