2 * linux/arch/arm/mach-footbridge/netwinder-hw.c
4 * Netwinder machine fixup
6 * Copyright (C) 1998, 1999 Russell King, Phil Blundell
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 <linux/spinlock.h>
15 #include <linux/slab.h>
16 #include <linux/leds.h>
18 #include <asm/hardware/dec21285.h>
19 #include <asm/mach-types.h>
20 #include <asm/setup.h>
21 #include <asm/system_misc.h>
23 #include <asm/mach/arch.h>
27 #define IRDA_IO_BASE 0x180
28 #define GP1_IO_BASE 0x338
29 #define GP2_IO_BASE 0x33a
32 * Winbond WB83977F accessibility stuff
34 static inline void wb977_open(void)
40 static inline void wb977_close(void)
45 static inline void wb977_wb(int reg
, int val
)
51 static inline void wb977_ww(int reg
, int val
)
54 outb(val
>> 8, 0x371);
56 outb(val
& 255, 0x371);
59 #define wb977_device_select(dev) wb977_wb(0x07, dev)
60 #define wb977_device_disable() wb977_wb(0x30, 0x00)
61 #define wb977_device_enable() wb977_wb(0x30, 0x01)
64 * This is a lock for accessing ports GP1_IO_BASE and GP2_IO_BASE
66 DEFINE_RAW_SPINLOCK(nw_gpio_lock
);
67 EXPORT_SYMBOL(nw_gpio_lock
);
69 static unsigned int current_gpio_op
;
70 static unsigned int current_gpio_io
;
71 static unsigned int current_cpld
;
73 void nw_gpio_modify_op(unsigned int mask
, unsigned int set
)
75 unsigned int new_gpio
, changed
;
77 new_gpio
= (current_gpio_op
& ~mask
) | set
;
78 changed
= new_gpio
^ current_gpio_op
;
79 current_gpio_op
= new_gpio
;
82 outb(new_gpio
, GP1_IO_BASE
);
84 outb(new_gpio
>> 8, GP2_IO_BASE
);
86 EXPORT_SYMBOL(nw_gpio_modify_op
);
88 static inline void __gpio_modify_io(int mask
, int in
)
90 unsigned int new_gpio
, changed
;
93 new_gpio
= (current_gpio_io
& ~mask
) | in
;
94 changed
= new_gpio
^ current_gpio_io
;
95 current_gpio_io
= new_gpio
;
100 wb977_device_select(7);
102 for (port
= 0xe1; changed
&& port
< 0xe8; changed
>>= 1) {
103 wb977_wb(port
, new_gpio
& 1);
109 wb977_device_select(8);
111 for (port
= 0xe8; changed
&& port
< 0xec; changed
>>= 1) {
112 wb977_wb(port
, new_gpio
& 1);
119 void nw_gpio_modify_io(unsigned int mask
, unsigned int in
)
121 /* Open up the SuperIO chip */
124 __gpio_modify_io(mask
, in
);
126 /* Close up the EFER gate */
129 EXPORT_SYMBOL(nw_gpio_modify_io
);
131 unsigned int nw_gpio_read(void)
133 return inb(GP1_IO_BASE
) | inb(GP2_IO_BASE
) << 8;
135 EXPORT_SYMBOL(nw_gpio_read
);
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);
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
198 wb977_wb(0x71, 0x02);
201 * Mouse IRQ 5, active high, edge trigger
204 wb977_wb(0x73, 0x02);
209 wb977_wb(0xf0, 0x40);
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);
227 wb977_ww(0x60, IRDA_IO_BASE
);
230 * IRDA IRQ 6, active high, edge trigger
233 wb977_wb(0x71, 0x02);
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);
253 wb977_device_enable();
257 * Initialise Winbond W83977F general purpose IO
259 static inline void wb977_init_gpio(void)
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
);
279 * GP10 (Orage button) IRQ 10, active high, edge trigger
282 wb977_wb(0x71, 0x02);
285 * GP10: Debounce filter enabled, IRQ, input
287 wb977_wb(0xe0, 0x19);
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
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);
320 wb977_device_enable();
323 * Set Group1/Group2 outputs
325 raw_spin_lock_irqsave(&nw_gpio_lock
, flags
);
326 nw_gpio_modify_op(-1, GPIO_RED_LED
| GPIO_FAN
);
327 raw_spin_unlock_irqrestore(&nw_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
343 * Initialise the global registers
348 * Initialise the various devices in
351 wb977_init_printer();
352 wb977_init_keyboard();
357 * Close up the EFER gate
362 void nw_cpld_modify(unsigned int mask
, unsigned int set
)
366 current_cpld
= (current_cpld
& ~mask
) | set
;
368 nw_gpio_modify_io(GPIO_DATA
| GPIO_IOCLK
| GPIO_IOLOAD
, 0);
369 nw_gpio_modify_op(GPIO_IOLOAD
, 0);
371 for (msk
= 8; msk
; msk
>>= 1) {
372 int bit
= current_cpld
& msk
;
374 nw_gpio_modify_op(GPIO_DATA
| GPIO_IOCLK
, bit
? GPIO_DATA
: 0);
375 nw_gpio_modify_op(GPIO_IOCLK
, GPIO_IOCLK
);
378 nw_gpio_modify_op(GPIO_IOCLK
|GPIO_DATA
, 0);
379 nw_gpio_modify_op(GPIO_IOLOAD
|GPIO_DSCLK
, GPIO_IOLOAD
|GPIO_DSCLK
);
380 nw_gpio_modify_op(GPIO_IOLOAD
, 0);
382 EXPORT_SYMBOL(nw_cpld_modify
);
384 static void __init
cpld_init(void)
388 raw_spin_lock_irqsave(&nw_gpio_lock
, flags
);
389 nw_cpld_modify(-1, CPLD_UNMUTE
| CPLD_7111_DISABLE
);
390 raw_spin_unlock_irqrestore(&nw_gpio_lock
, flags
);
393 static unsigned char rwa_unlock
[] __initdata
=
394 { 0x00, 0x00, 0x6a, 0xb5, 0xda, 0xed, 0xf6, 0xfb, 0x7d, 0xbe, 0xdf, 0x6f, 0x37, 0x1b,
395 0x0d, 0x86, 0xc3, 0x61, 0xb0, 0x58, 0x2c, 0x16, 0x8b, 0x45, 0xa2, 0xd1, 0xe8, 0x74,
396 0x3a, 0x9d, 0xce, 0xe7, 0x73, 0x39 };
399 #define dprintk(x...)
401 #define dprintk(x...) printk(x)
404 #define WRITE_RWA(r,v) do { outb((r), 0x279); udelay(10); outb((v), 0xa79); } while (0)
406 static inline void rwa010_unlock(void)
413 for (i
= 0; i
< sizeof(rwa_unlock
); i
++) {
414 outb(rwa_unlock
[i
], 0x279);
419 static inline void rwa010_read_ident(void)
431 dprintk("Identifier: ");
432 for (i
= 0; i
< 9; i
++) {
434 for (j
= 0; j
< 8; j
++) {
440 dprintk("%02X ", bit
);
441 bit
= (bit
== 0xaa) ? 1 : 0;
444 dprintk("(%02X) ", si
[i
]);
449 static inline void rwa010_global_init(void)
451 WRITE_RWA(6, 2); // Assign a card no = 2
453 dprintk("Card no = %d\n", inb(0x203));
455 /* disable the modem section of the chip */
459 /* disable the cdrom section of the chip */
463 /* disable the MPU-401 section of the chip */
468 static inline void rwa010_game_port_init(void)
474 dprintk("Slider base: ");
479 dprintk("%02X%02X (201)\n", inb(0x203), i
);
484 static inline void rwa010_waveartist_init(int base
, int irq
, int dma
)
490 dprintk("WaveArtist base: ");
491 WRITE_RWA(0x61, base
& 255);
494 WRITE_RWA(0x60, base
>> 8);
495 dprintk("%02X%02X (%X),", inb(0x203), i
, base
);
497 WRITE_RWA(0x70, irq
);
498 dprintk(" irq: %d (%d),", inb(0x203), irq
);
500 WRITE_RWA(0x74, dma
);
501 dprintk(" dma: %d (%d)\n", inb(0x203), dma
);
506 static inline void rwa010_soundblaster_init(int sb_base
, int al_base
, int irq
, int dma
)
512 dprintk("SoundBlaster base: ");
513 WRITE_RWA(0x61, sb_base
& 255);
516 WRITE_RWA(0x60, sb_base
>> 8);
517 dprintk("%02X%02X (%X),", inb(0x203), i
, sb_base
);
520 WRITE_RWA(0x70, irq
);
521 dprintk("%d (%d),", inb(0x203), irq
);
523 dprintk(" 8-bit DMA: ");
524 WRITE_RWA(0x74, dma
);
525 dprintk("%d (%d)\n", inb(0x203), dma
);
527 dprintk("AdLib base: ");
528 WRITE_RWA(0x63, al_base
& 255);
531 WRITE_RWA(0x62, al_base
>> 8);
532 dprintk("%02X%02X (%X)\n", inb(0x203), i
, al_base
);
537 static void rwa010_soundblaster_reset(void)
545 for (i
= 0; i
< 5; i
++) {
546 if (inb(0x22e) & 0x80)
551 printk("SoundBlaster: DSP reset failed\n");
553 dprintk("SoundBlaster DSP reset: %02X (AA)\n", inb(0x22a));
555 for (i
= 0; i
< 5; i
++) {
556 if ((inb(0x22c) & 0x80) == 0)
562 printk("SoundBlaster: DSP not ready\n");
566 dprintk("SoundBlaster DSP id: ");
569 i
|= inb(0x22a) << 8;
570 dprintk("%04X\n", i
);
572 for (i
= 0; i
< 5; i
++) {
573 if ((inb(0x22c) & 0x80) == 0)
579 printk("SoundBlaster: could not turn speaker off\n");
589 static void __init
rwa010_init(void)
593 rwa010_global_init();
594 rwa010_game_port_init();
595 rwa010_waveartist_init(0x250, 3, 7);
596 rwa010_soundblaster_init(0x220, 0x388, 3, 1);
597 rwa010_soundblaster_reset();
601 * Initialise any other hardware after we've got the PCI bus
602 * initialised. We may need the PCI bus to talk to this other
605 static int __init
nw_hw_init(void)
607 if (machine_is_netwinder()) {
615 __initcall(nw_hw_init
);
618 * Older NeTTroms either do not provide a parameters
619 * page, or they don't supply correct information in
620 * the parameter page.
623 fixup_netwinder(struct tag
*tags
, char **cmdline
, struct meminfo
*mi
)
626 extern int isapnp_disable
;
629 * We must not use the kernels ISAPnP code
630 * on the NetWinder - it will reset the settings
631 * for the WaveArtist chip and render it inoperable.
637 static void netwinder_restart(enum reboot_mode mode
, const char *cmd
)
639 if (mode
== REBOOT_SOFT
) {
640 /* Jump into the ROM */
641 soft_restart(0x41000000);
646 /* open up the SuperIO chip */
650 /* aux function group 1 (logical device 7) */
654 /* set GP16 for WD-TIMER output */
658 /* set a RED LED and toggle WD_TIMER for rebooting */
664 #if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS)
665 struct netwinder_led
{
666 struct led_classdev cdev
;
671 * The triggers lines up below will only be used if the
672 * LED triggers are compiled in.
674 static const struct {
677 } netwinder_leds
[] = {
678 { "netwinder:green", "heartbeat", },
679 { "netwinder:red", "cpu0", },
683 * The LED control in Netwinder is reversed:
684 * - setting bit means turn off LED
685 * - clearing bit means turn on LED
687 static void netwinder_led_set(struct led_classdev
*cdev
,
688 enum led_brightness b
)
690 struct netwinder_led
*led
= container_of(cdev
,
691 struct netwinder_led
, cdev
);
695 spin_lock_irqsave(&nw_gpio_lock
, flags
);
696 reg
= nw_gpio_read();
701 nw_gpio_modify_op(led
->mask
, reg
);
702 spin_unlock_irqrestore(&nw_gpio_lock
, flags
);
705 static enum led_brightness
netwinder_led_get(struct led_classdev
*cdev
)
707 struct netwinder_led
*led
= container_of(cdev
,
708 struct netwinder_led
, cdev
);
712 spin_lock_irqsave(&nw_gpio_lock
, flags
);
713 reg
= nw_gpio_read();
714 spin_unlock_irqrestore(&nw_gpio_lock
, flags
);
716 return (reg
& led
->mask
) ? LED_OFF
: LED_FULL
;
719 static int __init
netwinder_leds_init(void)
723 if (!machine_is_netwinder())
726 for (i
= 0; i
< ARRAY_SIZE(netwinder_leds
); i
++) {
727 struct netwinder_led
*led
;
729 led
= kzalloc(sizeof(*led
), GFP_KERNEL
);
733 led
->cdev
.name
= netwinder_leds
[i
].name
;
734 led
->cdev
.brightness_set
= netwinder_led_set
;
735 led
->cdev
.brightness_get
= netwinder_led_get
;
736 led
->cdev
.default_trigger
= netwinder_leds
[i
].trigger
;
739 led
->mask
= GPIO_GREEN_LED
;
741 led
->mask
= GPIO_RED_LED
;
743 if (led_classdev_register(NULL
, &led
->cdev
) < 0) {
753 * Since we may have triggers on any subsystem, defer registration
754 * until after subsystem_init.
756 fs_initcall(netwinder_leds_init
);
759 MACHINE_START(NETWINDER
, "Rebel-NetWinder")
760 /* Maintainer: Russell King/Rebel.com */
761 .atag_offset
= 0x100,
762 .video_start
= 0x000a0000,
763 .video_end
= 0x000bffff,
766 .fixup
= fixup_netwinder
,
767 .map_io
= footbridge_map_io
,
768 .init_irq
= footbridge_init_irq
,
769 .init_time
= isa_timer_init
,
770 .restart
= netwinder_restart
,