mirror of
https://github.com/torvalds/linux.git
synced 2024-12-30 06:41:43 +00:00
e404decb0f
alloc failures use dump_stack so emitting an additional out-of-memory message is an unnecessary duplication. Remove the allocation failure messages. Signed-off-by: Joe Perches <joe@perches.com> Signed-off-by: David S. Miller <davem@davemloft.net>
567 lines
13 KiB
C
567 lines
13 KiB
C
/*
|
|
* SDL Inc. RISCom/N2 synchronous serial card driver for Linux
|
|
*
|
|
* Copyright (C) 1998-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/>
|
|
*
|
|
* Note: integrated CSU/DSU/DDS are not supported by this driver
|
|
*
|
|
* Sources of information:
|
|
* Hitachi HD64570 SCA User's Manual
|
|
* SDL Inc. PPP/HDLC/CISCO driver
|
|
*/
|
|
|
|
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/capability.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 <asm/io.h>
|
|
#include "hd64570.h"
|
|
|
|
|
|
static const char* version = "SDL RISCom/N2 driver version: 1.15";
|
|
static const char* devname = "RISCom/N2";
|
|
|
|
#undef DEBUG_PKT
|
|
#define DEBUG_RINGS
|
|
|
|
#define USE_WINDOWSIZE 16384
|
|
#define USE_BUS16BITS 1
|
|
#define CLOCK_BASE 9830400 /* 9.8304 MHz */
|
|
#define MAX_PAGES 16 /* 16 RAM pages at max */
|
|
#define MAX_RAM_SIZE 0x80000 /* 512 KB */
|
|
#if MAX_RAM_SIZE > MAX_PAGES * USE_WINDOWSIZE
|
|
#undef MAX_RAM_SIZE
|
|
#define MAX_RAM_SIZE (MAX_PAGES * USE_WINDOWSIZE)
|
|
#endif
|
|
#define N2_IOPORTS 0x10
|
|
#define NEED_DETECT_RAM
|
|
#define NEED_SCA_MSCI_INTR
|
|
#define MAX_TX_BUFFERS 10
|
|
|
|
static char *hw; /* pointer to hw=xxx command line string */
|
|
|
|
/* RISCom/N2 Board Registers */
|
|
|
|
/* PC Control Register */
|
|
#define N2_PCR 0
|
|
#define PCR_RUNSCA 1 /* Run 64570 */
|
|
#define PCR_VPM 2 /* Enable VPM - needed if using RAM above 1 MB */
|
|
#define PCR_ENWIN 4 /* Open window */
|
|
#define PCR_BUS16 8 /* 16-bit bus */
|
|
|
|
|
|
/* Memory Base Address Register */
|
|
#define N2_BAR 2
|
|
|
|
|
|
/* Page Scan Register */
|
|
#define N2_PSR 4
|
|
#define WIN16K 0x00
|
|
#define WIN32K 0x20
|
|
#define WIN64K 0x40
|
|
#define PSR_WINBITS 0x60
|
|
#define PSR_DMAEN 0x80
|
|
#define PSR_PAGEBITS 0x0F
|
|
|
|
|
|
/* Modem Control Reg */
|
|
#define N2_MCR 6
|
|
#define CLOCK_OUT_PORT1 0x80
|
|
#define CLOCK_OUT_PORT0 0x40
|
|
#define TX422_PORT1 0x20
|
|
#define TX422_PORT0 0x10
|
|
#define DSR_PORT1 0x08
|
|
#define DSR_PORT0 0x04
|
|
#define DTR_PORT1 0x02
|
|
#define DTR_PORT0 0x01
|
|
|
|
|
|
typedef struct port_s {
|
|
struct net_device *dev;
|
|
struct card_s *card;
|
|
spinlock_t lock; /* TX lock */
|
|
sync_serial_settings settings;
|
|
int valid; /* port enabled */
|
|
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 */
|
|
u8 log_node; /* logical port # */
|
|
}port_t;
|
|
|
|
|
|
|
|
typedef struct card_s {
|
|
u8 __iomem *winbase; /* ISA window base address */
|
|
u32 phy_winbase; /* ISA physical base address */
|
|
u32 ram_size; /* number of bytes */
|
|
u16 io; /* IO Base address */
|
|
u16 buff_offset; /* offset of first buffer of first channel */
|
|
u16 rx_ring_buffers; /* number of buffers in a ring */
|
|
u16 tx_ring_buffers;
|
|
u8 irq; /* IRQ (3-15) */
|
|
|
|
port_t ports[2];
|
|
struct card_s *next_card;
|
|
}card_t;
|
|
|
|
|
|
static card_t *first_card;
|
|
static card_t **new_card = &first_card;
|
|
|
|
|
|
#define sca_reg(reg, card) (0x8000 | (card)->io | \
|
|
((reg) & 0x0F) | (((reg) & 0xF0) << 6))
|
|
#define sca_in(reg, card) inb(sca_reg(reg, card))
|
|
#define sca_out(value, reg, card) outb(value, sca_reg(reg, card))
|
|
#define sca_inw(reg, card) inw(sca_reg(reg, card))
|
|
#define sca_outw(value, reg, card) outw(value, sca_reg(reg, card))
|
|
|
|
#define port_to_card(port) ((port)->card)
|
|
#define log_node(port) ((port)->log_node)
|
|
#define phy_node(port) ((port)->phy_node)
|
|
#define winsize(card) (USE_WINDOWSIZE)
|
|
#define winbase(card) ((card)->winbase)
|
|
#define get_port(card, port) ((card)->ports[port].valid ? \
|
|
&(card)->ports[port] : NULL)
|
|
|
|
|
|
static __inline__ u8 sca_get_page(card_t *card)
|
|
{
|
|
return inb(card->io + N2_PSR) & PSR_PAGEBITS;
|
|
}
|
|
|
|
|
|
static __inline__ void openwin(card_t *card, u8 page)
|
|
{
|
|
u8 psr = inb(card->io + N2_PSR);
|
|
outb((psr & ~PSR_PAGEBITS) | page, card->io + N2_PSR);
|
|
}
|
|
|
|
|
|
#include "hd64570.c"
|
|
|
|
|
|
static void n2_set_iface(port_t *port)
|
|
{
|
|
card_t *card = port->card;
|
|
int io = card->io;
|
|
u8 mcr = inb(io + N2_MCR);
|
|
u8 msci = get_msci(port);
|
|
u8 rxs = port->rxs & CLK_BRG_MASK;
|
|
u8 txs = port->txs & CLK_BRG_MASK;
|
|
|
|
switch(port->settings.clock_type) {
|
|
case CLOCK_INT:
|
|
mcr |= port->phy_node ? CLOCK_OUT_PORT1 : CLOCK_OUT_PORT0;
|
|
rxs |= CLK_BRG_RX; /* BRG output */
|
|
txs |= CLK_RXCLK_TX; /* RX clock */
|
|
break;
|
|
|
|
case CLOCK_TXINT:
|
|
mcr |= port->phy_node ? CLOCK_OUT_PORT1 : CLOCK_OUT_PORT0;
|
|
rxs |= CLK_LINE_RX; /* RXC input */
|
|
txs |= CLK_BRG_TX; /* BRG output */
|
|
break;
|
|
|
|
case CLOCK_TXFROMRX:
|
|
mcr |= port->phy_node ? CLOCK_OUT_PORT1 : CLOCK_OUT_PORT0;
|
|
rxs |= CLK_LINE_RX; /* RXC input */
|
|
txs |= CLK_RXCLK_TX; /* RX clock */
|
|
break;
|
|
|
|
default: /* Clock EXTernal */
|
|
mcr &= port->phy_node ? ~CLOCK_OUT_PORT1 : ~CLOCK_OUT_PORT0;
|
|
rxs |= CLK_LINE_RX; /* RXC input */
|
|
txs |= CLK_LINE_TX; /* TXC input */
|
|
}
|
|
|
|
outb(mcr, io + N2_MCR);
|
|
port->rxs = rxs;
|
|
port->txs = txs;
|
|
sca_out(rxs, msci + RXS, card);
|
|
sca_out(txs, msci + TXS, card);
|
|
sca_set_port(port);
|
|
}
|
|
|
|
|
|
|
|
static int n2_open(struct net_device *dev)
|
|
{
|
|
port_t *port = dev_to_port(dev);
|
|
int io = port->card->io;
|
|
u8 mcr = inb(io + N2_MCR) | (port->phy_node ? TX422_PORT1:TX422_PORT0);
|
|
int result;
|
|
|
|
result = hdlc_open(dev);
|
|
if (result)
|
|
return result;
|
|
|
|
mcr &= port->phy_node ? ~DTR_PORT1 : ~DTR_PORT0; /* set DTR ON */
|
|
outb(mcr, io + N2_MCR);
|
|
|
|
outb(inb(io + N2_PCR) | PCR_ENWIN, io + N2_PCR); /* open window */
|
|
outb(inb(io + N2_PSR) | PSR_DMAEN, io + N2_PSR); /* enable dma */
|
|
sca_open(dev);
|
|
n2_set_iface(port);
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int n2_close(struct net_device *dev)
|
|
{
|
|
port_t *port = dev_to_port(dev);
|
|
int io = port->card->io;
|
|
u8 mcr = inb(io+N2_MCR) | (port->phy_node ? TX422_PORT1 : TX422_PORT0);
|
|
|
|
sca_close(dev);
|
|
mcr |= port->phy_node ? DTR_PORT1 : DTR_PORT0; /* set DTR OFF */
|
|
outb(mcr, io + N2_MCR);
|
|
hdlc_close(dev);
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int n2_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_SYNC_SERIAL;
|
|
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_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 */
|
|
n2_set_iface(port);
|
|
return 0;
|
|
|
|
default:
|
|
return hdlc_ioctl(dev, ifr, cmd);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
static void n2_destroy_card(card_t *card)
|
|
{
|
|
int cnt;
|
|
|
|
for (cnt = 0; cnt < 2; cnt++)
|
|
if (card->ports[cnt].card) {
|
|
struct net_device *dev = port_to_dev(&card->ports[cnt]);
|
|
unregister_hdlc_device(dev);
|
|
}
|
|
|
|
if (card->irq)
|
|
free_irq(card->irq, card);
|
|
|
|
if (card->winbase) {
|
|
iounmap(card->winbase);
|
|
release_mem_region(card->phy_winbase, USE_WINDOWSIZE);
|
|
}
|
|
|
|
if (card->io)
|
|
release_region(card->io, N2_IOPORTS);
|
|
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 const struct net_device_ops n2_ops = {
|
|
.ndo_open = n2_open,
|
|
.ndo_stop = n2_close,
|
|
.ndo_change_mtu = hdlc_change_mtu,
|
|
.ndo_start_xmit = hdlc_start_xmit,
|
|
.ndo_do_ioctl = n2_ioctl,
|
|
};
|
|
|
|
static int __init n2_run(unsigned long io, unsigned long irq,
|
|
unsigned long winbase, long valid0, long valid1)
|
|
{
|
|
card_t *card;
|
|
u8 cnt, pcr;
|
|
int i;
|
|
|
|
if (io < 0x200 || io > 0x3FF || (io % N2_IOPORTS) != 0) {
|
|
pr_err("invalid I/O port value\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
if (irq < 3 || irq > 15 || irq == 6) /* FIXME */ {
|
|
pr_err("invalid IRQ value\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
if (winbase < 0xA0000 || winbase > 0xFFFFF || (winbase & 0xFFF) != 0) {
|
|
pr_err("invalid RAM value\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
card = kzalloc(sizeof(card_t), GFP_KERNEL);
|
|
if (card == NULL)
|
|
return -ENOBUFS;
|
|
|
|
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) {
|
|
pr_err("unable to allocate memory\n");
|
|
n2_destroy_card(card);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (!request_region(io, N2_IOPORTS, devname)) {
|
|
pr_err("I/O port region in use\n");
|
|
n2_destroy_card(card);
|
|
return -EBUSY;
|
|
}
|
|
card->io = io;
|
|
|
|
if (request_irq(irq, sca_intr, 0, devname, card)) {
|
|
pr_err("could not allocate IRQ\n");
|
|
n2_destroy_card(card);
|
|
return -EBUSY;
|
|
}
|
|
card->irq = irq;
|
|
|
|
if (!request_mem_region(winbase, USE_WINDOWSIZE, devname)) {
|
|
pr_err("could not request RAM window\n");
|
|
n2_destroy_card(card);
|
|
return -EBUSY;
|
|
}
|
|
card->phy_winbase = winbase;
|
|
card->winbase = ioremap(winbase, USE_WINDOWSIZE);
|
|
if (!card->winbase) {
|
|
pr_err("ioremap() failed\n");
|
|
n2_destroy_card(card);
|
|
return -EFAULT;
|
|
}
|
|
|
|
outb(0, io + N2_PCR);
|
|
outb(winbase >> 12, io + N2_BAR);
|
|
|
|
switch (USE_WINDOWSIZE) {
|
|
case 16384:
|
|
outb(WIN16K, io + N2_PSR);
|
|
break;
|
|
|
|
case 32768:
|
|
outb(WIN32K, io + N2_PSR);
|
|
break;
|
|
|
|
case 65536:
|
|
outb(WIN64K, io + N2_PSR);
|
|
break;
|
|
|
|
default:
|
|
pr_err("invalid window size\n");
|
|
n2_destroy_card(card);
|
|
return -ENODEV;
|
|
}
|
|
|
|
pcr = PCR_ENWIN | PCR_VPM | (USE_BUS16BITS ? PCR_BUS16 : 0);
|
|
outb(pcr, io + N2_PCR);
|
|
|
|
card->ram_size = sca_detect_ram(card, card->winbase, MAX_RAM_SIZE);
|
|
|
|
/* number of TX + RX buffers for one port */
|
|
i = card->ram_size / ((valid0 + valid1) * (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 = (valid0 + valid1) * sizeof(pkt_desc) *
|
|
(card->tx_ring_buffers + card->rx_ring_buffers);
|
|
|
|
pr_info("RISCom/N2 %u KB RAM, IRQ%u, using %u TX + %u RX packets rings\n",
|
|
card->ram_size / 1024, card->irq,
|
|
card->tx_ring_buffers, card->rx_ring_buffers);
|
|
|
|
if (card->tx_ring_buffers < 1) {
|
|
pr_err("RAM test failed\n");
|
|
n2_destroy_card(card);
|
|
return -EIO;
|
|
}
|
|
|
|
pcr |= PCR_RUNSCA; /* run SCA */
|
|
outb(pcr, io + N2_PCR);
|
|
outb(0, io + N2_MCR);
|
|
|
|
sca_init(card, 0);
|
|
for (cnt = 0; cnt < 2; cnt++) {
|
|
port_t *port = &card->ports[cnt];
|
|
struct net_device *dev = port_to_dev(port);
|
|
hdlc_device *hdlc = dev_to_hdlc(dev);
|
|
|
|
if ((cnt == 0 && !valid0) || (cnt == 1 && !valid1))
|
|
continue;
|
|
|
|
port->phy_node = cnt;
|
|
port->valid = 1;
|
|
|
|
if ((cnt == 1) && valid0)
|
|
port->log_node = 1;
|
|
|
|
spin_lock_init(&port->lock);
|
|
dev->irq = irq;
|
|
dev->mem_start = winbase;
|
|
dev->mem_end = winbase + USE_WINDOWSIZE - 1;
|
|
dev->tx_queue_len = 50;
|
|
dev->netdev_ops = &n2_ops;
|
|
hdlc->attach = sca_attach;
|
|
hdlc->xmit = sca_xmit;
|
|
port->settings.clock_type = CLOCK_EXT;
|
|
port->card = card;
|
|
|
|
if (register_hdlc_device(dev)) {
|
|
pr_warn("unable to register hdlc device\n");
|
|
port->card = NULL;
|
|
n2_destroy_card(card);
|
|
return -ENOBUFS;
|
|
}
|
|
sca_init_port(port); /* Set up SCA memory */
|
|
|
|
netdev_info(dev, "RISCom/N2 node %d\n", port->phy_node);
|
|
}
|
|
|
|
*new_card = card;
|
|
new_card = &card->next_card;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int __init n2_init(void)
|
|
{
|
|
if (hw==NULL) {
|
|
#ifdef MODULE
|
|
pr_info("no card initialized\n");
|
|
#endif
|
|
return -EINVAL; /* no parameters specified, abort */
|
|
}
|
|
|
|
pr_info("%s\n", version);
|
|
|
|
do {
|
|
unsigned long io, irq, ram;
|
|
long valid[2] = { 0, 0 }; /* Default = both ports disabled */
|
|
|
|
io = simple_strtoul(hw, &hw, 0);
|
|
|
|
if (*hw++ != ',')
|
|
break;
|
|
irq = simple_strtoul(hw, &hw, 0);
|
|
|
|
if (*hw++ != ',')
|
|
break;
|
|
ram = simple_strtoul(hw, &hw, 0);
|
|
|
|
if (*hw++ != ',')
|
|
break;
|
|
while(1) {
|
|
if (*hw == '0' && !valid[0])
|
|
valid[0] = 1; /* Port 0 enabled */
|
|
else if (*hw == '1' && !valid[1])
|
|
valid[1] = 1; /* Port 1 enabled */
|
|
else
|
|
break;
|
|
hw++;
|
|
}
|
|
|
|
if (!valid[0] && !valid[1])
|
|
break; /* at least one port must be used */
|
|
|
|
if (*hw == ':' || *hw == '\x0')
|
|
n2_run(io, irq, ram, valid[0], valid[1]);
|
|
|
|
if (*hw == '\x0')
|
|
return first_card ? 0 : -EINVAL;
|
|
}while(*hw++ == ':');
|
|
|
|
pr_err("invalid hardware parameters\n");
|
|
return first_card ? 0 : -EINVAL;
|
|
}
|
|
|
|
|
|
static void __exit n2_cleanup(void)
|
|
{
|
|
card_t *card = first_card;
|
|
|
|
while (card) {
|
|
card_t *ptr = card;
|
|
card = card->next_card;
|
|
n2_destroy_card(ptr);
|
|
}
|
|
}
|
|
|
|
|
|
module_init(n2_init);
|
|
module_exit(n2_cleanup);
|
|
|
|
MODULE_AUTHOR("Krzysztof Halasa <khc@pm.waw.pl>");
|
|
MODULE_DESCRIPTION("RISCom/N2 serial port driver");
|
|
MODULE_LICENSE("GPL v2");
|
|
module_param(hw, charp, 0444);
|
|
MODULE_PARM_DESC(hw, "io,irq,ram,ports:io,irq,...");
|