GUI: Fix Tomato RAF theme for all builds. Compilation typo.

[tomato.git] / release / src-rt-6.x.4708 / linux / linux-2.6.36 / drivers / net / tokenring / skisa.c

/*
 *  skisa.c: A network driver for SK-NET TMS380-based ISA token ring cards.
 *
 *  Based on tmspci written 1999 by Adam Fritzler
 *  
 *  Written 2000 by Jochen Friedrich
 *  Dedicated to my girlfriend Steffi Bopp
 *
 *  This software may be used and distributed according to the terms
 *  of the GNU General Public License, incorporated herein by reference.
 *
 *  This driver module supports the following cards:
 *      - SysKonnect TR4/16(+) ISA      (SK-4190)
 *
 *  Maintainer(s):
 *    AF        Adam Fritzler
 *    JF        Jochen Friedrich        jochen@scram.de
 *
 *  Modification History:
 *      14-Jan-01       JF      Created
 *      28-Oct-02       JF      Fixed probe of card for static compilation.
 *                              Fixed module init to not make hotplug go wild.
 *      09-Nov-02       JF      Fixed early bail out on out of memory
 *                              situations if multiple cards are found.
 *                              Cleaned up some unnecessary console SPAM.
 *      09-Dec-02       JF      Fixed module reference counting.
 *      02-Jan-03       JF      Renamed to skisa.c
 *
 */
static const char version[] = "skisa.c: v1.03 09/12/2002 by Jochen Friedrich\n";

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/pci.h>
#include <linux/init.h>
#include <linux/netdevice.h>
#include <linux/trdevice.h>
#include <linux/platform_device.h>

#include <asm/system.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/pci.h>
#include <asm/dma.h>

#include "tms380tr.h"

#define SK_ISA_IO_EXTENT 32

/* A zero-terminated list of I/O addresses to be probed. */
static unsigned int portlist[] __initdata = {
        0x0A20, 0x1A20, 0x0B20, 0x1B20, 0x0980, 0x1980, 0x0900, 0x1900,// SK
        0
};

/* A zero-terminated list of IRQs to be probed. 
 * Used again after initial probe for sktr_chipset_init, called from sktr_open.
 */
static const unsigned short irqlist[] = {
        3, 5, 9, 10, 11, 12, 15,
        0
};

/* A zero-terminated list of DMAs to be probed. */
static int dmalist[] __initdata = {
        5, 6, 7,
        0
};

static char isa_cardname[] = "SK NET TR 4/16 ISA\0";
static u64 dma_mask = ISA_MAX_ADDRESS;
static int sk_isa_open(struct net_device *dev);
static void sk_isa_read_eeprom(struct net_device *dev);
static unsigned short sk_isa_setnselout_pins(struct net_device *dev);

static unsigned short sk_isa_sifreadb(struct net_device *dev, unsigned short reg)
{
        return inb(dev->base_addr + reg);
}

static unsigned short sk_isa_sifreadw(struct net_device *dev, unsigned short reg)
{
        return inw(dev->base_addr + reg);
}

static void sk_isa_sifwriteb(struct net_device *dev, unsigned short val, unsigned short reg)
{
        outb(val, dev->base_addr + reg);
}

static void sk_isa_sifwritew(struct net_device *dev, unsigned short val, unsigned short reg)
{
        outw(val, dev->base_addr + reg);
}


static int __init sk_isa_probe1(struct net_device *dev, int ioaddr)
{
        unsigned char old, chk1, chk2;

        if (!request_region(ioaddr, SK_ISA_IO_EXTENT, isa_cardname))
                return -ENODEV;

        old = inb(ioaddr + SIFADR);     /* Get the old SIFADR value */

        chk1 = 0;       /* Begin with check value 0 */
        do {
                /* Write new SIFADR value */
                outb(chk1, ioaddr + SIFADR);

                /* Read, invert and write */
                chk2 = inb(ioaddr + SIFADD);
                chk2 ^= 0x0FE;
                outb(chk2, ioaddr + SIFADR);

                /* Read, invert and compare */
                chk2 = inb(ioaddr + SIFADD);
                chk2 ^= 0x0FE;

                if(chk1 != chk2) {
                        release_region(ioaddr, SK_ISA_IO_EXTENT);
                        return -ENODEV;
                }

                chk1 -= 2;
        } while(chk1 != 0);     /* Repeat 128 times (all byte values) */

        /* Restore the SIFADR value */
        outb(old, ioaddr + SIFADR);

        dev->base_addr = ioaddr;
        return 0;
}

