ftrace: fix printout
[linux-2.6/mini2440.git] / arch / arm / mach-footbridge / netwinder-hw.c
bloba1f381c64a30e108d1077a843ad4afb90c1b371d
1 /*
2 * linux/arch/arm/mach-footbridge/netwinder-hw.c
4 * Netwinder machine fixup
6 * Copyright (C) 1998, 1999 Russell King, Phil Blundell
7 */
8 #include <linux/module.h>
9 #include <linux/ioport.h>
10 #include <linux/kernel.h>
11 #include <linux/delay.h>
12 #include <linux/init.h>
14 #include <asm/hardware/dec21285.h>
15 #include <asm/io.h>
16 #include <asm/leds.h>
17 #include <asm/mach-types.h>
18 #include <asm/setup.h>
20 #include <asm/mach/arch.h>
22 #include "common.h"
24 #define IRDA_IO_BASE 0x180
25 #define GP1_IO_BASE 0x338
26 #define GP2_IO_BASE 0x33a
29 #ifdef CONFIG_LEDS
30 #define DEFAULT_LEDS 0
31 #else
32 #define DEFAULT_LEDS GPIO_GREEN_LED
33 #endif
36 * Winbond WB83977F accessibility stuff
38 static inline void wb977_open(void)
40 outb(0x87, 0x370);
41 outb(0x87, 0x370);
44 static inline void wb977_close(void)
46 outb(0xaa, 0x370);
49 static inline void wb977_wb(int reg, int val)
51 outb(reg, 0x370);
52 outb(val, 0x371);
55 static inline void wb977_ww(int reg, int val)
57 outb(reg, 0x370);
58 outb(val >> 8, 0x371);
59 outb(reg + 1, 0x370);
60 outb(val & 255, 0x371);
63 #define wb977_device_select(dev) wb977_wb(0x07, dev)
64 #define wb977_device_disable() wb977_wb(0x30, 0x00)
65 #define wb977_device_enable() wb977_wb(0x30, 0x01)
68 * This is a lock for accessing ports GP1_IO_BASE and GP2_IO_BASE
70 DEFINE_SPINLOCK(gpio_lock);
72 static unsigned int current_gpio_op;
73 static unsigned int current_gpio_io;
74 static unsigned int current_cpld;
76 void gpio_modify_op(int mask, int set)
78 unsigned int new_gpio, changed;
80 new_gpio = (current_gpio_op & ~mask) | set;
81 changed = new_gpio ^ current_gpio_op;
82 current_gpio_op = new_gpio;
84 if (changed & 0xff)
85 outb(new_gpio, GP1_IO_BASE);
86 if (changed & 0xff00)
87 outb(new_gpio >> 8, GP2_IO_BASE);
90 static inline void __gpio_modify_io(int mask, int in)
92 unsigned int new_gpio, changed;
93 int port;
95 new_gpio = (current_gpio_io & ~mask) | in;
96 changed = new_gpio ^ current_gpio_io;
97 current_gpio_io = new_gpio;
99 changed >>= 1;
100 new_gpio >>= 1;
102 wb977_device_select(7);
104 for (port = 0xe1; changed && port < 0xe8; changed >>= 1) {
105 wb977_wb(port, new_gpio & 1);
107 port += 1;
108 new_gpio >>= 1;
111 wb977_device_select(8);
113 for (port = 0xe8; changed && port < 0xec; changed >>= 1) {
114 wb977_wb(port, new_gpio & 1);
116 port += 1;
117 new_gpio >>= 1;
121 void gpio_modify_io(int mask, int in)
123 /* Open up the SuperIO chip */
124 wb977_open();
126 __gpio_modify_io(mask, in);
128 /* Close up the EFER gate */
129 wb977_close();
132 int gpio_read(void)
134 return inb(GP1_IO_BASE) | inb(GP2_IO_BASE) << 8;
138 * Initialise the Winbond W83977F global registers
140 static inline void wb977_init_global(void)
143 * Enable R/W config registers
145 wb977_wb(0x26, 0x40);
148 * Power down FDC (not used)
150 wb977_wb(0x22, 0xfe);
153 * GP12, GP11, CIRRX, IRRXH, GP10
155 wb977_wb(0x2a, 0xc1);
158 * GP23, GP22, GP21, GP20, GP13
160 wb977_wb(0x2b, 0x6b);
163 * GP17, GP16, GP15, GP14
165 wb977_wb(0x2c, 0x55);
169 * Initialise the Winbond W83977F printer port
171 static inline void wb977_init_printer(void)
173 wb977_device_select(1);
176 * mode 1 == EPP
178 wb977_wb(0xf0, 0x01);
182 * Initialise the Winbond W83977F keyboard controller
184 static inline void wb977_init_keyboard(void)
186 wb977_device_select(5);
189 * Keyboard controller address
191 wb977_ww(0x60, 0x0060);
192 wb977_ww(0x62, 0x0064);
195 * Keyboard IRQ 1, active high, edge trigger
197 wb977_wb(0x70, 1);
198 wb977_wb(0x71, 0x02);
201 * Mouse IRQ 5, active high, edge trigger
203 wb977_wb(0x72, 5);
204 wb977_wb(0x73, 0x02);
207 * KBC 8MHz
209 wb977_wb(0xf0, 0x40);
212 * Enable device
214 wb977_device_enable();
218 * Initialise the Winbond W83977F Infra-Red device
220 static inline void wb977_init_irda(void)
222 wb977_device_select(6);
225 * IR base address
227 wb977_ww(0x60, IRDA_IO_BASE);
230 * IRDA IRQ 6, active high, edge trigger
232 wb977_wb(0x70, 6);
233 wb977_wb(0x71, 0x02);
236 * RX DMA - ISA DMA 0
238 wb977_wb(0x74, 0x00);
241 * TX DMA - Disable Tx DMA
243 wb977_wb(0x75, 0x04);
246 * Append CRC, Enable bank selection
248 wb977_wb(0xf0, 0x03);
251 * Enable device
253 wb977_device_enable();
257 * Initialise Winbond W83977F general purpose IO
259 static inline void wb977_init_gpio(void)
261 unsigned long flags;
264 * Set up initial I/O definitions
266 current_gpio_io = -1;
267 __gpio_modify_io(-1, GPIO_DONE | GPIO_WDTIMER);
269 wb977_device_select(7);
272 * Group1 base address
274 wb977_ww(0x60, GP1_IO_BASE);
275 wb977_ww(0x62, 0);
276 wb977_ww(0x64, 0);
279 * GP10 (Orage button) IRQ 10, active high, edge trigger
281 wb977_wb(0x70, 10);
282 wb977_wb(0x71, 0x02);
285 * GP10: Debounce filter enabled, IRQ, input
287 wb977_wb(0xe0, 0x19);
290 * Enable Group1
292 wb977_device_enable();
294 wb977_device_select(8);
297 * Group2 base address
299 wb977_ww(0x60, GP2_IO_BASE);
302 * Clear watchdog timer regs
303 * - timer disable
305 wb977_wb(0xf2, 0x00);
308 * - disable LED, no mouse nor keyboard IRQ
310 wb977_wb(0xf3, 0x00);
313 * - timer counting, disable power LED, disable timeouot
315 wb977_wb(0xf4, 0x00);
318 * Enable group2
320 wb977_device_enable();
323 * Set Group1/Group2 outputs
325 spin_lock_irqsave(&gpio_lock, flags);
326 gpio_modify_op(-1, GPIO_RED_LED | GPIO_FAN);
327 spin_unlock_irqrestore(&gpio_lock, flags);
331 * Initialise the Winbond W83977F chip.
333 static void __init wb977_init(void)
335 request_region(0x370, 2, "W83977AF configuration");
338 * Open up the SuperIO chip
340 wb977_open();
343 * Initialise the global registers
345 wb977_init_global();
348 * Initialise the various devices in
349 * the multi-IO chip.
351 wb977_init_printer();
352 wb977_init_keyboard();
353 wb977_init_irda();
354 wb977_init_gpio();
357 * Close up the EFER gate
359 wb977_close();
362 void cpld_modify(int mask, int set)
364 int msk;
366 current_cpld = (current_cpld & ~mask) | set;
368 gpio_modify_io(GPIO_DATA | GPIO_IOCLK | GPIO_IOLOAD, 0);
369 gpio_modify_op(GPIO_IOLOAD, 0);
371 for (msk = 8; msk; msk >>= 1) {
372 int bit = current_cpld & msk;
374 gpio_modify_op(GPIO_DATA | GPIO_IOCLK, bit ? GPIO_DATA : 0);
375 gpio_modify_op(GPIO_IOCLK, GPIO_IOCLK);
378 gpio_modify_op(GPIO_IOCLK|GPIO_DATA, 0);
379 gpio_modify_op(GPIO_IOLOAD|GPIO_DSCLK, GPIO_IOLOAD|GPIO_DSCLK);
380 gpio_modify_op(GPIO_IOLOAD, 0);
383 static void __init cpld_init(void)
385 unsigned long flags;
387 spin_lock_irqsave(&gpio_lock, flags);
388 cpld_modify(-1, CPLD_UNMUTE | CPLD_7111_DISABLE);
389 spin_unlock_irqrestore(&gpio_lock, flags);
392 static unsigned char rwa_unlock[] __initdata =
393 { 0x00, 0x00, 0x6a, 0xb5, 0xda, 0xed, 0xf6, 0xfb, 0x7d, 0xbe, 0xdf, 0x6f, 0x37, 0x1b,
394 0x0d, 0x86, 0xc3, 0x61, 0xb0, 0x58, 0x2c, 0x16, 0x8b, 0x45, 0xa2, 0xd1, 0xe8, 0x74,
395 0x3a, 0x9d, 0xce, 0xe7, 0x73, 0x39 };
397 #ifndef DEBUG
398 #define dprintk(x...)
399 #else
400 #define dprintk(x...) printk(x)
401 #endif
403 #define WRITE_RWA(r,v) do { outb((r), 0x279); udelay(10); outb((v), 0xa79); } while (0)
405 static inline void rwa010_unlock(void)
407 int i;
409 WRITE_RWA(2, 2);
410 mdelay(10);
412 for (i = 0; i < sizeof(rwa_unlock); i++) {
413 outb(rwa_unlock[i], 0x279);
414 udelay(10);
418 static inline void rwa010_read_ident(void)
420 unsigned char si[9];
421 int i, j;
423 WRITE_RWA(3, 0);
424 WRITE_RWA(0, 128);
426 outb(1, 0x279);
428 mdelay(1);
430 dprintk("Identifier: ");
431 for (i = 0; i < 9; i++) {
432 si[i] = 0;
433 for (j = 0; j < 8; j++) {
434 int bit;
435 udelay(250);
436 inb(0x203);
437 udelay(250);
438 bit = inb(0x203);
439 dprintk("%02X ", bit);
440 bit = (bit == 0xaa) ? 1 : 0;
441 si[i] |= bit << j;
443 dprintk("(%02X) ", si[i]);
445 dprintk("\n");
448 static inline void rwa010_global_init(void)
450 WRITE_RWA(6, 2); // Assign a card no = 2
452 dprintk("Card no = %d\n", inb(0x203));
454 /* disable the modem section of the chip */
455 WRITE_RWA(7, 3);
456 WRITE_RWA(0x30, 0);
458 /* disable the cdrom section of the chip */
459 WRITE_RWA(7, 4);
460 WRITE_RWA(0x30, 0);
462 /* disable the MPU-401 section of the chip */
463 WRITE_RWA(7, 2);
464 WRITE_RWA(0x30, 0);
467 static inline void rwa010_game_port_init(void)
469 int i;
471 WRITE_RWA(7, 5);
473 dprintk("Slider base: ");
474 WRITE_RWA(0x61, 1);
475 i = inb(0x203);
477 WRITE_RWA(0x60, 2);
478 dprintk("%02X%02X (201)\n", inb(0x203), i);
480 WRITE_RWA(0x30, 1);
483 static inline void rwa010_waveartist_init(int base, int irq, int dma)
485 int i;
487 WRITE_RWA(7, 0);
489 dprintk("WaveArtist base: ");
490 WRITE_RWA(0x61, base & 255);
491 i = inb(0x203);
493 WRITE_RWA(0x60, base >> 8);
494 dprintk("%02X%02X (%X),", inb(0x203), i, base);
496 WRITE_RWA(0x70, irq);
497 dprintk(" irq: %d (%d),", inb(0x203), irq);
499 WRITE_RWA(0x74, dma);
500 dprintk(" dma: %d (%d)\n", inb(0x203), dma);
502 WRITE_RWA(0x30, 1);
505 static inline void rwa010_soundblaster_init(int sb_base, int al_base, int irq, int dma)
507 int i;
509 WRITE_RWA(7, 1);
511 dprintk("SoundBlaster base: ");
512 WRITE_RWA(0x61, sb_base & 255);
513 i = inb(0x203);
515 WRITE_RWA(0x60, sb_base >> 8);
516 dprintk("%02X%02X (%X),", inb(0x203), i, sb_base);
518 dprintk(" irq: ");
519 WRITE_RWA(0x70, irq);
520 dprintk("%d (%d),", inb(0x203), irq);
522 dprintk(" 8-bit DMA: ");
523 WRITE_RWA(0x74, dma);
524 dprintk("%d (%d)\n", inb(0x203), dma);
526 dprintk("AdLib base: ");
527 WRITE_RWA(0x63, al_base & 255);
528 i = inb(0x203);
530 WRITE_RWA(0x62, al_base >> 8);
531 dprintk("%02X%02X (%X)\n", inb(0x203), i, al_base);
533 WRITE_RWA(0x30, 1);
536 static void rwa010_soundblaster_reset(void)
538 int i;
540 outb(1, 0x226);
541 udelay(3);
542 outb(0, 0x226);
544 for (i = 0; i < 5; i++) {
545 if (inb(0x22e) & 0x80)
546 break;
547 mdelay(1);
549 if (i == 5)
550 printk("SoundBlaster: DSP reset failed\n");
552 dprintk("SoundBlaster DSP reset: %02X (AA)\n", inb(0x22a));
554 for (i = 0; i < 5; i++) {
555 if ((inb(0x22c) & 0x80) == 0)
556 break;
557 mdelay(1);
560 if (i == 5)
561 printk("SoundBlaster: DSP not ready\n");
562 else {
563 outb(0xe1, 0x22c);
565 dprintk("SoundBlaster DSP id: ");
566 i = inb(0x22a);
567 udelay(1);
568 i |= inb(0x22a) << 8;
569 dprintk("%04X\n", i);
571 for (i = 0; i < 5; i++) {
572 if ((inb(0x22c) & 0x80) == 0)
573 break;
574 mdelay(1);
577 if (i == 5)
578 printk("SoundBlaster: could not turn speaker off\n");
580 outb(0xd3, 0x22c);
583 /* turn on OPL3 */
584 outb(5, 0x38a);
585 outb(1, 0x38b);
588 static void __init rwa010_init(void)
590 rwa010_unlock();
591 rwa010_read_ident();
592 rwa010_global_init();
593 rwa010_game_port_init();
594 rwa010_waveartist_init(0x250, 3, 7);
595 rwa010_soundblaster_init(0x220, 0x388, 3, 1);
596 rwa010_soundblaster_reset();
599 EXPORT_SYMBOL(gpio_lock);
600 EXPORT_SYMBOL(gpio_modify_op);
601 EXPORT_SYMBOL(gpio_modify_io);
602 EXPORT_SYMBOL(cpld_modify);
603 EXPORT_SYMBOL(gpio_read);
606 * Initialise any other hardware after we've got the PCI bus
607 * initialised. We may need the PCI bus to talk to this other
608 * hardware.
610 static int __init nw_hw_init(void)
612 if (machine_is_netwinder()) {
613 unsigned long flags;
615 wb977_init();
616 cpld_init();
617 rwa010_init();
619 spin_lock_irqsave(&gpio_lock, flags);
620 gpio_modify_op(GPIO_RED_LED|GPIO_GREEN_LED, DEFAULT_LEDS);
621 spin_unlock_irqrestore(&gpio_lock, flags);
623 return 0;
626 __initcall(nw_hw_init);
629 * Older NeTTroms either do not provide a parameters
630 * page, or they don't supply correct information in
631 * the parameter page.
633 static void __init
634 fixup_netwinder(struct machine_desc *desc, struct tag *tags,
635 char **cmdline, struct meminfo *mi)
637 #ifdef CONFIG_ISAPNP
638 extern int isapnp_disable;
641 * We must not use the kernels ISAPnP code
642 * on the NetWinder - it will reset the settings
643 * for the WaveArtist chip and render it inoperable.
645 isapnp_disable = 1;
646 #endif
649 MACHINE_START(NETWINDER, "Rebel-NetWinder")
650 /* Maintainer: Russell King/Rebel.com */
651 .phys_io = DC21285_ARMCSR_BASE,
652 .io_pg_offst = ((0xfe000000) >> 18) & 0xfffc,
653 .boot_params = 0x00000100,
654 .video_start = 0x000a0000,
655 .video_end = 0x000bffff,
656 .reserve_lp0 = 1,
657 .reserve_lp2 = 1,
658 .fixup = fixup_netwinder,
659 .map_io = footbridge_map_io,
660 .init_irq = footbridge_init_irq,
661 .timer = &isa_timer,
662 MACHINE_END