Subversion Repositories test_project

/*

 * Goramo PCI200SYN synchronous serial card driver for Linux

 *

 * Copyright (C) 2002-2003 Krzysztof Halasa <khc@pm.waw.pl>

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of version 2 of the GNU General Public License

 * as published by the Free Software Foundation.

 *

 * For information see <http://www.kernel.org/pub/linux/utils/net/hdlc/>

 *

 * Sources of information:

 *    Hitachi HD64572 SCA-II User's Manual

 *    PLX Technology Inc. PCI9052 Data Book

 */

#include <linux/module.h>

#include <linux/kernel.h>

#include <linux/slab.h>

#include <linux/types.h>

#include <linux/fcntl.h>

#include <linux/in.h>

#include <linux/string.h>

#include <linux/errno.h>

#include <linux/init.h>

#include <linux/ioport.h>

#include <linux/moduleparam.h>

#include <linux/netdevice.h>

#include <linux/hdlc.h>

#include <linux/pci.h>

#include <linux/delay.h>

#include <asm/io.h>

#include "hd64572.h"

static const char* version = "Goramo PCI200SYN driver version: 1.16";

static const char* devname = "PCI200SYN";

#undef DEBUG_PKT

#define DEBUG_RINGS

#define PCI200SYN_PLX_SIZE      0x80    /* PLX control window size (128b) */

#define PCI200SYN_SCA_SIZE      0x400   /* SCA window size (1Kb) */

#define ALL_PAGES_ALWAYS_MAPPED

#define NEED_DETECT_RAM

#define NEED_SCA_MSCI_INTR

#define MAX_TX_BUFFERS          10

static int pci_clock_freq = 33000000;

#define CLOCK_BASE pci_clock_freq

/*

 *      PLX PCI9052 local configuration and shared runtime registers.

 *      This structure can be used to access 9052 registers (memory mapped).

 */

typedef struct {

        u32 loc_addr_range[4];  /* 00-0Ch : Local Address Ranges */

        u32 loc_rom_range;      /* 10h : Local ROM Range */

        u32 loc_addr_base[4];   /* 14-20h : Local Address Base Addrs */

        u32 loc_rom_base;       /* 24h : Local ROM Base */

        u32 loc_bus_descr[4];   /* 28-34h : Local Bus Descriptors */

        u32 rom_bus_descr;      /* 38h : ROM Bus Descriptor */

        u32 cs_base[4];         /* 3C-48h : Chip Select Base Addrs */

        u32 intr_ctrl_stat;     /* 4Ch : Interrupt Control/Status */

        u32 init_ctrl;          /* 50h : EEPROM ctrl, Init Ctrl, etc */

}plx9052;

typedef struct port_s {

        struct net_device *dev;

        struct card_s *card;

        spinlock_t lock;        /* TX lock */

        sync_serial_settings settings;

        int rxpart;             /* partial frame received, next frame invalid*/

        unsigned short encoding;

        unsigned short parity;

        u16 rxin;               /* rx ring buffer 'in' pointer */

        u16 txin;               /* tx ring buffer 'in' and 'last' pointers */

        u16 txlast;

        u8 rxs, txs, tmc;       /* SCA registers */

        u8 phy_node;            /* physical port # - 0 or 1 */

}port_t;

typedef struct card_s {

        u8 __iomem *rambase;    /* buffer memory base (virtual) */

        u8 __iomem *scabase;    /* SCA memory base (virtual) */

        plx9052 __iomem *plxbase;/* PLX registers memory base (virtual) */

        u16 rx_ring_buffers;    /* number of buffers in a ring */

        u16 tx_ring_buffers;

        u16 buff_offset;        /* offset of first buffer of first channel */

        u8 irq;                 /* interrupt request level */

        port_t ports[2];

}card_t;

#define sca_in(reg, card)            readb(card->scabase + (reg))

#define sca_out(value, reg, card)    writeb(value, card->scabase + (reg))

#define sca_inw(reg, card)           readw(card->scabase + (reg))

#define sca_outw(value, reg, card)   writew(value, card->scabase + (reg))

#define sca_inl(reg, card)           readl(card->scabase + (reg))

#define sca_outl(value, reg, card)   writel(value, card->scabase + (reg))

#define port_to_card(port)           (port->card)

#define log_node(port)               (port->phy_node)

#define phy_node(port)               (port->phy_node)

