Linux/Unix编程

开发平台：
Unix_Linux

c101.c：源码内容
							/*
 * Moxa C101 synchronous serial card driver for Linux
 *
 * Copyright (C) 2000 Krzysztof Halasa <khc@pm.waw.pl>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * For information see http://hq.pm.waw.pl/hdlc/
 *
 * Sources of information:
 *    Hitachi HD64570 SCA User's Manual
 *    Moxa C101 User's Manual
 */
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/types.h>
#include <linux/string.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/netdevice.h>
#include <linux/hdlc.h>
#include <linux/delay.h>
#include <asm/io.h>
#include "hd64570.h"
#define DEBUG_RINGS
/* #define DEBUG_PKT */
static const char* version = "Moxa C101 driver revision: 1.02 for Linux 2.4";
static const char* devname = "C101";
#define C101_PAGE 0x1D00
#define C101_DTR 0x1E00
#define C101_SCA 0x1F00
#define C101_WINDOW_SIZE 0x2000
#define C101_MAPPED_RAM_SIZE 0x4000
#define RAM_SIZE (256 * 1024)
#define CLOCK_BASE 9830400	/* 9.8304 MHz */
#define PAGE0_ALWAYS_MAPPED
static char *hw;		/* pointer to hw=xxx command line string */
typedef struct card_s {
	hdlc_device hdlc;	/* HDLC device struct - must be first */
	spinlock_t lock;	/* TX lock */
	int clkmode;		/* clock mode */
	int clkrate;		/* clock speed */
	int line;		/* loopback only */
	u8 *win0base;		/* ISA window base address */
	u32 phy_winbase;	/* ISA physical base address */
	u16 buff_offset;	/* offset of first buffer of first channel */
	u8 rxs, txs, tmc;	/* SCA registers */
	u8 irq;			/* IRQ (3-15) */
	u8 ring_buffers;	/* number of buffers in a ring */
	u8 page;
	u8 rxin;		/* rx ring buffer 'in' pointer */
	u8 txin;		/* tx ring buffer 'in' and 'last' pointers */
	u8 txlast;
	u8 rxpart;		/* partial frame received, next frame invalid*/
	struct card_s *next_card;
}card_t;
typedef card_t port_t;
#define sca_in(reg, card)	   readb((card)->win0base + C101_SCA + (reg))
#define sca_out(value, reg, card)  writeb(value, (card)->win0base + C101_SCA + (reg))
#define sca_inw(reg, card)	   readw((card)->win0base + C101_SCA + (reg))
#define sca_outw(value, reg, card) writew(value, (card)->win0base + C101_SCA + (reg))
#define port_to_card(port)	   (port)
#define log_node(port)		   (0)
#define phy_node(port)		   (0)
#define winsize(card)		   (C101_WINDOW_SIZE)
#define win0base(card)		   ((card)->win0base)
#define winbase(card)      	   ((card)->win0base + 0x2000)
#define get_port(card, port)	   ((port) == 0 ? (card) : NULL)
static inline u8 sca_get_page(card_t *card)
{
	return card->page;
}
static inline void openwin(card_t *card, u8 page)
{
	card->page = page;
	writeb(page, card->win0base + C101_PAGE);
}
#define close_windows(card) {} /* no hardware support */
#include "hd6457x.c"
static int c101_set_clock(port_t *port, int value)
{
	u8 msci = get_msci(port);
	u8 rxs = port->rxs & CLK_BRG_MASK;
	u8 txs = port->txs & CLK_BRG_MASK;
	switch(value) {
	case CLOCK_EXT:
		rxs |= CLK_LINE_RX; /* RXC input */
		txs |= CLK_LINE_TX; /* TXC input */
		break;
	case CLOCK_INT:
		rxs |= CLK_BRG_RX; /* TX clock */
		txs |= CLK_RXCLK_TX; /* BRG output */
		break;
	case CLOCK_TXINT:
		rxs |= CLK_LINE_RX; /* RXC input */
		txs |= CLK_BRG_TX; /* BRG output */
		break;
	case CLOCK_TXFROMRX:
		rxs |= CLK_LINE_RX; /* RXC input */
		txs |= CLK_RXCLK_TX; /* RX clock */
		break;
	default:
		return -EINVAL;
	}
	port->rxs = rxs;
	port->txs = txs;
	sca_out(rxs, msci + RXS, port);
	sca_out(txs, msci + TXS, port);
	port->clkmode = value;
	return 0;
}
static int c101_open(hdlc_device *hdlc)
{
	port_t *port = hdlc_to_port(hdlc);
	MOD_INC_USE_COUNT;
	writeb(1, port->win0base + C101_DTR);
	sca_out(0, MSCI1_OFFSET + CTL, port); /* RTS uses ch#2 output */
	sca_open(hdlc);
	c101_set_clock(port, port->clkmode);
	return 0;
}
static void c101_close(hdlc_device *hdlc)
{
	port_t *port = hdlc_to_port(hdlc);
	sca_close(hdlc);
	writeb(0, port->win0base + C101_DTR);
	sca_out(CTL_NORTS, MSCI1_OFFSET + CTL, port);
	MOD_DEC_USE_COUNT;
}
static int c101_ioctl(hdlc_device *hdlc, struct ifreq *ifr, int cmd)
{
	int value = ifr->ifr_ifru.ifru_ivalue;
	int result = 0;
	port_t *port = hdlc_to_port(hdlc);
	if(!capable(CAP_NET_ADMIN))
		return -EPERM;
	switch(cmd) {
	case HDLCSCLOCK:
		result = c101_set_clock(port, value);
	case HDLCGCLOCK:
		value = port->clkmode;
		break;
	case HDLCSCLOCKRATE:
		port->clkrate = value;
		sca_set_clock(port);
	case HDLCGCLOCKRATE:
		value = port->clkrate;
		break;
	case HDLCSLINE:
		result = sca_set_loopback(port, value);
	case HDLCGLINE:
		value = port->line;
		break;
#ifdef DEBUG_RINGS
	case HDLCRUN:
		sca_dump_rings(hdlc);
		return 0;
#endif /* DEBUG_RINGS */
	default:
		return -EINVAL;
	}
	ifr->ifr_ifru.ifru_ivalue = value;
	return result;
}
static void c101_destroy_card(card_t *card)
{
	if (card->irq)
		free_irq(card->irq, card);
	if (card->win0base) {
		iounmap(card->win0base);
		release_mem_region(card->phy_winbase, C101_MAPPED_RAM_SIZE);
	}
	kfree(card);
}
static int c101_run(unsigned long irq, unsigned long winbase)
{
	card_t *card;
	int result;
	if (irq<3 || irq>15 || irq == 6) /* FIXME */ {
		printk(KERN_ERR "c101: invalid IRQ valuen");
		return -ENODEV;
	}
	if (winbase < 0xC0000 || winbase > 0xDFFFF || (winbase & 0x3FFF) !=0) {
		printk(KERN_ERR "c101: invalid RAM valuen");
		return -ENODEV;
	}
	card = kmalloc(sizeof(card_t), GFP_KERNEL);
	if (card == NULL) {
		printk(KERN_ERR "c101: unable to allocate memoryn");
		return -ENOBUFS;
	}
	memset(card, 0, sizeof(card_t));
	if (request_irq(irq, sca_intr, 0, devname, card)) {
		printk(KERN_ERR "c101: could not allocate IRQn");
		c101_destroy_card(card);
		return(-EBUSY);
	}
	card->irq = irq;
	if (!request_mem_region(winbase, C101_MAPPED_RAM_SIZE, devname)) {
		printk(KERN_ERR "c101: could not request RAM windown");
		c101_destroy_card(card);
		return(-EBUSY);
	}
	card->phy_winbase = winbase;
	card->win0base = ioremap(winbase, C101_MAPPED_RAM_SIZE);
	if (!card->win0base) {
		printk(KERN_ERR "c101: could not map I/O addressn");
		c101_destroy_card(card);
		return -EBUSY;
	}
	/* 2 rings required for 1 port */
	card->ring_buffers = (RAM_SIZE -C101_WINDOW_SIZE) / (2 * HDLC_MAX_MRU);
	printk(KERN_DEBUG "c101: using %u packets ringsn",card->ring_buffers);
	card->buff_offset = C101_WINDOW_SIZE; /* Bytes 1D00-1FFF reserved */
	readb(card->win0base + C101_PAGE); /* Resets SCA? */
	udelay(100);
	writeb(0, card->win0base + C101_PAGE);
	writeb(0, card->win0base + C101_DTR); /* Power-up for RAM? */
	sca_init(card, 0);
	spin_lock_init(&card->lock);
	hdlc_to_dev(&card->hdlc)->irq = irq;
	hdlc_to_dev(&card->hdlc)->mem_start = winbase;
	hdlc_to_dev(&card->hdlc)->mem_end = winbase + C101_MAPPED_RAM_SIZE - 1;
	hdlc_to_dev(&card->hdlc)->tx_queue_len = 50;
	card->hdlc.ioctl = c101_ioctl;
	card->hdlc.open = c101_open;
	card->hdlc.close = c101_close;
	card->hdlc.xmit = sca_xmit;
	result = register_hdlc_device(&card->hdlc);
	if (result) {
		printk(KERN_WARNING "c101: unable to register hdlc devicen");
		c101_destroy_card(card);
		return result;
	}
	sca_init_sync_port(card); /* Set up C101 memory */
	*new_card = card;
	new_card = &card->next_card;
	return 0;
}
static int __init c101_init(void)
{
	if (hw == NULL) {
#ifdef MODULE
		printk(KERN_INFO "c101: no card initializedn");
#endif
		return -ENOSYS;	/* no parameters specified, abort */
	}
	printk(KERN_INFO "%sn", version);
	do {
		unsigned long irq, ram;
		irq = simple_strtoul(hw, &hw, 0);
		if (*hw++ != ',')
			break;
		ram = simple_strtoul(hw, &hw, 0);
		if (*hw == ':' || *hw == 'x0')
			c101_run(irq, ram);
		if (*hw == 'x0')
			return 0;
	}while(*hw++ == ':');
	printk(KERN_ERR "c101: invalid hardware parametersn");
	return first_card ? 0 : -ENOSYS;
}
#ifndef MODULE
static int __init c101_setup(char *str)
{
	hw = str;
	return 1;
}
__setup("c101=", c101_setup);
#endif
static void __exit c101_cleanup(void)
{
	card_t *card = first_card;
	while (card) {
		card_t *ptr = card;
		card = card->next_card;
		unregister_hdlc_device(&ptr->hdlc);
		c101_destroy_card(ptr);
	}
}
module_init(c101_init);
module_exit(c101_cleanup);
MODULE_AUTHOR("Krzysztof Halasa <khc@pm.waw.pl>");
MODULE_DESCRIPTION("Moxa C101 serial port driver");
MODULE_LICENSE("GPL");
MODULE_PARM(hw, "s");		/* hw=irq,ram:irq,... */
EXPORT_NO_SYMBOLS;

						