Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/*

 * 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 <asm/hardware/dec21285.h>

#include <asm/io.h>

#include <asm/leds.h>

#include <asm/mach-types.h>

#include <asm/setup.h>

#include <asm/mach/arch.h>

#include "common.h"

#define IRDA_IO_BASE            0x180

#define GP1_IO_BASE             0x338

#define GP2_IO_BASE             0x33a

#ifdef CONFIG_LEDS

#define DEFAULT_LEDS    0

#else

#define DEFAULT_LEDS    GPIO_GREEN_LED

#endif

/*

 * 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_SPINLOCK(gpio_lock);

static unsigned int current_gpio_op;

static unsigned int current_gpio_io;

static unsigned int current_cpld;

void gpio_modify_op(int mask, 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);

}

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 gpio_modify_io(int mask, int in)

{

        /* Open up the SuperIO chip */

        wb977_open();

        __gpio_modify_io(mask, in);

        /* Close up the EFER gate */

        wb977_close();

}

int gpio_read(void)

{

        return inb(GP1_IO_BASE) | inb(GP2_IO_BASE) << 8;

}

/*

 * 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

         */

        spin_lock_irqsave(&gpio_lock, flags);

        gpio_modify_op(-1, GPIO_RED_LED | GPIO_FAN);

        spin_unlock_irqrestore(&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 cpld_modify(int mask, int set)

{

        int msk;

        current_cpld = (current_cpld & ~mask) | set;

        gpio_modify_io(GPIO_DATA | GPIO_IOCLK | GPIO_IOLOAD, 0);

        gpio_modify_op(GPIO_IOLOAD, 0);

        for (msk = 8; msk; msk >>= 1) {

                int bit = current_cpld & msk;

                gpio_modify_op(GPIO_DATA | GPIO_IOCLK, bit ? GPIO_DATA : 0);

                gpio_modify_op(GPIO_IOCLK, GPIO_IOCLK);

        }

        gpio_modify_op(GPIO_IOCLK|GPIO_DATA, 0);

        gpio_modify_op(GPIO_IOLOAD|GPIO_DSCLK, GPIO_IOLOAD|GPIO_DSCLK);

        gpio_modify_op(GPIO_IOLOAD, 0);

}

static void __init cpld_init(void)

{

        unsigned long flags;

        spin_lock_irqsave(&gpio_lock, flags);

        cpld_modify(-1, CPLD_UNMUTE | CPLD_7111_DISABLE);

        spin_unlock_irqrestore(&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();

}

EXPORT_SYMBOL(gpio_lock);

EXPORT_SYMBOL(gpio_modify_op);

EXPORT_SYMBOL(gpio_modify_io);

EXPORT_SYMBOL(cpld_modify);

EXPORT_SYMBOL(gpio_read);

/*

 * 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()) {

                unsigned long flags;

                wb977_init();

                cpld_init();

                rwa010_init();

                spin_lock_irqsave(&gpio_lock, flags);

                gpio_modify_op(GPIO_RED_LED|GPIO_GREEN_LED, DEFAULT_LEDS);

                spin_unlock_irqrestore(&gpio_lock, flags);

        }

        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 machine_desc *desc, 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

}

MACHINE_START(NETWINDER, "Rebel-NetWinder")

        /* Maintainer: Russell King/Rebel.com */

        .phys_io        = DC21285_ARMCSR_BASE,

        .io_pg_offst    = ((0xfe000000) >> 18) & 0xfffc,

        .boot_params    = 0x00000100,

        .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,

        .timer          = &isa_timer,

MACHINE_END