#define winbase(card)                (card->rambase)

#define get_port(card, port)         (&card->ports[port])

#define sca_flush(card)              (sca_in(IER0, card));

static inline void new_memcpy_toio(char __iomem *dest, char *src, int length)

{

        int len;

        do {

                len = length > 256 ? 256 : length;

                memcpy_toio(dest, src, len);

                dest += len;

                src += len;

                length -= len;

                readb(dest);

        } while (len);

}

#undef memcpy_toio

#define memcpy_toio new_memcpy_toio

#include "hd6457x.c"

static void pci200_set_iface(port_t *port)

{

        card_t *card = port->card;

        u16 msci = get_msci(port);

        u8 rxs = port->rxs & CLK_BRG_MASK;

        u8 txs = port->txs & CLK_BRG_MASK;

        sca_out(EXS_TES1, (phy_node(port) ? MSCI1_OFFSET : MSCI0_OFFSET) + EXS,

                port_to_card(port));

        switch(port->settings.clock_type) {

        case CLOCK_INT:

                rxs |= CLK_BRG; /* BRG output */

                txs |= CLK_PIN_OUT | CLK_TX_RXCLK; /* RX clock */

                break;

        case CLOCK_TXINT:

                rxs |= CLK_LINE; /* RXC input */

                txs |= CLK_PIN_OUT | CLK_BRG; /* BRG output */

                break;

        case CLOCK_TXFROMRX:

                rxs |= CLK_LINE; /* RXC input */

                txs |= CLK_PIN_OUT | CLK_TX_RXCLK; /* RX clock */

                break;

        default:                /* EXTernal clock */

                rxs |= CLK_LINE; /* RXC input */

                txs |= CLK_PIN_OUT | CLK_LINE; /* TXC input */

                break;

        }

        port->rxs = rxs;

        port->txs = txs;

        sca_out(rxs, msci + RXS, card);

        sca_out(txs, msci + TXS, card);

        sca_set_port(port);

}

static int pci200_open(struct net_device *dev)

{

        port_t *port = dev_to_port(dev);

        int result = hdlc_open(dev);

        if (result)

                return result;

        sca_open(dev);

        pci200_set_iface(port);

        sca_flush(port_to_card(port));

        return 0;

}

static int pci200_close(struct net_device *dev)

{

        sca_close(dev);

        sca_flush(port_to_card(dev_to_port(dev)));

        hdlc_close(dev);

        return 0;

}

static int pci200_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)

{

        const size_t size = sizeof(sync_serial_settings);

        sync_serial_settings new_line;

        sync_serial_settings __user *line = ifr->ifr_settings.ifs_ifsu.sync;

        port_t *port = dev_to_port(dev);

#ifdef DEBUG_RINGS

        if (cmd == SIOCDEVPRIVATE) {

                sca_dump_rings(dev);

                return 0;

        }

#endif

        if (cmd != SIOCWANDEV)

                return hdlc_ioctl(dev, ifr, cmd);

        switch(ifr->ifr_settings.type) {

        case IF_GET_IFACE:

                ifr->ifr_settings.type = IF_IFACE_V35;

                if (ifr->ifr_settings.size < size) {

                        ifr->ifr_settings.size = size; /* data size wanted */

                        return -ENOBUFS;

                }

                if (copy_to_user(line, &port->settings, size))

                        return -EFAULT;

                return 0;

        case IF_IFACE_V35:

        case IF_IFACE_SYNC_SERIAL:

                if (!capable(CAP_NET_ADMIN))

                        return -EPERM;

                if (copy_from_user(&new_line, line, size))

                        return -EFAULT;

                if (new_line.clock_type != CLOCK_EXT &&

                    new_line.clock_type != CLOCK_TXFROMRX &&

                    new_line.clock_type != CLOCK_INT &&

                    new_line.clock_type != CLOCK_TXINT)

                return -EINVAL; /* No such clock setting */

                if (new_line.loopback != 0 && new_line.loopback != 1)

                        return -EINVAL;

                memcpy(&port->settings, &new_line, size); /* Update settings */

                pci200_set_iface(port);

                sca_flush(port_to_card(port));

                return 0;

        default:

                return hdlc_ioctl(dev, ifr, cmd);

        }

}

static void pci200_pci_remove_one(struct pci_dev *pdev)

