[PATCH] Char: stallion, functions cleanup
Delete macros and functions, that are implemented in kernel yet (strtoul, min, tolower). Expand one function body in place, where it is called from. Signed-off-by: Jiri Slaby <jirislaby@gmail.com> Cc: Alan Cox <alan@lxorguk.ukuu.org.uk> Signed-off-by: Andrew Morton <akpm@osdl.org> Signed-off-by: Linus Torvalds <torvalds@osdl.org>
This commit is contained in:

committed by
Linus Torvalds

parent
705c186241
commit
843b568cf0
@@ -41,13 +41,12 @@
|
|||||||
#include <linux/smp_lock.h>
|
#include <linux/smp_lock.h>
|
||||||
#include <linux/device.h>
|
#include <linux/device.h>
|
||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
|
#include <linux/ctype.h>
|
||||||
|
|
||||||
#include <asm/io.h>
|
#include <asm/io.h>
|
||||||
#include <asm/uaccess.h>
|
#include <asm/uaccess.h>
|
||||||
|
|
||||||
#ifdef CONFIG_PCI
|
|
||||||
#include <linux/pci.h>
|
#include <linux/pci.h>
|
||||||
#endif
|
|
||||||
|
|
||||||
/*****************************************************************************/
|
/*****************************************************************************/
|
||||||
|
|
||||||
@@ -63,43 +62,16 @@
|
|||||||
#define BRD_ECH64PCI 27
|
#define BRD_ECH64PCI 27
|
||||||
#define BRD_EASYIOPCI 28
|
#define BRD_EASYIOPCI 28
|
||||||
|
|
||||||
/*
|
struct stlconf {
|
||||||
* Define a configuration structure to hold the board configuration.
|
|
||||||
* Need to set this up in the code (for now) with the boards that are
|
|
||||||
* to be configured into the system. This is what needs to be modified
|
|
||||||
* when adding/removing/modifying boards. Each line entry in the
|
|
||||||
* stl_brdconf[] array is a board. Each line contains io/irq/memory
|
|
||||||
* ranges for that board (as well as what type of board it is).
|
|
||||||
* Some examples:
|
|
||||||
* { BRD_EASYIO, 0x2a0, 0, 0, 10, 0 },
|
|
||||||
* This line would configure an EasyIO board (4 or 8, no difference),
|
|
||||||
* at io address 2a0 and irq 10.
|
|
||||||
* Another example:
|
|
||||||
* { BRD_ECH, 0x2a8, 0x280, 0, 12, 0 },
|
|
||||||
* This line will configure an EasyConnection 8/32 board at primary io
|
|
||||||
* address 2a8, secondary io address 280 and irq 12.
|
|
||||||
* Enter as many lines into this array as you want (only the first 4
|
|
||||||
* will actually be used!). Any combination of EasyIO and EasyConnection
|
|
||||||
* boards can be specified. EasyConnection 8/32 boards can share their
|
|
||||||
* secondary io addresses between each other.
|
|
||||||
*
|
|
||||||
* NOTE: there is no need to put any entries in this table for PCI
|
|
||||||
* boards. They will be found automatically by the driver - provided
|
|
||||||
* PCI BIOS32 support is compiled into the kernel.
|
|
||||||
*/
|
|
||||||
|
|
||||||
static struct stlconf {
|
|
||||||
int brdtype;
|
int brdtype;
|
||||||
int ioaddr1;
|
int ioaddr1;
|
||||||
int ioaddr2;
|
int ioaddr2;
|
||||||
unsigned long memaddr;
|
unsigned long memaddr;
|
||||||
int irq;
|
int irq;
|
||||||
int irqtype;
|
int irqtype;
|
||||||
} stl_brdconf[] = {
|
|
||||||
/*{ BRD_EASYIO, 0x2a0, 0, 0, 10, 0 },*/
|
|
||||||
};
|
};
|
||||||
|
|
||||||
static int stl_nrbrds = ARRAY_SIZE(stl_brdconf);
|
static unsigned int stl_nrbrds;
|
||||||
|
|
||||||
/*****************************************************************************/
|
/*****************************************************************************/
|
||||||
|
|
||||||
@@ -432,15 +404,6 @@ static unsigned int stl_baudrates[] = {
|
|||||||
9600, 19200, 38400, 57600, 115200, 230400, 460800, 921600
|
9600, 19200, 38400, 57600, 115200, 230400, 460800, 921600
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
|
||||||
* Define some handy local macros...
|
|
||||||
*/
|
|
||||||
#undef MIN
|
|
||||||
#define MIN(a,b) (((a) <= (b)) ? (a) : (b))
|
|
||||||
|
|
||||||
#undef TOLOWER
|
|
||||||
#define TOLOWER(x) ((((x) >= 'A') && ((x) <= 'Z')) ? ((x) + 0x20) : (x))
|
|
||||||
|
|
||||||
/*****************************************************************************/
|
/*****************************************************************************/
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@@ -659,42 +622,6 @@ static struct class *stallion_class;
|
|||||||
|
|
||||||
/*****************************************************************************/
|
/*****************************************************************************/
|
||||||
|
|
||||||
/*
|
|
||||||
* Convert an ascii string number into an unsigned long.
|
|
||||||
*/
|
|
||||||
|
|
||||||
static unsigned long stl_atol(char *str)
|
|
||||||
{
|
|
||||||
unsigned long val;
|
|
||||||
int base, c;
|
|
||||||
char *sp;
|
|
||||||
|
|
||||||
val = 0;
|
|
||||||
sp = str;
|
|
||||||
if ((*sp == '0') && (*(sp+1) == 'x')) {
|
|
||||||
base = 16;
|
|
||||||
sp += 2;
|
|
||||||
} else if (*sp == '0') {
|
|
||||||
base = 8;
|
|
||||||
sp++;
|
|
||||||
} else {
|
|
||||||
base = 10;
|
|
||||||
}
|
|
||||||
|
|
||||||
for (; (*sp != 0); sp++) {
|
|
||||||
c = (*sp > '9') ? (TOLOWER(*sp) - 'a' + 10) : (*sp - '0');
|
|
||||||
if ((c < 0) || (c >= base)) {
|
|
||||||
printk("STALLION: invalid argument %s\n", str);
|
|
||||||
val = 0;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
val = (val * base) + c;
|
|
||||||
}
|
|
||||||
return val;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*****************************************************************************/
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Parse the supplied argument string, into the board conf struct.
|
* Parse the supplied argument string, into the board conf struct.
|
||||||
*/
|
*/
|
||||||
@@ -710,7 +637,7 @@ static int __init stl_parsebrd(struct stlconf *confp, char **argp)
|
|||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
for (sp = argp[0], i = 0; ((*sp != 0) && (i < 25)); sp++, i++)
|
for (sp = argp[0], i = 0; ((*sp != 0) && (i < 25)); sp++, i++)
|
||||||
*sp = TOLOWER(*sp);
|
*sp = tolower(*sp);
|
||||||
|
|
||||||
for (i = 0; i < ARRAY_SIZE(stl_brdstr); i++) {
|
for (i = 0; i < ARRAY_SIZE(stl_brdstr); i++) {
|
||||||
if (strcmp(stl_brdstr[i].name, argp[0]) == 0)
|
if (strcmp(stl_brdstr[i].name, argp[0]) == 0)
|
||||||
@@ -725,15 +652,15 @@ static int __init stl_parsebrd(struct stlconf *confp, char **argp)
|
|||||||
|
|
||||||
i = 1;
|
i = 1;
|
||||||
if ((argp[i] != NULL) && (*argp[i] != 0))
|
if ((argp[i] != NULL) && (*argp[i] != 0))
|
||||||
confp->ioaddr1 = stl_atol(argp[i]);
|
confp->ioaddr1 = simple_strtoul(argp[i], NULL, 0);
|
||||||
i++;
|
i++;
|
||||||
if (confp->brdtype == BRD_ECH) {
|
if (confp->brdtype == BRD_ECH) {
|
||||||
if ((argp[i] != NULL) && (*argp[i] != 0))
|
if ((argp[i] != NULL) && (*argp[i] != 0))
|
||||||
confp->ioaddr2 = stl_atol(argp[i]);
|
confp->ioaddr2 = simple_strtoul(argp[i], NULL, 0);
|
||||||
i++;
|
i++;
|
||||||
}
|
}
|
||||||
if ((argp[i] != NULL) && (*argp[i] != 0))
|
if ((argp[i] != NULL) && (*argp[i] != 0))
|
||||||
confp->irq = stl_atol(argp[i]);
|
confp->irq = simple_strtoul(argp[i], NULL, 0);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -758,32 +685,6 @@ static struct stlbrd *stl_allocbrd(void)
|
|||||||
return brdp;
|
return brdp;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void __init stl_argbrds(void)
|
|
||||||
{
|
|
||||||
struct stlconf conf;
|
|
||||||
struct stlbrd *brdp;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
pr_debug("stl_argbrds()\n");
|
|
||||||
|
|
||||||
for (i = stl_nrbrds; (i < stl_nargs); i++) {
|
|
||||||
memset(&conf, 0, sizeof(conf));
|
|
||||||
if (stl_parsebrd(&conf, stl_brdsp[i]) == 0)
|
|
||||||
continue;
|
|
||||||
if ((brdp = stl_allocbrd()) == NULL)
|
|
||||||
continue;
|
|
||||||
stl_nrbrds = i + 1;
|
|
||||||
brdp->brdnr = i;
|
|
||||||
brdp->brdtype = conf.brdtype;
|
|
||||||
brdp->ioaddr1 = conf.ioaddr1;
|
|
||||||
brdp->ioaddr2 = conf.ioaddr2;
|
|
||||||
brdp->irq = conf.irq;
|
|
||||||
brdp->irqtype = conf.irqtype;
|
|
||||||
if (stl_brdinit(brdp))
|
|
||||||
kfree(brdp);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*****************************************************************************/
|
/*****************************************************************************/
|
||||||
|
|
||||||
static int stl_open(struct tty_struct *tty, struct file *filp)
|
static int stl_open(struct tty_struct *tty, struct file *filp)
|
||||||
@@ -1089,10 +990,10 @@ static int stl_write(struct tty_struct *tty, const unsigned char *buf, int count
|
|||||||
stlen = len;
|
stlen = len;
|
||||||
}
|
}
|
||||||
|
|
||||||
len = MIN(len, count);
|
len = min(len, (unsigned int)count);
|
||||||
count = 0;
|
count = 0;
|
||||||
while (len > 0) {
|
while (len > 0) {
|
||||||
stlen = MIN(len, stlen);
|
stlen = min(len, stlen);
|
||||||
memcpy(head, chbuf, stlen);
|
memcpy(head, chbuf, stlen);
|
||||||
len -= stlen;
|
len -= stlen;
|
||||||
chbuf += stlen;
|
chbuf += stlen;
|
||||||
@@ -2549,56 +2450,6 @@ static struct pci_driver stl_pcidriver = {
|
|||||||
|
|
||||||
/*****************************************************************************/
|
/*****************************************************************************/
|
||||||
|
|
||||||
/*
|
|
||||||
* Scan through all the boards in the configuration and see what we
|
|
||||||
* can find. Handle EIO and the ECH boards a little differently here
|
|
||||||
* since the initial search and setup is too different.
|
|
||||||
*/
|
|
||||||
|
|
||||||
static int __init stl_initbrds(void)
|
|
||||||
{
|
|
||||||
struct stlbrd *brdp;
|
|
||||||
struct stlconf *confp;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
pr_debug("stl_initbrds()\n");
|
|
||||||
|
|
||||||
if (stl_nrbrds > STL_MAXBRDS) {
|
|
||||||
printk("STALLION: too many boards in configuration table, "
|
|
||||||
"truncating to %d\n", STL_MAXBRDS);
|
|
||||||
stl_nrbrds = STL_MAXBRDS;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Firstly scan the list of static boards configured. Allocate
|
|
||||||
* resources and initialize the boards as found.
|
|
||||||
*/
|
|
||||||
for (i = 0; (i < stl_nrbrds); i++) {
|
|
||||||
confp = &stl_brdconf[i];
|
|
||||||
stl_parsebrd(confp, stl_brdsp[i]);
|
|
||||||
if ((brdp = stl_allocbrd()) == NULL)
|
|
||||||
return(-ENOMEM);
|
|
||||||
brdp->brdnr = i;
|
|
||||||
brdp->brdtype = confp->brdtype;
|
|
||||||
brdp->ioaddr1 = confp->ioaddr1;
|
|
||||||
brdp->ioaddr2 = confp->ioaddr2;
|
|
||||||
brdp->irq = confp->irq;
|
|
||||||
brdp->irqtype = confp->irqtype;
|
|
||||||
if (stl_brdinit(brdp))
|
|
||||||
kfree(brdp);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Find any dynamically supported boards. That is via module load
|
|
||||||
* line options or auto-detected on the PCI bus.
|
|
||||||
*/
|
|
||||||
stl_argbrds();
|
|
||||||
|
|
||||||
return(0);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*****************************************************************************/
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Return the board stats structure to user app.
|
* Return the board stats structure to user app.
|
||||||
*/
|
*/
|
||||||
@@ -3691,9 +3542,9 @@ static void stl_cd1400txisr(struct stlpanel *panelp, int ioaddr)
|
|||||||
}
|
}
|
||||||
outb(srer, (ioaddr + EREG_DATA));
|
outb(srer, (ioaddr + EREG_DATA));
|
||||||
} else {
|
} else {
|
||||||
len = MIN(len, CD1400_TXFIFOSIZE);
|
len = min(len, CD1400_TXFIFOSIZE);
|
||||||
portp->stats.txtotal += len;
|
portp->stats.txtotal += len;
|
||||||
stlen = MIN(len, ((portp->tx.buf + STL_TXBUFSIZE) - tail));
|
stlen = min(len, ((portp->tx.buf + STL_TXBUFSIZE) - tail));
|
||||||
outb((TDR + portp->uartaddr), ioaddr);
|
outb((TDR + portp->uartaddr), ioaddr);
|
||||||
outsb((ioaddr + EREG_DATA), tail, stlen);
|
outsb((ioaddr + EREG_DATA), tail, stlen);
|
||||||
len -= stlen;
|
len -= stlen;
|
||||||
@@ -3746,13 +3597,13 @@ static void stl_cd1400rxisr(struct stlpanel *panelp, int ioaddr)
|
|||||||
outb((RDCR + portp->uartaddr), ioaddr);
|
outb((RDCR + portp->uartaddr), ioaddr);
|
||||||
len = inb(ioaddr + EREG_DATA);
|
len = inb(ioaddr + EREG_DATA);
|
||||||
if (tty == NULL || (buflen = tty_buffer_request_room(tty, len)) == 0) {
|
if (tty == NULL || (buflen = tty_buffer_request_room(tty, len)) == 0) {
|
||||||
len = MIN(len, sizeof(stl_unwanted));
|
len = min(len, sizeof(stl_unwanted));
|
||||||
outb((RDSR + portp->uartaddr), ioaddr);
|
outb((RDSR + portp->uartaddr), ioaddr);
|
||||||
insb((ioaddr + EREG_DATA), &stl_unwanted[0], len);
|
insb((ioaddr + EREG_DATA), &stl_unwanted[0], len);
|
||||||
portp->stats.rxlost += len;
|
portp->stats.rxlost += len;
|
||||||
portp->stats.rxtotal += len;
|
portp->stats.rxtotal += len;
|
||||||
} else {
|
} else {
|
||||||
len = MIN(len, buflen);
|
len = min(len, buflen);
|
||||||
if (len > 0) {
|
if (len > 0) {
|
||||||
unsigned char *ptr;
|
unsigned char *ptr;
|
||||||
outb((RDSR + portp->uartaddr), ioaddr);
|
outb((RDSR + portp->uartaddr), ioaddr);
|
||||||
@@ -4615,9 +4466,9 @@ static void stl_sc26198txisr(struct stlport *portp)
|
|||||||
outb(mr0, (ioaddr + XP_DATA));
|
outb(mr0, (ioaddr + XP_DATA));
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
len = MIN(len, SC26198_TXFIFOSIZE);
|
len = min(len, SC26198_TXFIFOSIZE);
|
||||||
portp->stats.txtotal += len;
|
portp->stats.txtotal += len;
|
||||||
stlen = MIN(len, ((portp->tx.buf + STL_TXBUFSIZE) - tail));
|
stlen = min(len, ((portp->tx.buf + STL_TXBUFSIZE) - tail));
|
||||||
outb(GTXFIFO, (ioaddr + XP_ADDR));
|
outb(GTXFIFO, (ioaddr + XP_ADDR));
|
||||||
outsb((ioaddr + XP_DATA), tail, stlen);
|
outsb((ioaddr + XP_DATA), tail, stlen);
|
||||||
len -= stlen;
|
len -= stlen;
|
||||||
@@ -4658,13 +4509,13 @@ static void stl_sc26198rxisr(struct stlport *portp, unsigned int iack)
|
|||||||
|
|
||||||
if ((iack & IVR_TYPEMASK) == IVR_RXDATA) {
|
if ((iack & IVR_TYPEMASK) == IVR_RXDATA) {
|
||||||
if (tty == NULL || (buflen = tty_buffer_request_room(tty, len)) == 0) {
|
if (tty == NULL || (buflen = tty_buffer_request_room(tty, len)) == 0) {
|
||||||
len = MIN(len, sizeof(stl_unwanted));
|
len = min(len, sizeof(stl_unwanted));
|
||||||
outb(GRXFIFO, (ioaddr + XP_ADDR));
|
outb(GRXFIFO, (ioaddr + XP_ADDR));
|
||||||
insb((ioaddr + XP_DATA), &stl_unwanted[0], len);
|
insb((ioaddr + XP_DATA), &stl_unwanted[0], len);
|
||||||
portp->stats.rxlost += len;
|
portp->stats.rxlost += len;
|
||||||
portp->stats.rxtotal += len;
|
portp->stats.rxtotal += len;
|
||||||
} else {
|
} else {
|
||||||
len = MIN(len, buflen);
|
len = min(len, buflen);
|
||||||
if (len > 0) {
|
if (len > 0) {
|
||||||
unsigned char *ptr;
|
unsigned char *ptr;
|
||||||
outb(GRXFIFO, (ioaddr + XP_ADDR));
|
outb(GRXFIFO, (ioaddr + XP_ADDR));
|
||||||
@@ -4831,6 +4682,8 @@ static void stl_sc26198otherisr(struct stlport *portp, unsigned int iack)
|
|||||||
*/
|
*/
|
||||||
static int __init stallion_module_init(void)
|
static int __init stallion_module_init(void)
|
||||||
{
|
{
|
||||||
|
struct stlbrd *brdp;
|
||||||
|
struct stlconf conf;
|
||||||
unsigned int i, retval;
|
unsigned int i, retval;
|
||||||
|
|
||||||
printk(KERN_INFO "%s: version %s\n", stl_drvtitle, stl_drvversion);
|
printk(KERN_INFO "%s: version %s\n", stl_drvtitle, stl_drvversion);
|
||||||
@@ -4838,7 +4691,27 @@ static int __init stallion_module_init(void)
|
|||||||
spin_lock_init(&stallion_lock);
|
spin_lock_init(&stallion_lock);
|
||||||
spin_lock_init(&brd_lock);
|
spin_lock_init(&brd_lock);
|
||||||
|
|
||||||
stl_initbrds();
|
/*
|
||||||
|
* Find any dynamically supported boards. That is via module load
|
||||||
|
* line options.
|
||||||
|
*/
|
||||||
|
for (i = stl_nrbrds; i < stl_nargs; i++) {
|
||||||
|
memset(&conf, 0, sizeof(conf));
|
||||||
|
if (stl_parsebrd(&conf, stl_brdsp[i]) == 0)
|
||||||
|
continue;
|
||||||
|
if ((brdp = stl_allocbrd()) == NULL)
|
||||||
|
continue;
|
||||||
|
brdp->brdnr = i;
|
||||||
|
brdp->brdtype = conf.brdtype;
|
||||||
|
brdp->ioaddr1 = conf.ioaddr1;
|
||||||
|
brdp->ioaddr2 = conf.ioaddr2;
|
||||||
|
brdp->irq = conf.irq;
|
||||||
|
brdp->irqtype = conf.irqtype;
|
||||||
|
if (stl_brdinit(brdp))
|
||||||
|
kfree(brdp);
|
||||||
|
else
|
||||||
|
stl_nrbrds = i + 1;
|
||||||
|
}
|
||||||
|
|
||||||
retval = pci_register_driver(&stl_pcidriver);
|
retval = pci_register_driver(&stl_pcidriver);
|
||||||
if (retval)
|
if (retval)
|
||||||
|
Reference in New Issue
Block a user