static struct net_device_ops sk_isa_netdev_ops __read_mostly;

static int __init setup_card(struct net_device *dev, struct device *pdev)
{
        struct net_local *tp;
        static int versionprinted;
        const unsigned *port;
        int j, err = 0;

        if (!dev)
                return -ENOMEM;

        if (dev->base_addr)     /* probe specific location */
                err = sk_isa_probe1(dev, dev->base_addr);
        else {
                for (port = portlist; *port; port++) {
                        err = sk_isa_probe1(dev, *port);
                        if (!err)
                                break;
                }
        }
        if (err)
                goto out5;

        /* At this point we have found a valid card. */

        if (versionprinted++ == 0)
                printk(KERN_DEBUG "%s", version);

        err = -EIO;
        pdev->dma_mask = &dma_mask;
        if (tmsdev_init(dev, pdev))
                goto out4;

        dev->base_addr &= ~3; 
                
        sk_isa_read_eeprom(dev);

        printk(KERN_DEBUG "skisa.c:    Ring Station Address: %pM\n",
               dev->dev_addr);
                
        tp = netdev_priv(dev);
        tp->setnselout = sk_isa_setnselout_pins;
                
        tp->sifreadb = sk_isa_sifreadb;
        tp->sifreadw = sk_isa_sifreadw;
        tp->sifwriteb = sk_isa_sifwriteb;
        tp->sifwritew = sk_isa_sifwritew;
        
        memcpy(tp->ProductID, isa_cardname, PROD_ID_SIZE + 1);

        tp->tmspriv = NULL;

        dev->netdev_ops = &sk_isa_netdev_ops;

        if (dev->irq == 0)
        {
                for(j = 0; irqlist[j] != 0; j++)
                {
                        dev->irq = irqlist[j];
                        if (!request_irq(dev->irq, tms380tr_interrupt, 0, 
                                isa_cardname, dev))
                                break;
                }
                
                if(irqlist[j] == 0)
                {
                        printk(KERN_INFO "skisa.c: AutoSelect no IRQ available\n");
                        goto out3;
                }
        }
        else
        {
                for(j = 0; irqlist[j] != 0; j++)
                        if (irqlist[j] == dev->irq)
                                break;
                if (irqlist[j] == 0)
                {
                        printk(KERN_INFO "skisa.c: Illegal IRQ %d specified\n",
                                dev->irq);
                        goto out3;
                }
                if (request_irq(dev->irq, tms380tr_interrupt, 0, 
                        isa_cardname, dev))
                {
                        printk(KERN_INFO "skisa.c: Selected IRQ %d not available\n",
                                dev->irq);
                        goto out3;
                }
        }

        if (dev->dma == 0)
        {
                for(j = 0; dmalist[j] != 0; j++)
                {
                        dev->dma = dmalist[j];
                        if (!request_dma(dev->dma, isa_cardname))
                                break;
                }

                if(dmalist[j] == 0)
                {
                        printk(KERN_INFO "skisa.c: AutoSelect no DMA available\n");
                        goto out2;
                }
        }
        else
        {
                for(j = 0; dmalist[j] != 0; j++)
                        if (dmalist[j] == dev->dma)
                                break;
                if (dmalist[j] == 0)
                {
                        printk(KERN_INFO "skisa.c: Illegal DMA %d specified\n",
                                dev->dma);
                        goto out2;
                }
                if (request_dma(dev->dma, isa_cardname))
                {
                        printk(KERN_INFO "skisa.c: Selected DMA %d not available\n",
                                dev->dma);
                        goto out2;
                }
        }

        err = register_netdev(dev);
        if (err)
                goto out;

        printk(KERN_DEBUG "%s:    IO: %#4lx  IRQ: %d  DMA: %d\n",
               dev->name, dev->base_addr, dev->irq, dev->dma);

        return 0;
out:
        free_dma(dev->dma);
out2:
        free_irq(dev->irq, dev);
out3:
        tmsdev_term(dev);
out4:
        release_region(dev->base_addr, SK_ISA_IO_EXTENT);
out5:
        return err;
}

/*
 * Reads MAC address from adapter RAM, which should've read it from
 * the onboard ROM.  
 *
 * Calling this on a board that does not support it can be a very
 * dangerous thing.  The Madge board, for instance, will lock your
 * machine hard when this is called.  Luckily, its supported in a
 * separate driver.  --ASF
 */