{

        int i;

        card_t *card = pci_get_drvdata(pdev);

        for (i = 0; i < 2; i++)

                if (card->ports[i].card) {

                        struct net_device *dev = port_to_dev(&card->ports[i]);

                        unregister_hdlc_device(dev);

                }

        if (card->irq)

                free_irq(card->irq, card);

        if (card->rambase)

                iounmap(card->rambase);

        if (card->scabase)

                iounmap(card->scabase);

        if (card->plxbase)

                iounmap(card->plxbase);

        pci_release_regions(pdev);

        pci_disable_device(pdev);

        pci_set_drvdata(pdev, NULL);

        if (card->ports[0].dev)

                free_netdev(card->ports[0].dev);

        if (card->ports[1].dev)

                free_netdev(card->ports[1].dev);

        kfree(card);

}

static int __devinit pci200_pci_init_one(struct pci_dev *pdev,

                                         const struct pci_device_id *ent)

{

        card_t *card;

        u32 __iomem *p;

        int i;

        u32 ramsize;

        u32 ramphys;            /* buffer memory base */

        u32 scaphys;            /* SCA memory base */

        u32 plxphys;            /* PLX registers memory base */

#ifndef MODULE

        static int printed_version;

        if (!printed_version++)

                printk(KERN_INFO "%s\n", version);

#endif

        i = pci_enable_device(pdev);

        if (i)

                return i;

        i = pci_request_regions(pdev, "PCI200SYN");

        if (i) {

                pci_disable_device(pdev);

                return i;

        }

        card = kzalloc(sizeof(card_t), GFP_KERNEL);

        if (card == NULL) {

                printk(KERN_ERR "pci200syn: unable to allocate memory\n");

                pci_release_regions(pdev);

                pci_disable_device(pdev);

                return -ENOBUFS;

        }

        pci_set_drvdata(pdev, card);

        card->ports[0].dev = alloc_hdlcdev(&card->ports[0]);

        card->ports[1].dev = alloc_hdlcdev(&card->ports[1]);

        if (!card->ports[0].dev || !card->ports[1].dev) {

                printk(KERN_ERR "pci200syn: unable to allocate memory\n");

                pci200_pci_remove_one(pdev);

                return -ENOMEM;

        }

        if (pci_resource_len(pdev, 0) != PCI200SYN_PLX_SIZE ||

            pci_resource_len(pdev, 2) != PCI200SYN_SCA_SIZE ||

            pci_resource_len(pdev, 3) < 16384) {

                printk(KERN_ERR "pci200syn: invalid card EEPROM parameters\n");

                pci200_pci_remove_one(pdev);

                return -EFAULT;

        }

        plxphys = pci_resource_start(pdev,0) & PCI_BASE_ADDRESS_MEM_MASK;

        card->plxbase = ioremap(plxphys, PCI200SYN_PLX_SIZE);

        scaphys = pci_resource_start(pdev,2) & PCI_BASE_ADDRESS_MEM_MASK;

        card->scabase = ioremap(scaphys, PCI200SYN_SCA_SIZE);

        ramphys = pci_resource_start(pdev,3) & PCI_BASE_ADDRESS_MEM_MASK;

        card->rambase = ioremap(ramphys, pci_resource_len(pdev,3));

        if (card->plxbase == NULL ||

            card->scabase == NULL ||

            card->rambase == NULL) {

                printk(KERN_ERR "pci200syn: ioremap() failed\n");

                pci200_pci_remove_one(pdev);

                return -EFAULT;

        }

        /* Reset PLX */

        p = &card->plxbase->init_ctrl;

        writel(readl(p) | 0x40000000, p);

        readl(p);               /* Flush the write - do not use sca_flush */

        udelay(1);

        writel(readl(p) & ~0x40000000, p);

        readl(p);               /* Flush the write - do not use sca_flush */

        udelay(1);

        ramsize = sca_detect_ram(card, card->rambase,

                                 pci_resource_len(pdev, 3));

        /* number of TX + RX buffers for one port - this is dual port card */

        i = ramsize / (2 * (sizeof(pkt_desc) + HDLC_MAX_MRU));

        card->tx_ring_buffers = min(i / 2, MAX_TX_BUFFERS);

        card->rx_ring_buffers = i - card->tx_ring_buffers;

        card->buff_offset = 2 * sizeof(pkt_desc) * (card->tx_ring_buffers +

                                                    card->rx_ring_buffers);

        printk(KERN_INFO "pci200syn: %u KB RAM at 0x%x, IRQ%u, using %u TX +"

               " %u RX packets rings\n", ramsize / 1024, ramphys,

               pdev->irq, card->tx_ring_buffers, card->rx_ring_buffers);

        if (pdev->subsystem_device == PCI_DEVICE_ID_PLX_9050) {

                printk(KERN_ERR "Detected PCI200SYN card with old "

                       "configuration data.\n");

                printk(KERN_ERR "See <http://www.kernel.org/pub/"

                       "linux/utils/net/hdlc/pci200syn/> for update.\n");

                printk(KERN_ERR "The card will stop working with"

                       " future versions of Linux if not updated.\n");

        }

        if (card->tx_ring_buffers < 1) {

                printk(KERN_ERR "pci200syn: RAM test failed\n");

                pci200_pci_remove_one(pdev);

                return -EFAULT;

        }

        /* Enable interrupts on the PCI bridge */

        p = &card->plxbase->intr_ctrl_stat;

        writew(readw(p) | 0x0040, p);

        /* Allocate IRQ */

        if (request_irq(pdev->irq, sca_intr, IRQF_SHARED, devname, card)) {

                printk(KERN_WARNING "pci200syn: could not allocate IRQ%d.\n",

                       pdev->irq);

                pci200_pci_remove_one(pdev);

                return -EBUSY;

        }

        card->irq = pdev->irq;

        sca_init(card, 0);

        for (i = 0; i < 2; i++) {

                port_t *port = &card->ports[i];

                struct net_device *dev = port_to_dev(port);

                hdlc_device *hdlc = dev_to_hdlc(dev);

                port->phy_node = i;

                spin_lock_init(&port->lock);

                dev->irq = card->irq;

                dev->mem_start = ramphys;

                dev->mem_end = ramphys + ramsize - 1;

                dev->tx_queue_len = 50;

                dev->do_ioctl = pci200_ioctl;

                dev->open = pci200_open;

                dev->stop = pci200_close;

                hdlc->attach = sca_attach;

                hdlc->xmit = sca_xmit;

                port->settings.clock_type = CLOCK_EXT;

                port->card = card;

                if (register_hdlc_device(dev)) {

                        printk(KERN_ERR "pci200syn: unable to register hdlc "

                               "device\n");

                        port->card = NULL;

                        pci200_pci_remove_one(pdev);

                        return -ENOBUFS;

                }

                sca_init_sync_port(port);       /* Set up SCA memory */

                printk(KERN_INFO "%s: PCI200SYN node %d\n",

                       dev->name, port->phy_node);

        }

        sca_flush(card);

        return 0;

}

