arch/arm/mach-footbridge/netwinder-hw.c - kernel/msm-4.9 - Gitiles

 /*
  * linux/arch/arm/mach-footbridge/netwinder-hw.c
  *
  * Netwinder machine fixup
  *
  * Copyright (C) 1998, 1999 Russell King, Phil Blundell
  */
 #include <linux/module.h>
 #include <linux/ioport.h>
 #include <linux/kernel.h>
 #include <linux/delay.h>
 #include <linux/init.h>
 #include <linux/io.h>
 #include <linux/spinlock.h>
 #include <linux/slab.h>
 #include <linux/leds.h>

 #include <asm/hardware/dec21285.h>
 #include <asm/mach-types.h>
 #include <asm/setup.h>
 #include <asm/system_misc.h>

 #include <asm/mach/arch.h>

 #include "common.h"

 #define IRDA_IO_BASE		0x180
 #define GP1_IO_BASE		0x338
 #define GP2_IO_BASE		0x33a

 /*
  * Winbond WB83977F accessibility stuff
  */
 static inline void wb977_open(void)
 {
 	outb(0x87, 0x370);
 	outb(0x87, 0x370);
 }

 static inline void wb977_close(void)
 {
 	outb(0xaa, 0x370);
 }

 static inline void wb977_wb(int reg, int val)
 {
 	outb(reg, 0x370);
 	outb(val, 0x371);
 }

 static inline void wb977_ww(int reg, int val)
 {
 	outb(reg, 0x370);
 	outb(val >> 8, 0x371);
 	outb(reg + 1, 0x370);
 	outb(val & 255, 0x371);
 }

 #define wb977_device_select(dev)	wb977_wb(0x07, dev)
 #define wb977_device_disable()		wb977_wb(0x30, 0x00)
 #define wb977_device_enable()		wb977_wb(0x30, 0x01)

 /*
  * This is a lock for accessing ports GP1_IO_BASE and GP2_IO_BASE
  */
 DEFINE_RAW_SPINLOCK(nw_gpio_lock);
 EXPORT_SYMBOL(nw_gpio_lock);

 static unsigned int current_gpio_op;
 static unsigned int current_gpio_io;
 static unsigned int current_cpld;

 void nw_gpio_modify_op(unsigned int mask, unsigned int set)
 {
 	unsigned int new_gpio, changed;

 	new_gpio = (current_gpio_op & ~mask) | set;
 	changed = new_gpio ^ current_gpio_op;
 	current_gpio_op = new_gpio;

 	if (changed & 0xff)
 		outb(new_gpio, GP1_IO_BASE);
 	if (changed & 0xff00)
 		outb(new_gpio >> 8, GP2_IO_BASE);
 }
 EXPORT_SYMBOL(nw_gpio_modify_op);

 static inline void __gpio_modify_io(int mask, int in)
 {
 	unsigned int new_gpio, changed;
 	int port;

 	new_gpio = (current_gpio_io & ~mask) | in;
 	changed = new_gpio ^ current_gpio_io;
 	current_gpio_io = new_gpio;

 	changed >>= 1;
 	new_gpio >>= 1;

 	wb977_device_select(7);

 	for (port = 0xe1; changed && port < 0xe8; changed >>= 1) {
 		wb977_wb(port, new_gpio & 1);

 		port += 1;
 		new_gpio >>= 1;
 	}

 	wb977_device_select(8);

 	for (port = 0xe8; changed && port < 0xec; changed >>= 1) {
 		wb977_wb(port, new_gpio & 1);

 		port += 1;
 		new_gpio >>= 1;
 	}
 }

 void nw_gpio_modify_io(unsigned int mask, unsigned int in)
 {
 	/* Open up the SuperIO chip */
 	wb977_open();

 	__gpio_modify_io(mask, in);

 	/* Close up the EFER gate */
 	wb977_close();
 }
 EXPORT_SYMBOL(nw_gpio_modify_io);

 unsigned int nw_gpio_read(void)
 {
 	return inb(GP1_IO_BASE) | inb(GP2_IO_BASE) << 8;
 }
 EXPORT_SYMBOL(nw_gpio_read);

 /*
  * Initialise the Winbond W83977F global registers
  */
 static inline void wb977_init_global(void)
 {
 	/*
 	 * Enable R/W config registers
 	 */
 	wb977_wb(0x26, 0x40);

 	/*
 	 * Power down FDC (not used)
 	 */
 	wb977_wb(0x22, 0xfe);

 	/*
 	 * GP12, GP11, CIRRX, IRRXH, GP10
 	 */
 	wb977_wb(0x2a, 0xc1);

 	/*
 	 * GP23, GP22, GP21, GP20, GP13
 	 */
 	wb977_wb(0x2b, 0x6b);

 	/*
 	 * GP17, GP16, GP15, GP14
 	 */
 	wb977_wb(0x2c, 0x55);
 }

 /*
  * Initialise the Winbond W83977F printer port
  */
 static inline void wb977_init_printer(void)
 {
 	wb977_device_select(1);

 	/*
 	 * mode 1 == EPP
 	 */
 	wb977_wb(0xf0, 0x01);
 }

 /*
  * Initialise the Winbond W83977F keyboard controller
  */
 static inline void wb977_init_keyboard(void)
 {
 	wb977_device_select(5);

 	/*
 	 * Keyboard controller address
 	 */
 	wb977_ww(0x60, 0x0060);
 	wb977_ww(0x62, 0x0064);

 	/*
 	 * Keyboard IRQ 1, active high, edge trigger
 	 */
 	wb977_wb(0x70, 1);
 	wb977_wb(0x71, 0x02);

 	/*
 	 * Mouse IRQ 5, active high, edge trigger
 	 */
 	wb977_wb(0x72, 5);
 	wb977_wb(0x73, 0x02);

 	/*
 	 * KBC 8MHz
 	 */
 	wb977_wb(0xf0, 0x40);

 	/*
 	 * Enable device
 	 */
 	wb977_device_enable();
 }

 /*
  * Initialise the Winbond W83977F Infra-Red device
  */
 static inline void wb977_init_irda(void)
 {
 	wb977_device_select(6);

 	/*
 	 * IR base address
 	 */
 	wb977_ww(0x60, IRDA_IO_BASE);

 	/*
 	 * IRDA IRQ 6, active high, edge trigger
 	 */
 	wb977_wb(0x70, 6);
 	wb977_wb(0x71, 0x02);

 	/*
 	 * RX DMA - ISA DMA 0
 	 */
 	wb977_wb(0x74, 0x00);

 	/*
 	 * TX DMA - Disable Tx DMA
 	 */
 	wb977_wb(0x75, 0x04);

 	/*
 	 * Append CRC, Enable bank selection
 	 */
 	wb977_wb(0xf0, 0x03);

 	/*
 	 * Enable device
 	 */
 	wb977_device_enable();
 }

 /*
  * Initialise Winbond W83977F general purpose IO
  */
 static inline void wb977_init_gpio(void)
 {
 	unsigned long flags;

 	/*
 	 * Set up initial I/O definitions
 	 */
 	current_gpio_io = -1;
 	__gpio_modify_io(-1, GPIO_DONE | GPIO_WDTIMER);

 	wb977_device_select(7);

 	/*
 	 * Group1 base address
 	 */
 	wb977_ww(0x60, GP1_IO_BASE);
 	wb977_ww(0x62, 0);
 	wb977_ww(0x64, 0);

 	/*
 	 * GP10 (Orage button) IRQ 10, active high, edge trigger
 	 */
 	wb977_wb(0x70, 10);
 	wb977_wb(0x71, 0x02);

 	/*
 	 * GP10: Debounce filter enabled, IRQ, input
 	 */
 	wb977_wb(0xe0, 0x19);

 	/*
 	 * Enable Group1
 	 */
 	wb977_device_enable();

 	wb977_device_select(8);

 	/*
 	 * Group2 base address
 	 */
 	wb977_ww(0x60, GP2_IO_BASE);

 	/*
 	 * Clear watchdog timer regs
 	 *  - timer disable
 	 */
 	wb977_wb(0xf2, 0x00);

 	/*
 	 *  - disable LED, no mouse nor keyboard IRQ
 	 */
 	wb977_wb(0xf3, 0x00);

 	/*
 	 *  - timer counting, disable power LED, disable timeouot
 	 */
 	wb977_wb(0xf4, 0x00);

 	/*
 	 * Enable group2
 	 */
 	wb977_device_enable();

 	/*
 	 * Set Group1/Group2 outputs
 	 */
 	raw_spin_lock_irqsave(&nw_gpio_lock, flags);
 	nw_gpio_modify_op(-1, GPIO_RED_LED | GPIO_FAN);
 	raw_spin_unlock_irqrestore(&nw_gpio_lock, flags);
 }

 /*
  * Initialise the Winbond W83977F chip.
  */
 static void __init wb977_init(void)
 {
 	request_region(0x370, 2, "W83977AF configuration");

 	/*
 	 * Open up the SuperIO chip
 	 */
 	wb977_open();

 	/*
 	 * Initialise the global registers
 	 */
 	wb977_init_global();

 	/*
 	 * Initialise the various devices in
 	 * the multi-IO chip.
 	 */
 	wb977_init_printer();
 	wb977_init_keyboard();
 	wb977_init_irda();
 	wb977_init_gpio();

 	/*
 	 * Close up the EFER gate
 	 */
 	wb977_close();
 }

 void nw_cpld_modify(unsigned int mask, unsigned int set)
 {
 	int msk;

 	current_cpld = (current_cpld & ~mask) | set;

 	nw_gpio_modify_io(GPIO_DATA | GPIO_IOCLK | GPIO_IOLOAD, 0);
 	nw_gpio_modify_op(GPIO_IOLOAD, 0);

 	for (msk = 8; msk; msk >>= 1) {
 		int bit = current_cpld & msk;

 		nw_gpio_modify_op(GPIO_DATA | GPIO_IOCLK, bit ? GPIO_DATA : 0);
 		nw_gpio_modify_op(GPIO_IOCLK, GPIO_IOCLK);
 	}

 	nw_gpio_modify_op(GPIO_IOCLK|GPIO_DATA, 0);
 	nw_gpio_modify_op(GPIO_IOLOAD|GPIO_DSCLK, GPIO_IOLOAD|GPIO_DSCLK);
 	nw_gpio_modify_op(GPIO_IOLOAD, 0);
 }
 EXPORT_SYMBOL(nw_cpld_modify);

 static void __init cpld_init(void)
 {
 	unsigned long flags;

 	raw_spin_lock_irqsave(&nw_gpio_lock, flags);
 	nw_cpld_modify(-1, CPLD_UNMUTE | CPLD_7111_DISABLE);
 	raw_spin_unlock_irqrestore(&nw_gpio_lock, flags);
 }

 static unsigned char rwa_unlock[] __initdata =
 { 0x00, 0x00, 0x6a, 0xb5, 0xda, 0xed, 0xf6, 0xfb, 0x7d, 0xbe, 0xdf, 0x6f, 0x37, 0x1b,
   0x0d, 0x86, 0xc3, 0x61, 0xb0, 0x58, 0x2c, 0x16, 0x8b, 0x45, 0xa2, 0xd1, 0xe8, 0x74,
   0x3a, 0x9d, 0xce, 0xe7, 0x73, 0x39 };

 #ifndef DEBUG
 #define dprintk(x...)
 #else
 #define dprintk(x...) printk(x)
 #endif

 #define WRITE_RWA(r,v) do { outb((r), 0x279); udelay(10); outb((v), 0xa79); } while (0)

 static inline void rwa010_unlock(void)
 {
 	int i;

 	WRITE_RWA(2, 2);
 	mdelay(10);

 	for (i = 0; i < sizeof(rwa_unlock); i++) {
 		outb(rwa_unlock[i], 0x279);
 		udelay(10);
 	}
 }

 static inline void rwa010_read_ident(void)
 {
 	unsigned char si[9];
 	int i, j;

 	WRITE_RWA(3, 0);
 	WRITE_RWA(0, 128);

 	outb(1, 0x279);

 	mdelay(1);

 	dprintk("Identifier: ");
 	for (i = 0; i < 9; i++) {
 		si[i] = 0;
 		for (j = 0; j < 8; j++) {
 			int bit;
 			udelay(250);
 			inb(0x203);
 			udelay(250);
 			bit = inb(0x203);
 			dprintk("%02X ", bit);
 			bit = (bit == 0xaa) ? 1 : 0;
 			si[i] |= bit << j;
 		}
 		dprintk("(%02X) ", si[i]);
 	}
 	dprintk("\n");
 }

 static inline void rwa010_global_init(void)
 {
 	WRITE_RWA(6, 2);	// Assign a card no = 2

 	dprintk("Card no = %d\n", inb(0x203));

 	/* disable the modem section of the chip */
 	WRITE_RWA(7, 3);
 	WRITE_RWA(0x30, 0);

 	/* disable the cdrom section of the chip */
 	WRITE_RWA(7, 4);
 	WRITE_RWA(0x30, 0);

 	/* disable the MPU-401 section of the chip */
 	WRITE_RWA(7, 2);
 	WRITE_RWA(0x30, 0);
 }

 static inline void rwa010_game_port_init(void)
 {
 	int i;

 	WRITE_RWA(7, 5);

 	dprintk("Slider base: ");
 	WRITE_RWA(0x61, 1);
 	i = inb(0x203);

 	WRITE_RWA(0x60, 2);
 	dprintk("%02X%02X (201)\n", inb(0x203), i);

 	WRITE_RWA(0x30, 1);
 }

 static inline void rwa010_waveartist_init(int base, int irq, int dma)
 {
 	int i;

 	WRITE_RWA(7, 0);

 	dprintk("WaveArtist base: ");
 	WRITE_RWA(0x61, base & 255);
 	i = inb(0x203);

 	WRITE_RWA(0x60, base >> 8);
 	dprintk("%02X%02X (%X),", inb(0x203), i, base);

 	WRITE_RWA(0x70, irq);
 	dprintk(" irq: %d (%d),", inb(0x203), irq);

 	WRITE_RWA(0x74, dma);
 	dprintk(" dma: %d (%d)\n", inb(0x203), dma);

 	WRITE_RWA(0x30, 1);
 }

 static inline void rwa010_soundblaster_init(int sb_base, int al_base, int irq, int dma)
 {
 	int i;

 	WRITE_RWA(7, 1);

 	dprintk("SoundBlaster base: ");
 	WRITE_RWA(0x61, sb_base & 255);
 	i = inb(0x203);

 	WRITE_RWA(0x60, sb_base >> 8);
 	dprintk("%02X%02X (%X),", inb(0x203), i, sb_base);

 	dprintk(" irq: ");
 	WRITE_RWA(0x70, irq);
 	dprintk("%d (%d),", inb(0x203), irq);

 	dprintk(" 8-bit DMA: ");
 	WRITE_RWA(0x74, dma);
 	dprintk("%d (%d)\n", inb(0x203), dma);

 	dprintk("AdLib base: ");
 	WRITE_RWA(0x63, al_base & 255);
 	i = inb(0x203);

 	WRITE_RWA(0x62, al_base >> 8);
 	dprintk("%02X%02X (%X)\n", inb(0x203), i, al_base);

 	WRITE_RWA(0x30, 1);
 }

 static void rwa010_soundblaster_reset(void)
 {
 	int i;

 	outb(1, 0x226);
 	udelay(3);
 	outb(0, 0x226);

 	for (i = 0; i < 5; i++) {
 		if (inb(0x22e) & 0x80)
 			break;
 		mdelay(1);
 	}
 	if (i == 5)
 		printk("SoundBlaster: DSP reset failed\n");

 	dprintk("SoundBlaster DSP reset: %02X (AA)\n", inb(0x22a));

 	for (i = 0; i < 5; i++) {
 		if ((inb(0x22c) & 0x80) == 0)
 			break;
 		mdelay(1);
 	}

 	if (i == 5)
 		printk("SoundBlaster: DSP not ready\n");
 	else {
 		outb(0xe1, 0x22c);

 		dprintk("SoundBlaster DSP id: ");
 		i = inb(0x22a);
 		udelay(1);
 		i |= inb(0x22a) << 8;
 		dprintk("%04X\n", i);

 		for (i = 0; i < 5; i++) {
 			if ((inb(0x22c) & 0x80) == 0)
 				break;
 			mdelay(1);
 		}

 		if (i == 5)
 			printk("SoundBlaster: could not turn speaker off\n");

 		outb(0xd3, 0x22c);
 	}

 	/* turn on OPL3 */
 	outb(5, 0x38a);
 	outb(1, 0x38b);
 }

 static void __init rwa010_init(void)
 {
 	rwa010_unlock();
 	rwa010_read_ident();
 	rwa010_global_init();
 	rwa010_game_port_init();
 	rwa010_waveartist_init(0x250, 3, 7);
 	rwa010_soundblaster_init(0x220, 0x388, 3, 1);
 	rwa010_soundblaster_reset();
 }

 /*
  * Initialise any other hardware after we've got the PCI bus
  * initialised.  We may need the PCI bus to talk to this other
  * hardware.
  */
 static int __init nw_hw_init(void)
 {
 	if (machine_is_netwinder()) {
 		wb977_init();
 		cpld_init();
 		rwa010_init();
 	}
 	return 0;
 }

 __initcall(nw_hw_init);

 /*
  * Older NeTTroms either do not provide a parameters
  * page, or they don't supply correct information in
  * the parameter page.
  */
 static void __init
 fixup_netwinder(struct tag *tags, char **cmdline, struct meminfo *mi)
 {
 #ifdef CONFIG_ISAPNP
 	extern int isapnp_disable;

 	/*
 	 * We must not use the kernels ISAPnP code
 	 * on the NetWinder - it will reset the settings
 	 * for the WaveArtist chip and render it inoperable.
 	 */
 	isapnp_disable = 1;
 #endif
 }

 static void netwinder_restart(enum reboot_mode mode, const char *cmd)
 {
 	if (mode == REBOOT_SOFT) {
 		/* Jump into the ROM */
 		soft_restart(0x41000000);
 	} else {
 		local_irq_disable();
 		local_fiq_disable();

 		/* open up the SuperIO chip */
 		outb(0x87, 0x370);
 		outb(0x87, 0x370);

 		/* aux function group 1 (logical device 7) */
 		outb(0x07, 0x370);
 		outb(0x07, 0x371);

 		/* set GP16 for WD-TIMER output */
 		outb(0xe6, 0x370);
 		outb(0x00, 0x371);

 		/* set a RED LED and toggle WD_TIMER for rebooting */
 		outb(0xc4, 0x338);
 	}
 }

 /* LEDs */
 #if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS)
 struct netwinder_led {
 	struct led_classdev     cdev;
 	u8                      mask;
 };

 /*
  * The triggers lines up below will only be used if the
  * LED triggers are compiled in.
  */
 static const struct {
 	const char *name;
 	const char *trigger;
 } netwinder_leds[] = {
 	{ "netwinder:green", "heartbeat", },
 	{ "netwinder:red", "cpu0", },
 };

 /*
  * The LED control in Netwinder is reversed:
  *  - setting bit means turn off LED
  *  - clearing bit means turn on LED
  */
 static void netwinder_led_set(struct led_classdev *cdev,
 		enum led_brightness b)
 {
 	struct netwinder_led *led = container_of(cdev,
 			struct netwinder_led, cdev);
 	unsigned long flags;
 	u32 reg;

 	raw_spin_lock_irqsave(&nw_gpio_lock, flags);
 	reg = nw_gpio_read();
 	if (b != LED_OFF)
 		reg &= ~led->mask;
 	else
 		reg |= led->mask;
 	nw_gpio_modify_op(led->mask, reg);
 	raw_spin_unlock_irqrestore(&nw_gpio_lock, flags);
 }

 static enum led_brightness netwinder_led_get(struct led_classdev *cdev)
 {
 	struct netwinder_led *led = container_of(cdev,
 			struct netwinder_led, cdev);
 	unsigned long flags;
 	u32 reg;

 	raw_spin_lock_irqsave(&nw_gpio_lock, flags);
 	reg = nw_gpio_read();
 	raw_spin_unlock_irqrestore(&nw_gpio_lock, flags);

 	return (reg & led->mask) ? LED_OFF : LED_FULL;
 }

 static int __init netwinder_leds_init(void)
 {
 	int i;

 	if (!machine_is_netwinder())
 		return -ENODEV;

 	for (i = 0; i < ARRAY_SIZE(netwinder_leds); i++) {
 		struct netwinder_led *led;

 		led = kzalloc(sizeof(*led), GFP_KERNEL);
 		if (!led)
 			break;

 		led->cdev.name = netwinder_leds[i].name;
 		led->cdev.brightness_set = netwinder_led_set;
 		led->cdev.brightness_get = netwinder_led_get;
 		led->cdev.default_trigger = netwinder_leds[i].trigger;

 		if (i == 0)
 			led->mask = GPIO_GREEN_LED;
 		else
 			led->mask = GPIO_RED_LED;

 		if (led_classdev_register(NULL, &led->cdev) < 0) {
 			kfree(led);
 			break;
 		}
 	}

 	return 0;
 }

 /*
  * Since we may have triggers on any subsystem, defer registration
  * until after subsystem_init.
  */
 fs_initcall(netwinder_leds_init);
 #endif

 MACHINE_START(NETWINDER, "Rebel-NetWinder")
 	/* Maintainer: Russell King/Rebel.com */
 	.atag_offset	= 0x100,
 	.video_start	= 0x000a0000,
 	.video_end	= 0x000bffff,
 	.reserve_lp0	= 1,
 	.reserve_lp2	= 1,
 	.fixup		= fixup_netwinder,
 	.map_io		= footbridge_map_io,
 	.init_irq	= footbridge_init_irq,
 	.init_time	= isa_timer_init,
 	.restart	= netwinder_restart,
 MACHINE_END
	/*
	* linux/arch/arm/mach-footbridge/netwinder-hw.c
	*
	* Netwinder machine fixup
	*
	* Copyright (C) 1998, 1999 Russell King, Phil Blundell
	*/
	#include <linux/module.h>
	#include <linux/ioport.h>
	#include <linux/kernel.h>
	#include <linux/delay.h>
	#include <linux/init.h>
	#include <linux/io.h>
	#include <linux/spinlock.h>
	#include <linux/slab.h>
	#include <linux/leds.h>

	#include <asm/hardware/dec21285.h>
	#include <asm/mach-types.h>
	#include <asm/setup.h>
	#include <asm/system_misc.h>

	#include <asm/mach/arch.h>

	#include "common.h"

	#define IRDA_IO_BASE 0x180
	#define GP1_IO_BASE 0x338
	#define GP2_IO_BASE 0x33a

	/*
	* Winbond WB83977F accessibility stuff
	*/
	static inline void wb977_open(void)
	{
	outb(0x87, 0x370);
	outb(0x87, 0x370);
	}

	static inline void wb977_close(void)
	{
	outb(0xaa, 0x370);
	}

	static inline void wb977_wb(int reg, int val)
	{
	outb(reg, 0x370);
	outb(val, 0x371);
	}

	static inline void wb977_ww(int reg, int val)
	{
	outb(reg, 0x370);
	outb(val >> 8, 0x371);
	outb(reg + 1, 0x370);
	outb(val & 255, 0x371);
	}

	#define wb977_device_select(dev) wb977_wb(0x07, dev)
	#define wb977_device_disable() wb977_wb(0x30, 0x00)
	#define wb977_device_enable() wb977_wb(0x30, 0x01)

	/*
	* This is a lock for accessing ports GP1_IO_BASE and GP2_IO_BASE
	*/
	DEFINE_RAW_SPINLOCK(nw_gpio_lock);
	EXPORT_SYMBOL(nw_gpio_lock);

	static unsigned int current_gpio_op;
	static unsigned int current_gpio_io;
	static unsigned int current_cpld;

	void nw_gpio_modify_op(unsigned int mask, unsigned int set)
	{
	unsigned int new_gpio, changed;

	new_gpio = (current_gpio_op & ~mask) \| set;
	changed = new_gpio ^ current_gpio_op;
	current_gpio_op = new_gpio;

	if (changed & 0xff)
	outb(new_gpio, GP1_IO_BASE);
	if (changed & 0xff00)
	outb(new_gpio >> 8, GP2_IO_BASE);
	}
	EXPORT_SYMBOL(nw_gpio_modify_op);

	static inline void __gpio_modify_io(int mask, int in)
	{
	unsigned int new_gpio, changed;
	int port;

	new_gpio = (current_gpio_io & ~mask) \| in;
	changed = new_gpio ^ current_gpio_io;
	current_gpio_io = new_gpio;

	changed >>= 1;
	new_gpio >>= 1;

	wb977_device_select(7);

	for (port = 0xe1; changed && port < 0xe8; changed >>= 1) {
	wb977_wb(port, new_gpio & 1);

	port += 1;
	new_gpio >>= 1;
	}

	wb977_device_select(8);

	for (port = 0xe8; changed && port < 0xec; changed >>= 1) {
	wb977_wb(port, new_gpio & 1);

	port += 1;
	new_gpio >>= 1;
	}
	}

	void nw_gpio_modify_io(unsigned int mask, unsigned int in)
	{
	/* Open up the SuperIO chip */
	wb977_open();

	__gpio_modify_io(mask, in);

	/* Close up the EFER gate */
	wb977_close();
	}
	EXPORT_SYMBOL(nw_gpio_modify_io);

	unsigned int nw_gpio_read(void)
	{
	return inb(GP1_IO_BASE) \| inb(GP2_IO_BASE) << 8;
	}
	EXPORT_SYMBOL(nw_gpio_read);

	/*
	* Initialise the Winbond W83977F global registers
	*/
	static inline void wb977_init_global(void)
	{
	/*
	* Enable R/W config registers
	*/
	wb977_wb(0x26, 0x40);

	/*
	* Power down FDC (not used)
	*/
	wb977_wb(0x22, 0xfe);

	/*
	* GP12, GP11, CIRRX, IRRXH, GP10
	*/
	wb977_wb(0x2a, 0xc1);

	/*
	* GP23, GP22, GP21, GP20, GP13
	*/
	wb977_wb(0x2b, 0x6b);

	/*
	* GP17, GP16, GP15, GP14
	*/
	wb977_wb(0x2c, 0x55);
	}

	/*
	* Initialise the Winbond W83977F printer port
	*/
	static inline void wb977_init_printer(void)
	{
	wb977_device_select(1);

	/*
	* mode 1 == EPP
	*/
	wb977_wb(0xf0, 0x01);
	}

	/*
	* Initialise the Winbond W83977F keyboard controller
	*/
	static inline void wb977_init_keyboard(void)
	{
	wb977_device_select(5);

	/*
	* Keyboard controller address
	*/
	wb977_ww(0x60, 0x0060);
	wb977_ww(0x62, 0x0064);

	/*
	* Keyboard IRQ 1, active high, edge trigger
	*/
	wb977_wb(0x70, 1);
	wb977_wb(0x71, 0x02);

	/*
	* Mouse IRQ 5, active high, edge trigger
	*/
	wb977_wb(0x72, 5);
	wb977_wb(0x73, 0x02);

	/*
	* KBC 8MHz
	*/
	wb977_wb(0xf0, 0x40);

	/*
	* Enable device
	*/
	wb977_device_enable();
	}

	/*
	* Initialise the Winbond W83977F Infra-Red device
	*/
	static inline void wb977_init_irda(void)
	{
	wb977_device_select(6);

	/*
	* IR base address
	*/
	wb977_ww(0x60, IRDA_IO_BASE);

	/*
	* IRDA IRQ 6, active high, edge trigger
	*/
	wb977_wb(0x70, 6);
	wb977_wb(0x71, 0x02);

	/*
	* RX DMA - ISA DMA 0
	*/
	wb977_wb(0x74, 0x00);

	/*
	* TX DMA - Disable Tx DMA
	*/
	wb977_wb(0x75, 0x04);

	/*
	* Append CRC, Enable bank selection
	*/
	wb977_wb(0xf0, 0x03);

	/*
	* Enable device
	*/
	wb977_device_enable();
	}

	/*
	* Initialise Winbond W83977F general purpose IO
	*/
	static inline void wb977_init_gpio(void)
	{
	unsigned long flags;

	/*
	* Set up initial I/O definitions
	*/
	current_gpio_io = -1;
	__gpio_modify_io(-1, GPIO_DONE \| GPIO_WDTIMER);

	wb977_device_select(7);

	/*
	* Group1 base address
	*/
	wb977_ww(0x60, GP1_IO_BASE);
	wb977_ww(0x62, 0);
	wb977_ww(0x64, 0);

	/*
	* GP10 (Orage button) IRQ 10, active high, edge trigger
	*/
	wb977_wb(0x70, 10);
	wb977_wb(0x71, 0x02);

	/*
	* GP10: Debounce filter enabled, IRQ, input
	*/
	wb977_wb(0xe0, 0x19);

	/*
	* Enable Group1
	*/
	wb977_device_enable();

	wb977_device_select(8);

	/*
	* Group2 base address
	*/
	wb977_ww(0x60, GP2_IO_BASE);

	/*
	* Clear watchdog timer regs
	* - timer disable
	*/
	wb977_wb(0xf2, 0x00);

	/*
	* - disable LED, no mouse nor keyboard IRQ
	*/
	wb977_wb(0xf3, 0x00);

	/*
	* - timer counting, disable power LED, disable timeouot
	*/
	wb977_wb(0xf4, 0x00);

	/*
	* Enable group2
	*/
	wb977_device_enable();

	/*
	* Set Group1/Group2 outputs
	*/
	raw_spin_lock_irqsave(&nw_gpio_lock, flags);
	nw_gpio_modify_op(-1, GPIO_RED_LED \| GPIO_FAN);
	raw_spin_unlock_irqrestore(&nw_gpio_lock, flags);
	}

	/*
	* Initialise the Winbond W83977F chip.
	*/
	static void __init wb977_init(void)
	{
	request_region(0x370, 2, "W83977AF configuration");

	/*
	* Open up the SuperIO chip
	*/
	wb977_open();

	/*
	* Initialise the global registers
	*/
	wb977_init_global();

	/*
	* Initialise the various devices in
	* the multi-IO chip.
	*/
	wb977_init_printer();
	wb977_init_keyboard();
	wb977_init_irda();
	wb977_init_gpio();

	/*
	* Close up the EFER gate
	*/
	wb977_close();
	}

	void nw_cpld_modify(unsigned int mask, unsigned int set)
	{
	int msk;

	current_cpld = (current_cpld & ~mask) \| set;

	nw_gpio_modify_io(GPIO_DATA \| GPIO_IOCLK \| GPIO_IOLOAD, 0);
	nw_gpio_modify_op(GPIO_IOLOAD, 0);

	for (msk = 8; msk; msk >>= 1) {
	int bit = current_cpld & msk;

	nw_gpio_modify_op(GPIO_DATA \| GPIO_IOCLK, bit ? GPIO_DATA : 0);
	nw_gpio_modify_op(GPIO_IOCLK, GPIO_IOCLK);
	}

	nw_gpio_modify_op(GPIO_IOCLK\|GPIO_DATA, 0);
	nw_gpio_modify_op(GPIO_IOLOAD\|GPIO_DSCLK, GPIO_IOLOAD\|GPIO_DSCLK);
	nw_gpio_modify_op(GPIO_IOLOAD, 0);
	}
	EXPORT_SYMBOL(nw_cpld_modify);

	static void __init cpld_init(void)
	{
	unsigned long flags;

	raw_spin_lock_irqsave(&nw_gpio_lock, flags);
	nw_cpld_modify(-1, CPLD_UNMUTE \| CPLD_7111_DISABLE);
	raw_spin_unlock_irqrestore(&nw_gpio_lock, flags);
	}

	static unsigned char rwa_unlock[] __initdata =
	{ 0x00, 0x00, 0x6a, 0xb5, 0xda, 0xed, 0xf6, 0xfb, 0x7d, 0xbe, 0xdf, 0x6f, 0x37, 0x1b,
	0x0d, 0x86, 0xc3, 0x61, 0xb0, 0x58, 0x2c, 0x16, 0x8b, 0x45, 0xa2, 0xd1, 0xe8, 0x74,
	0x3a, 0x9d, 0xce, 0xe7, 0x73, 0x39 };

	#ifndef DEBUG
	#define dprintk(x...)
	#else
	#define dprintk(x...) printk(x)
	#endif

	#define WRITE_RWA(r,v) do { outb((r), 0x279); udelay(10); outb((v), 0xa79); } while (0)

	static inline void rwa010_unlock(void)
	{
	int i;

	WRITE_RWA(2, 2);
	mdelay(10);

	for (i = 0; i < sizeof(rwa_unlock); i++) {
	outb(rwa_unlock[i], 0x279);
	udelay(10);
	}
	}

	static inline void rwa010_read_ident(void)
	{
	unsigned char si[9];
	int i, j;

	WRITE_RWA(3, 0);
	WRITE_RWA(0, 128);

	outb(1, 0x279);

	mdelay(1);

	dprintk("Identifier: ");
	for (i = 0; i < 9; i++) {
	si[i] = 0;
	for (j = 0; j < 8; j++) {
	int bit;
	udelay(250);
	inb(0x203);
	udelay(250);
	bit = inb(0x203);
	dprintk("%02X ", bit);
	bit = (bit == 0xaa) ? 1 : 0;
	si[i] \|= bit << j;
	}
	dprintk("(%02X) ", si[i]);
	}
	dprintk("\n");
	}

	static inline void rwa010_global_init(void)
	{
	WRITE_RWA(6, 2); // Assign a card no = 2

	dprintk("Card no = %d\n", inb(0x203));

	/* disable the modem section of the chip */
	WRITE_RWA(7, 3);
	WRITE_RWA(0x30, 0);

	/* disable the cdrom section of the chip */
	WRITE_RWA(7, 4);
	WRITE_RWA(0x30, 0);

	/* disable the MPU-401 section of the chip */
	WRITE_RWA(7, 2);
	WRITE_RWA(0x30, 0);
	}

	static inline void rwa010_game_port_init(void)
	{
	int i;

	WRITE_RWA(7, 5);

	dprintk("Slider base: ");
	WRITE_RWA(0x61, 1);
	i = inb(0x203);

	WRITE_RWA(0x60, 2);
	dprintk("%02X%02X (201)\n", inb(0x203), i);

	WRITE_RWA(0x30, 1);
	}

	static inline void rwa010_waveartist_init(int base, int irq, int dma)
	{
	int i;

	WRITE_RWA(7, 0);

	dprintk("WaveArtist base: ");
	WRITE_RWA(0x61, base & 255);
	i = inb(0x203);

	WRITE_RWA(0x60, base >> 8);
	dprintk("%02X%02X (%X),", inb(0x203), i, base);

	WRITE_RWA(0x70, irq);
	dprintk(" irq: %d (%d),", inb(0x203), irq);

	WRITE_RWA(0x74, dma);
	dprintk(" dma: %d (%d)\n", inb(0x203), dma);

	WRITE_RWA(0x30, 1);
	}

	static inline void rwa010_soundblaster_init(int sb_base, int al_base, int irq, int dma)
	{
	int i;

	WRITE_RWA(7, 1);

	dprintk("SoundBlaster base: ");
	WRITE_RWA(0x61, sb_base & 255);
	i = inb(0x203);

	WRITE_RWA(0x60, sb_base >> 8);
	dprintk("%02X%02X (%X),", inb(0x203), i, sb_base);

	dprintk(" irq: ");
	WRITE_RWA(0x70, irq);
	dprintk("%d (%d),", inb(0x203), irq);

	dprintk(" 8-bit DMA: ");
	WRITE_RWA(0x74, dma);
	dprintk("%d (%d)\n", inb(0x203), dma);

	dprintk("AdLib base: ");
	WRITE_RWA(0x63, al_base & 255);
	i = inb(0x203);

	WRITE_RWA(0x62, al_base >> 8);
	dprintk("%02X%02X (%X)\n", inb(0x203), i, al_base);

	WRITE_RWA(0x30, 1);
	}

	static void rwa010_soundblaster_reset(void)
	{
	int i;

	outb(1, 0x226);
	udelay(3);
	outb(0, 0x226);

	for (i = 0; i < 5; i++) {
	if (inb(0x22e) & 0x80)
	break;
	mdelay(1);
	}
	if (i == 5)
	printk("SoundBlaster: DSP reset failed\n");

	dprintk("SoundBlaster DSP reset: %02X (AA)\n", inb(0x22a));

	for (i = 0; i < 5; i++) {
	if ((inb(0x22c) & 0x80) == 0)
	break;
	mdelay(1);
	}

	if (i == 5)
	printk("SoundBlaster: DSP not ready\n");
	else {
	outb(0xe1, 0x22c);

	dprintk("SoundBlaster DSP id: ");
	i = inb(0x22a);
	udelay(1);
	i \|= inb(0x22a) << 8;
	dprintk("%04X\n", i);

	for (i = 0; i < 5; i++) {
	if ((inb(0x22c) & 0x80) == 0)
	break;
	mdelay(1);
	}

	if (i == 5)
	printk("SoundBlaster: could not turn speaker off\n");

	outb(0xd3, 0x22c);
	}

	/* turn on OPL3 */
	outb(5, 0x38a);
	outb(1, 0x38b);
	}

	static void __init rwa010_init(void)
	{
	rwa010_unlock();
	rwa010_read_ident();
	rwa010_global_init();
	rwa010_game_port_init();
	rwa010_waveartist_init(0x250, 3, 7);
	rwa010_soundblaster_init(0x220, 0x388, 3, 1);
	rwa010_soundblaster_reset();
	}

	/*
	* Initialise any other hardware after we've got the PCI bus
	* initialised. We may need the PCI bus to talk to this other
	* hardware.
	*/
	static int __init nw_hw_init(void)
	{
	if (machine_is_netwinder()) {
	wb977_init();
	cpld_init();
	rwa010_init();
	}
	return 0;
	}

	__initcall(nw_hw_init);

	/*
	* Older NeTTroms either do not provide a parameters
	* page, or they don't supply correct information in
	* the parameter page.
	*/
	static void __init
	fixup_netwinder(struct tag tags, char cmdline, struct meminfo mi)
	{
	#ifdef CONFIG_ISAPNP
	extern int isapnp_disable;

	/*
	* We must not use the kernels ISAPnP code
	* on the NetWinder - it will reset the settings
	* for the WaveArtist chip and render it inoperable.
	*/
	isapnp_disable = 1;
	#endif
	}

	static void netwinder_restart(enum reboot_mode mode, const char *cmd)
	{
	if (mode == REBOOT_SOFT) {
	/* Jump into the ROM */
	soft_restart(0x41000000);
	} else {
	local_irq_disable();
	local_fiq_disable();

	/* open up the SuperIO chip */
	outb(0x87, 0x370);
	outb(0x87, 0x370);

	/* aux function group 1 (logical device 7) */
	outb(0x07, 0x370);
	outb(0x07, 0x371);

	/* set GP16 for WD-TIMER output */
	outb(0xe6, 0x370);
	outb(0x00, 0x371);

	/* set a RED LED and toggle WD_TIMER for rebooting */
	outb(0xc4, 0x338);
	}
	}

	/* LEDs */
	#if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS)
	struct netwinder_led {
	struct led_classdev cdev;
	u8 mask;
	};

	/*
	* The triggers lines up below will only be used if the
	* LED triggers are compiled in.
	*/
	static const struct {
	const char *name;
	const char *trigger;
	} netwinder_leds[] = {
	{ "netwinder:green", "heartbeat", },
	{ "netwinder:red", "cpu0", },
	};

	/*
	* The LED control in Netwinder is reversed:
	* - setting bit means turn off LED
	* - clearing bit means turn on LED
	*/
	static void netwinder_led_set(struct led_classdev *cdev,
	enum led_brightness b)
	{
	struct netwinder_led *led = container_of(cdev,
	struct netwinder_led, cdev);
	unsigned long flags;
	u32 reg;

	raw_spin_lock_irqsave(&nw_gpio_lock, flags);
	reg = nw_gpio_read();
	if (b != LED_OFF)
	reg &= ~led->mask;
	else
	reg \|= led->mask;
	nw_gpio_modify_op(led->mask, reg);
	raw_spin_unlock_irqrestore(&nw_gpio_lock, flags);
	}

	static enum led_brightness netwinder_led_get(struct led_classdev *cdev)
	{
	struct netwinder_led *led = container_of(cdev,
	struct netwinder_led, cdev);
	unsigned long flags;
	u32 reg;

	raw_spin_lock_irqsave(&nw_gpio_lock, flags);
	reg = nw_gpio_read();
	raw_spin_unlock_irqrestore(&nw_gpio_lock, flags);

	return (reg & led->mask) ? LED_OFF : LED_FULL;
	}

	static int __init netwinder_leds_init(void)
	{
	int i;

	if (!machine_is_netwinder())
	return -ENODEV;

	for (i = 0; i < ARRAY_SIZE(netwinder_leds); i++) {
	struct netwinder_led *led;

	led = kzalloc(sizeof(*led), GFP_KERNEL);
	if (!led)
	break;

	led->cdev.name = netwinder_leds[i].name;
	led->cdev.brightness_set = netwinder_led_set;
	led->cdev.brightness_get = netwinder_led_get;
	led->cdev.default_trigger = netwinder_leds[i].trigger;

	if (i == 0)
	led->mask = GPIO_GREEN_LED;
	else
	led->mask = GPIO_RED_LED;

	if (led_classdev_register(NULL, &led->cdev) < 0) {
	kfree(led);
	break;
	}
	}

	return 0;
	}

	/*
	* Since we may have triggers on any subsystem, defer registration
	* until after subsystem_init.
	*/
	fs_initcall(netwinder_leds_init);
	#endif

	MACHINE_START(NETWINDER, "Rebel-NetWinder")
	/* Maintainer: Russell King/Rebel.com */
	.atag_offset = 0x100,
	.video_start = 0x000a0000,
	.video_end = 0x000bffff,
	.reserve_lp0 = 1,
	.reserve_lp2 = 1,
	.fixup = fixup_netwinder,
	.map_io = footbridge_map_io,
	.init_irq = footbridge_init_irq,
	.init_time = isa_timer_init,
	.restart = netwinder_restart,
	MACHINE_END