static void sk_isa_read_eeprom(struct net_device *dev)
{
        int i;
        
        /* Address: 0000:0000 */
        sk_isa_sifwritew(dev, 0, SIFADX);
        sk_isa_sifwritew(dev, 0, SIFADR);       
        
        /* Read six byte MAC address data */
        dev->addr_len = 6;
        for(i = 0; i < 6; i++)
                dev->dev_addr[i] = sk_isa_sifreadw(dev, SIFINC) >> 8;
}

static unsigned short sk_isa_setnselout_pins(struct net_device *dev)
{
        return 0;
}

static int sk_isa_open(struct net_device *dev)
{  
        struct net_local *tp = netdev_priv(dev);
        unsigned short val = 0;
        unsigned short oldval;
        int i;

        val = 0;
        for(i = 0; irqlist[i] != 0; i++)
        {
                if(irqlist[i] == dev->irq)
                        break;
        }

        val |= CYCLE_TIME << 2;
        val |= i << 4;
        i = dev->dma - 5;
        val |= i;
        if(tp->DataRate == SPEED_4)
                val |= LINE_SPEED_BIT;
        else
                val &= ~LINE_SPEED_BIT;
        oldval = sk_isa_sifreadb(dev, POSREG);
        /* Leave cycle bits alone */
        oldval |= 0xf3;
        val &= oldval;
        sk_isa_sifwriteb(dev, val, POSREG);

        return tms380tr_open(dev);
}

#define ISATR_MAX_ADAPTERS 3

static int io[ISATR_MAX_ADAPTERS];
static int irq[ISATR_MAX_ADAPTERS];
static int dma[ISATR_MAX_ADAPTERS];

MODULE_LICENSE("GPL");

module_param_array(io, int, NULL, 0);
module_param_array(irq, int, NULL, 0);
module_param_array(dma, int, NULL, 0);

static struct platform_device *sk_isa_dev[ISATR_MAX_ADAPTERS];

static struct platform_driver sk_isa_driver = {
        .driver         = {
                .name   = "skisa",
        },
};

static int __init sk_isa_init(void)
{
        struct net_device *dev;
        struct platform_device *pdev;
        int i, num = 0, err = 0;

        sk_isa_netdev_ops = tms380tr_netdev_ops;
        sk_isa_netdev_ops.ndo_open = sk_isa_open;
        sk_isa_netdev_ops.ndo_stop = tms380tr_close;

        err = platform_driver_register(&sk_isa_driver);
        if (err)
                return err;

        for (i = 0; i < ISATR_MAX_ADAPTERS ; i++) {
                dev = alloc_trdev(sizeof(struct net_local));
                if (!dev)
                        continue;

                dev->base_addr = io[i];
                dev->irq = irq[i];
                dev->dma = dma[i];
                pdev = platform_device_register_simple("skisa",
                        i, NULL, 0);
                if (IS_ERR(pdev)) {
                        free_netdev(dev);
                        continue;
                }
                err = setup_card(dev, &pdev->dev);
                if (!err) {
                        sk_isa_dev[i] = pdev;
                        platform_set_drvdata(sk_isa_dev[i], dev);
                        ++num;
                } else {
                        platform_device_unregister(pdev);
                        free_netdev(dev);
                }
        }

        printk(KERN_NOTICE "skisa.c: %d cards found.\n", num);
        /* Probe for cards. */
        if (num == 0) {
                printk(KERN_NOTICE "skisa.c: No cards found.\n");
                platform_driver_unregister(&sk_isa_driver);
                return -ENODEV;
        }
        return 0;
}

static void __exit sk_isa_cleanup(void)
{
        struct net_device *dev;
        int i;

        for (i = 0; i < ISATR_MAX_ADAPTERS ; i++) {
                struct platform_device *pdev = sk_isa_dev[i];

                if (!pdev)
                        continue;
                dev = platform_get_drvdata(pdev);
                unregister_netdev(dev);
                release_region(dev->base_addr, SK_ISA_IO_EXTENT);
                free_irq(dev->irq, dev);
                free_dma(dev->dma);
                tmsdev_term(dev);
                free_netdev(dev);
                platform_set_drvdata(pdev, NULL);
                platform_device_unregister(pdev);
        }
        platform_driver_unregister(&sk_isa_driver);
}

module_init(sk_isa_init);
module_exit(sk_isa_cleanup);