static struct pci_device_id pci200_pci_tbl[] __devinitdata = {

        { PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9050, PCI_VENDOR_ID_PLX,

          PCI_DEVICE_ID_PLX_9050, 0, 0, 0 },

        { PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9050, PCI_VENDOR_ID_PLX,

          PCI_DEVICE_ID_PLX_PCI200SYN, 0, 0, 0 },

        { 0, }

};

static struct pci_driver pci200_pci_driver = {

        .name           = "PCI200SYN",

        .id_table       = pci200_pci_tbl,

        .probe          = pci200_pci_init_one,

        .remove         = pci200_pci_remove_one,

};

static int __init pci200_init_module(void)

{

#ifdef MODULE

        printk(KERN_INFO "%s\n", version);

#endif

        if (pci_clock_freq < 1000000 || pci_clock_freq > 80000000) {

                printk(KERN_ERR "pci200syn: Invalid PCI clock frequency\n");

                return -EINVAL;

        }

        return pci_register_driver(&pci200_pci_driver);

}

static void __exit pci200_cleanup_module(void)

{

        pci_unregister_driver(&pci200_pci_driver);

}

MODULE_AUTHOR("Krzysztof Halasa <khc@pm.waw.pl>");

MODULE_DESCRIPTION("Goramo PCI200SYN serial port driver");

MODULE_LICENSE("GPL v2");

MODULE_DEVICE_TABLE(pci, pci200_pci_tbl);

module_param(pci_clock_freq, int, 0444);

MODULE_PARM_DESC(pci_clock_freq, "System PCI clock frequency in Hz");

module_init(pci200_init_module);

module_exit(pci200_cleanup_module);