Subversion Repositories or1k

/* $Id: setup_hs7729pci.c,v 1.1.1.1 2004-04-15 01:17:22 phoenix Exp $

 *

 * linux/arch/sh/kernel/setup_hs7729pci.c

 *

 * Copyright (C) 2000  Kazumoto Kojima

 *

 * Hitachi Semiconductor and Devices HS7729PCI Support.

 *

 */

#include <linux/config.h>

#include <linux/init.h>

#include <linux/irq.h>

#include <linux/hdreg.h>

#include <linux/ide.h>

#include <asm/io.h>

#include <asm/hitachi_hs7729pci.h>

#include <asm/smc37c93x.h>

static int interrupt_count;

static int sevenseg_count;

extern unsigned char aux_device_present;

/*

 * Configure the Super I/O chip

 */

static void __init smsc_config(int index, int data)

{

        outb_p(index, INDEX_PORT);

        outb_p(data, DATA_PORT);

}

static void __init init_smsc(void)

{

        outb_p(CONFIG_ENTER, CONFIG_PORT);

        outb_p(CONFIG_ENTER, CONFIG_PORT);

#if defined(CONFIG_BLK_DEV_FD)

        /* FDC */

        smsc_config(CURRENT_LDN_INDEX, LDN_FDC);

        smsc_config(ACTIVATE_INDEX, 0x01);

        smsc_config(IRQ_SELECT_INDEX, 6); /* IRQ6 */

#endif

#if defined(CONFIG_BLK_DEV_IDE)

        /* IDE1 */

        smsc_config(CURRENT_LDN_INDEX, LDN_IDE1);

        smsc_config(ACTIVATE_INDEX, 0x01);

        smsc_config(IRQ_SELECT_INDEX, 14); /* IRQ14 */

        smsc_config(IO_BASE_HI_INDEX, 0x01);

        smsc_config(IO_BASE_LO_INDEX, 0x70);

        smsc_config(0x62, 0x03);

        smsc_config(0x63, 0x76);

#if 0

#define SMSC_RD(adr) ({ outb(adr, 0x3f0), inb(0x3f1); })

        printk("IDE1 addrs 0x%02x%02x, 0x%02x%02x\n", SMSC_RD(0x60), SMSC_RD(0x61), SMSC_RD(0x62), SMSC_RD(0x63));

        printk("IDE1 Reg 0xF0: %02x. IDE1 Reg 0xF1: %02x\n", SMSC_RD(0xf0), SMSC_RD(0xf1));

        printk("Power reg: %02x\n", SMSC_RD(0x22));

        smsc_config(0x22, 0x3f);

        printk("Power reg changed to: %02x\n", SMSC_RD(0x22));

#endif         

#endif

        /* AUXIO (GPIO): to use IDE1 */

        smsc_config(CURRENT_LDN_INDEX, LDN_AUXIO);

        smsc_config(GPIO46_INDEX, 0x00); /* nIOROP */

        smsc_config(GPIO47_INDEX, 0x00); /* nIOWOP */

#if defined(CONFIG_SERIAL)

        /* COM1 */

        smsc_config(CURRENT_LDN_INDEX, LDN_COM1);

        smsc_config(ACTIVATE_INDEX, 0x01);

        smsc_config(IO_BASE_HI_INDEX, 0x03);

        smsc_config(IO_BASE_LO_INDEX, 0xf8);

        smsc_config(IRQ_SELECT_INDEX, 4); /* IRQ4 */

        /* COM2 */

        smsc_config(CURRENT_LDN_INDEX, LDN_COM2);

        smsc_config(ACTIVATE_INDEX, 0x01);

        smsc_config(IO_BASE_HI_INDEX, 0x02);

        smsc_config(IO_BASE_LO_INDEX, 0xf8);

        smsc_config(IRQ_SELECT_INDEX, 3); /* IRQ3 */

#endif

        /* RTC */

        smsc_config(CURRENT_LDN_INDEX, LDN_RTC);

        smsc_config(ACTIVATE_INDEX, 0x01);

        smsc_config(IRQ_SELECT_INDEX, 8); /* IRQ8 */

#if defined(CONFIG_VT)

        disable_irq(1);

        /* KBD */

        smsc_config(CURRENT_LDN_INDEX, LDN_KBC);

        smsc_config(ACTIVATE_INDEX, 0x01);

        smsc_config(IRQ_SELECT_INDEX, 1); /* IRQ1 */

        smsc_config(IRQ_SELECT_INDEX+2, 12); /* IRQ12 */

        /* Let it probe for PS/2 port. It should find one. */

        aux_device_present = 0;

#endif

#if defined(CONFIG_PARPORT)

        /* PARALLEL */

        smsc_config(CURRENT_LDN_INDEX, LDN_PARPORT);

        smsc_config(ACTIVATE_INDEX, 0x01);

        smsc_config(IO_BASE_HI_INDEX, 0x03);

        smsc_config(IO_BASE_LO_INDEX, 0x78);

        smsc_config(IRQ_SELECT_INDEX, 5); /* IRQ5 */

#endif

        outb_p(CONFIG_EXIT, CONFIG_PORT);

}

