Subversion Repositories or1k_old

/*
 * linux/arch/arm/drivers/char/serial-module.c
 *
 * Copyright (c) 1996 Russell King.
 *
 * A generic handler of serial expansion cards that use 16550s or
 * the like.
 *
 * Definitions:
 *  MY_PRODS		Product numbers to identify this card by
 *  MY_MANUS		Manufacturer numbers to identify this card by
 *  MY_NUMPORTS		Number of ports per card
 *  MY_BAUD_BASE	Baud base for the card
 *  MY_INIT		Initialisation routine name
 *  MY_BASE_ADDRESS(ec)	Return base address for ports
 *  MY_PORT_ADDRESS
 *	(port,cardaddr)	Return address for port using base address
 *			from above.
 *
 * Changelog:
 *  30-07-1996	RMK	Created
 */
#include <linux/module.h>
#include <linux/serial.h>
#include <linux/errno.h>
#include <asm/ecard.h>
 
#ifndef NUM_SERIALS
#define NUM_SERIALS	MY_NUMPORTS * MAX_ECARDS
#endif
 
#ifdef MODULE
static int __serial_ports[NUM_SERIALS];
static int __serial_pcount;
static struct expansion_card *expcard[MAX_ECARDS];
#define ADD_ECARD(ec,card) expcard[(card)] = (ec)
#define ADD_PORT(port) __serial_ports[__serial_pcount++] = (port)
#define REGISTER(ss) register_serial(ss)
#undef MY_INIT
#define MY_INIT init_module
#else
#define ADD_ECARD(ec,card)
#define ADD_PORT(port)
#define REGISTER(ss) register_pre_init_serial(ss)
#endif
 
static const card_ids serial_cids[] = { MY_CARD_LIST, { 0xffff, 0xffff } };
 
static inline int serial_register_onedev (unsigned long port, int irq)
{
    struct serial_struct req;
 
    req.baud_base = MY_BAUD_BASE;
    req.irq = irq;
    req.port = port;
 
    return REGISTER (&req);
}
 
int MY_INIT (void)
{
    int card = 0;
 
    ecard_startfind ();
 
    do {
	struct expansion_card *ec;
	unsigned long cardaddr;
	int port;
 
	ec = ecard_find (0, serial_cids);
	if (!ec)
	    break;
 
	cardaddr = MY_BASE_ADDRESS(ec);
 
	for (port = 0; port < MY_NUMPORTS; port ++) {
	    int line;
 
	    line = serial_register_onedev (MY_PORT_ADDRESS(port, cardaddr), ec->irq);
	    if (line < 0)
		break;
	    ADD_PORT(line);
	}
 
	if (port) {
	    ecard_claim (ec);
	    ADD_ECARD(ec, card);
	} else
	    break;
    } while (++card < MAX_ECARDS);
    return card ? 0 : -ENODEV;
}
 
#ifdef MODULE
void cleanup_module (void)
{
    int i;
 
    for (i = 0; i < __serial_pcount; i++)
	unregister_serial (__serial_ports[i]);
 
    for (i = 0; i < MAX_ECARDS; i++)
	if (expcard[i])
	    ecard_release (expcard[i]);
}
#endif