mirror of
https://github.com/torvalds/linux.git
synced 2024-11-23 12:42:02 +00:00
dd00cc486a
Transform some calls to kmalloc/memset to a single kzalloc (or kcalloc). Here is a short excerpt of the semantic patch performing this transformation: @@ type T2; expression x; identifier f,fld; expression E; expression E1,E2; expression e1,e2,e3,y; statement S; @@ x = - kmalloc + kzalloc (E1,E2) ... when != \(x->fld=E;\|y=f(...,x,...);\|f(...,x,...);\|x=E;\|while(...) S\|for(e1;e2;e3) S\) - memset((T2)x,0,E1); @@ expression E1,E2,E3; @@ - kzalloc(E1 * E2,E3) + kcalloc(E1,E2,E3) [akpm@linux-foundation.org: get kcalloc args the right way around] Signed-off-by: Yoann Padioleau <padator@wanadoo.fr> Cc: Richard Henderson <rth@twiddle.net> Cc: Ivan Kokshaysky <ink@jurassic.park.msu.ru> Acked-by: Russell King <rmk@arm.linux.org.uk> Cc: Bryan Wu <bryan.wu@analog.com> Acked-by: Jiri Slaby <jirislaby@gmail.com> Cc: Dave Airlie <airlied@linux.ie> Acked-by: Roland Dreier <rolandd@cisco.com> Cc: Jiri Kosina <jkosina@suse.cz> Acked-by: Dmitry Torokhov <dtor@mail.ru> Cc: Benjamin Herrenschmidt <benh@kernel.crashing.org> Acked-by: Mauro Carvalho Chehab <mchehab@infradead.org> Acked-by: Pierre Ossman <drzeus-list@drzeus.cx> Cc: Jeff Garzik <jeff@garzik.org> Cc: "David S. Miller" <davem@davemloft.net> Acked-by: Greg KH <greg@kroah.com> Cc: James Bottomley <James.Bottomley@steeleye.com> Cc: "Antonino A. Daplas" <adaplas@pol.net> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
493 lines
13 KiB
C
493 lines
13 KiB
C
/*
|
|
* 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);
|
|
SET_MODULE_OWNER(dev);
|
|
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);
|