/*

 * Initialize IRQ setting

 */

void __init init_hs7729pci_IRQ(void)

{

        /*

         * Super I/O (Just mimic PC):

         *  0: SD0001

         *  1: keyboard

         *  3: serial 0

         *  4: serial 1

         *  5: printer

         *  6: floppy

         *  8: rtc

         * 12: mouse

         * 14: ide0

         */

        ctrl_outw(0x0130, BCR_ILCRA);

        ctrl_outw(0x0070, BCR_ILCRB);

        ctrl_outw(0x9abc, BCR_ILCRC);

        ctrl_outw(0xef84, BCR_ILCRD);

        ctrl_outw(0x0506, BCR_ILCRE);

        ctrl_outw(0x0002, BCR_ILCRF);

        ctrl_outw(0x000d, BCR_ILCRG);

        make_ipr_irq(15, BCR_ILCRA, 3, 0x00); /* IRQ15 */

        make_ipr_irq(14, BCR_ILCRA, 2, 0x01); /* IRQ14 */

        make_ipr_irq(12, BCR_ILCRA, 1, 0x03); /* IRQ12 */

        make_ipr_irq( 8, BCR_ILCRB, 1, 0x07); /* IRQ8 */

        make_ipr_irq( 6, BCR_ILCRC, 3, 0x09); /* IRQ6 */

        make_ipr_irq( 5, BCR_ILCRC, 2, 0x0a); /* IRQ5 */

        make_ipr_irq( 4, BCR_ILCRC, 1, 0x0b); /* IRQ4 */

        make_ipr_irq( 3, BCR_ILCRC, 0, 0x0c); /* IRQ3 */

        make_ipr_irq( 1, BCR_ILCRD, 3, 0x0e); /* IRQ1 */

        make_ipr_irq( 0, BCR_ILCRD, 2, 0x0f); /* PCI_IRQ0 */

        make_ipr_irq( 7, BCR_ILCRD, 1, 0x08); /* USB1_IRQ */

        make_ipr_irq(11, BCR_ILCRD, 0, 0x04); /* USB2_IRQ */

        make_ipr_irq(10, BCR_ILCRE, 2, 0x05); /* PC_IRQ2 */

        make_ipr_irq( 9, BCR_ILCRE, 0, 0x06); /* PC_IRQ1 */

        make_ipr_irq(13, BCR_ILCRF, 0, 0x02); /* SLOT_IRQ5 */

        make_ipr_irq( 2, BCR_ILCRG, 0, 0x0d); /* SLOT_IRQ1 */

}

/*

 * Initialize the board

 */

void __init setup_hs7729pci(void)

{

        init_smsc();

        /* XXX: RTC setting comes here */

        interrupt_count = 0;

        sevenseg_count = 0;

        ctrl_outw(0xffff, PA_LED);

        ctrl_outw(0x3f3f, PA_7SEG);

}

void debug_interrupt(void)

{

        ctrl_outw(interrupt_count, PA_LED);

        if (interrupt_count == 0xffff)

                interrupt_count = 0;

        else

                interrupt_count++;

}

static int sevenseg_data[] = {0x3f, 0x06, 0x5b, 0x4f, 0x66, 0x6d, 0x7d, 0x07,

                          0x7f, 0x6f, 0x77, 0x7c, 0x39, 0x5e, 0x79, 0x71};

void set_sevenseg(unsigned char val)

{

        unsigned short data;

        data = sevenseg_data[(val & 0xf0) >> 4] << 8;

        data |= sevenseg_data[val & 0x0f];

        ctrl_outw(data, PA_7SEG);

}

void debug_sevenseg(void)

{

        set_sevenseg(sevenseg_count);

        if (sevenseg_count == 0xff)

                sevenseg_count = 0;

        else

                sevenseg_count++;

}