OpenCores
URL https://opencores.org/ocsvn/or1k/or1k/trunk

Subversion Repositories or1k

[/] [or1k/] [trunk/] [rc203soc/] [sw/] [uClinux/] [drivers/] [net/] [ibmtr.c] - Rev 1626

Go to most recent revision | Compare with Previous | Blame | View Log

/* ibmtr.c:  A shared-memory IBM Token Ring 16/4 driver for linux */
/*
  Written 1993 by Mark Swanson and Peter De Schrijver.
  This software may be used and distributed according to the terms
  of the GNU Public License, incorporated herein by reference.
 
  This device driver should work with Any IBM Token Ring Card that does
  not use DMA.
 
  I used Donald Becker's (becker@super.org) device driver work
  as a base for most of my initial work.
*/
 
/*
   Changes by Peter De Schrijver (Peter.Deschrijver@linux.cc.kuleuven.ac.be) :
 
	+ changed name to ibmtr.c in anticipation of other tr boards.
	+ changed reset code and adapter open code.
	+ added SAP open code.
	+ a first attempt to write interrupt, transmit and receive routines.
 
   Changes by David W. Morris (dwm@shell.portal.com) :
     941003 dwm: - Restructure tok_probe for multiple adapters, devices
                 - Add comments, misc reorg for clarity
                 - Flatten interrupt handler levels
 
   Changes by Farzad Farid (farzy@zen.via.ecp.fr)
   and Pascal Andre (andre@chimay.via.ecp.fr) (March 9 1995) :
        - multi ring support clean up
        - RFC1042 compliance enhanced
 
   Changes by Pascal Andre (andre@chimay.via.ecp.fr) (September 7 1995) :
        - bug correction in tr_tx
        - removed redundant information display
        - some code reworking
 
   Changes by Michel Lespinasse (walken@via.ecp.fr), 
     Yann Doussot (doussot@via.ecp.fr) and Pascal Andre (andre@via.ecp.fr)
     (February 18, 1996) :
	- modified shared memory and mmio access port the driver to 
          alpha platform (structure access -> readb/writeb)
 
   Changes by Steve Kipisz (bungy@ibm.net or kipisz@vnet.ibm.com)
                           (January 18 1996):
        - swapped WWOR and WWCR in ibmtr.h
        - moved some init code from tok_probe into trdev_init.  The
          PCMCIA code can call trdev_init to complete initializing
          the driver.
	- added -DPCMCIA to support PCMCIA
	- detecting PCMCIA Card Removal in interrupt handler.  if
	  ISRP is FF, then a PCMCIA card has been removed
 
   Changes by Paul Norton (pnorton@cts.com) :
 	- restructured the READ.LOG logic to prevent the transmit SRB
	  from being rudely overwritten before the transmit cycle is
	  complete. (August 15 1996)
 
   Warnings !!!!!!!!!!!!!!
      This driver is only partially sanitized for support of multiple
      adapters.  It will almost definitely fail if more than one
      active adapter is identified.
*/
 
#ifdef PCMCIA
#define MODULE
#endif
 
#include <linux/module.h>
 
#ifdef PCMCIA
#undef MODULE
#endif
 
#define NO_AUTODETECT 1
#undef NO_AUTODETECT
#undef ENABLE_PAGING
 
#define FALSE 0
#define TRUE (!FALSE)
 
/* changes the output format of driver initialisation */
#define TR_NEWFORMAT	1
#define TR_VERBOSE	0
 
/* some 95 OS send many non UI frame; this allow removing the warning */
#define TR_FILTERNONUI	1
 
/* version and credits */
static const char *version = 
"ibmtr.c: v1.3.57 8/7/94 Peter De Schrijver and Mark Swanson\n"
"  modified 10/3/94 DW Morris, modified at VIA, ECP, France\n"
"  (3/9/95 F Farid and P Andre, 9/7/95 PA and 2/20/95 ML/PA/YD)\n";
 
static char pcchannelid[]={0x05, 0x00, 0x04, 0x09,
			   0x04, 0x03, 0x04, 0x0f,
			   0x03, 0x06, 0x03, 0x01,
			   0x03, 0x01, 0x03, 0x00,
			   0x03, 0x09, 0x03, 0x09,
			   0x03, 0x00, 0x02, 0x00};
static char mcchannelid[]={0x04, 0x0d, 0x04, 0x01,
			   0x05, 0x02, 0x05, 0x03,
			   0x03, 0x06, 0x03, 0x03,
			   0x05, 0x08, 0x03, 0x04,
			   0x03, 0x05, 0x03, 0x01,
			   0x03, 0x08, 0x02, 0x00};
 
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/errno.h>
#include <linux/sched.h>
#include <linux/timer.h>
#include <linux/in.h>
#include <asm/io.h>
#include <asm/system.h>
#include <asm/bitops.h>
#include <linux/ioport.h>
#include <linux/errno.h>
#include <linux/string.h>
#include <linux/skbuff.h>
#include <linux/interrupt.h>
#include <linux/delay.h>
#include <linux/netdevice.h>
#include <linux/trdevice.h>
#include <stddef.h>
#include "ibmtr.h"
 
 
#define DPRINTK(format, args...) printk("%s: " format, dev->name , ## args)
#define DPRINTD(format, args...) DummyCall("%s: " format, dev->name , ## args)
 
#if TR_NEWFORMAT
/* this allows displaying full adapter information */
const char *channel_def[] = { "ISA", "MCA", "ISA P&P" };
 
char *adapter_def(char type)
{
	switch (type) {
	      case 0xF : return "Adapter/A";
	      case 0xE : return "16/4 Adapter/II";
	      default : return "adapter";
	};
};
#endif
 
#if !TR_NEWFORMAT
unsigned char ibmtr_debug_trace=1;  /*  Patch or otherwise alter to
                                         control tokenring tracing.  */
#else
unsigned char ibmtr_debug_trace=0;
#endif
#define TRC_INIT 0x01              /*  Trace initialization & PROBEs */
#define TRC_INITV 0x02             /*  verbose init trace points     */
 
/* addresses to scan */
static short TokBaseAddrs[] = { MMIOStartLocP, MMIOStartLocA };
 
 
int tok_probe(struct device *dev);
unsigned char get_sram_size(struct tok_info *adapt_info);
 
static int tok_init_card(struct device *dev);
int trdev_init(struct device *dev);
void tok_interrupt(int irq, void *dev_id, struct pt_regs *regs);
 
static void initial_tok_int(struct device *dev);
 
static void open_sap(unsigned char type,struct device *dev);
void tok_open_adapter(unsigned long dev_addr);
static void tr_rx(struct device *dev);
static void tr_tx(struct device *dev);
 
static int tok_open(struct device *dev);
static int tok_close(struct device *dev);
static int tok_send_packet(struct sk_buff *skb, struct device *dev);
static struct enet_statistics * tok_get_stats(struct device *dev);
void tr_readlog(struct device *dev);
 
static struct timer_list tr_timer={NULL,NULL,0,0L,tok_open_adapter};
 
#if 0
int DummyCallCount=0;
 
/*  This routine combined with the #DEFINE DPRINTD serves
    to workaround the gcc apparent bug.   in tr_tx() */
 
static void DummyCall(const char * fmt,...) 
{ DummyCallCount++; return; }
#endif
 
static void PrtChanID(char *pcid, short stride) {
	short i, j;
	for (i=0, j=0; i<24; i++, j+=stride) 
		printk("%1x", ((int) pcid[j]) & 0x0f);
	printk("\n");
}
 
static void HWPrtChanID (__u32 pcid, short stride)
{
	short i, j;
	for (i=0, j=0; i<24; i++, j+=stride)
		printk("%1x", ((int)readb(pcid + j)) & 0x0f);
	printk("\n");
}
 
/* tok_probe():  Routine specified in the network device structure
          to probe for an IBM Token Ring Adapter.  Routine outline:
          I.  Interrogate hardware to determine if an adapter exists
              and what the speeds and feeds are
         II.  Setup data structures to control execution based upon
              adapter characteristics.
         III. Initialize adapter operation
     We expect tok_probe to be called once for each device entry
     which references it.
 */
 
int tok_probe(struct device *dev)
{
	unsigned char segment=0, intr=0, irq=0, i=0, j=0, cardpresent=NOTOK,temp=0;
	__u32 t_mmio=0;
	short PIOaddr=0, iAddr;
	struct tok_info *ti=0;
	static struct tok_info *badti=0;  /* if fail after kmalloc, reuse */
 
	static unsigned char Shared_Ram_Base = IBMTR_SHARED_RAM_BASE;
 
	/* this is the major adapter probe loop.  For each call to tok_probe,
	   we try each remaining entry in TokBaseAddrs[] as a possible
	   adapter.  Once an entry is rejected or assigned, we zero it to
	   avoid duplicate use or worthless trial for the tok probe call*/
 
	for (iAddr=0;
	     iAddr < (sizeof(TokBaseAddrs)/sizeof(short))&&PIOaddr==0; iAddr++) { 
 
		__u32 cd_chanid;
		unsigned char *tchanid, ctemp;
 
		PIOaddr=TokBaseAddrs[iAddr];  /* address to try           */
		TokBaseAddrs[iAddr] = 0;      /* (and marked already used */
		if (PIOaddr == 0) continue;   /* already tried this addr */
 
		/* Make sure PIO address not already assigned
		   elsewhere before we muck with IO address */
		if (check_region(PIOaddr,TR_IO_EXTENT)) {
			if (ibmtr_debug_trace & TRC_INIT)
				DPRINTK("check_region(%4hx,%d) failed.\n", PIOaddr, TR_IO_EXTENT);
			PIOaddr = 0; 
			continue; /* clear to flag fail and try next */
		}
		/* Query the adapter PIO base port which will return
		   indication of where MMIO was placed (per tech ref
		   this assignment is done by BIOS - what is rational for
		   where it is?).  We also have a coded interrupt address. */
 
		segment = inb(PIOaddr);
		/* out of range values so we'll assume non-existent IO device */
		if (segment < 0x40 || segment > 0xe0) { 
			PIOaddr = 0; 
			continue; /* clear to flag fail and try next */
		}
 
		/* Compute the linear base address of the MMIO area
		   as LINUX doesn't care about segments          */
		t_mmio=(((__u32)(segment & 0xfc) << 11) + 0x80000);
		intr = segment & 0x03;   /* low bits is coded interrupt # */
		if (ibmtr_debug_trace & TRC_INIT)
			DPRINTK("PIOaddr: %4hx seg/intr: %2x mmio base: %08X intr: %d\n", PIOaddr, (int)segment, t_mmio, (int)intr);
 
		/* Now we will compare expected 'channelid' strings with
		   what we is there to learn of ISA/MCA or not TR card */
		/* !!!WARNING:!!!! It seems pretty silly to blunder ahead
		   w/o verification that the mmio address we have found
		   is valid storage -- perhaps this is tolerable for current
		   hardware state??? */
 
		cd_chanid = (CHANNEL_ID + t_mmio);  /* for efficiency */
		tchanid=pcchannelid; 
		cardpresent=TR_ISA;  /* try ISA */
 
		/* suboptimize knowing first byte different */
		ctemp = readb(cd_chanid) & 0x0f;
		if (ctemp != *tchanid) { /* NOT ISA card, try MCA */
			tchanid=mcchannelid; 
			cardpresent=TR_MCA;
			if (ctemp != *tchanid)  /* Neither ISA nor MCA */
				cardpresent=NOTOK;
		}
 
		if (cardpresent != NOTOK) { /* know presumed type, try rest of ID */
			for (i=2,j=1; i<=46; i=i+2,j++) {
				if ((readb(cd_chanid+i) & 0x0f) != tchanid[j]) {
					cardpresent=NOTOK;   /* match failed, not TR card */
					break;
				}
			}
		}
 
		/* If we have an ISA board check for the ISA P&P version,
		   as it has different IRQ settings */
		if (cardpresent == TR_ISA && (readb(AIPFID + t_mmio)==0x0e))
			cardpresent=TR_ISAPNP;
 
		if (cardpresent == NOTOK) { /* "channel_id" did not match, report */
			if (ibmtr_debug_trace & TRC_INIT) {
				DPRINTK("Channel ID string not found for PIOaddr: %4hx\n", PIOaddr);
				DPRINTK("Expected for ISA: ");  PrtChanID(pcchannelid,1);
				DPRINTK("           found: ");  HWPrtChanID(cd_chanid,2);
				DPRINTK("Expected for MCA: ");  PrtChanID(mcchannelid,1);
			}
			PIOaddr = 0;  /* all to know not found yet */
			continue;
		}
 
	/* !!!! we could tighten validation by checking the HW Address
	   against the 1-s complement..  Move the get HW logic to here */
 
	}
 
	/* The search loop has either completed with a presumed TR adapter
	   or none found.  Check situation ... march on if possible */
 
	if (PIOaddr == 0) { /* failed to find a valid TR adapter */
		if (ibmtr_debug_trace & TRC_INIT)
			DPRINTK("Unable to assign adapter to device.\n");
		return ENODEV;
	}
 
	/*?? Now, allocate some of the pl0 buffers for this driver.. */
 
	if (!badti) {
		ti = (struct tok_info *)kmalloc(sizeof(struct tok_info), GFP_KERNEL);
		if (ti == NULL) return -ENOMEM;
	} else {
		ti = badti; 
		badti = NULL;
	} /*?? dev->priv = kmalloc(sizeof(struct net_local), GFP_KERNEL); */
 
	memset(ti, 0, sizeof(struct tok_info));
 
	ti->mmio= t_mmio;
	ti->readlog_pending = 0;
 
	dev->priv = ti;     /* this seems like the logical use of the
                         field ... let's try some empirical tests
                         using the token-info structure -- that
                         should fit with out future hope of multiple
                         adapter support as well /dwm   */
 
	switch (cardpresent) {
	      case TR_ISA:
		if (intr==0) irq=9; /* irq2 really is irq9 */
		if (intr==1) irq=3;
		if (intr==2) irq=6;
		if (intr==3) irq=7;
		ti->global_int_enable=GLOBAL_INT_ENABLE+((irq==9) ? 2 : irq);
		ti->sram=0;
#if !TR_NEWFORMAT
		DPRINTK("ti->global_int_enable: %04X\n",ti->global_int_enable);
#endif
		break;
	      case TR_MCA:
		if (intr==0) irq=9;
		if (intr==1) irq=3;
		if (intr==2) irq=10;
		if (intr==3) irq=11;
		ti->global_int_enable=0;
		ti->sram=((__u32)(inb(PIOaddr+ADAPTRESETREL) & 0xfe) << 12);
		break;
	      case TR_ISAPNP:
		if (intr==0) irq=9;
		if (intr==1) irq=3;
		if (intr==2) irq=10;
		if (intr==3) irq=11;
		while(!readb(ti->mmio + ACA_OFFSET + ACA_RW + RRR_EVEN));
		ti->sram=((__u32)readb(ti->mmio + ACA_OFFSET + ACA_RW + RRR_EVEN)<<12);
		ti->global_int_enable=PIOaddr+ADAPTINTREL;
		break;
 
	}
 
	if (ibmtr_debug_trace & TRC_INIT) { /* just report int */
		DPRINTK("irq=%d",irq);
		if (ibmtr_debug_trace & TRC_INITV) { /* full chat in verbose only */
			DPRINTK(", ti->mmio=%08X",ti->mmio);
			printk(", segment=%02X",segment);
		}
		printk(".\n");
	}
 
	/* Get hw address of token ring card */
#if !TR_NEWFORMAT 
	DPRINTK("hw address: ");
#endif
	j=0;
	for (i=0; i<0x18; i=i+2) {
		/* technical reference states to do this */
		temp = readb(ti->mmio + AIP + i) & 0x0f;
#if !TR_NEWFORMAT
		printk("%1X",ti->hw_address[j]=temp);
#else
		ti->hw_address[j]=temp;
#endif
		if(j&1)
			dev->dev_addr[(j/2)]=ti->hw_address[j]+(ti->hw_address[j-1]<<4);
		++j;
	}
#ifndef TR_NEWFORMAT
	printk("\n");
#endif
 
	/* get Adapter type:  'F' = Adapter/A, 'E' = 16/4 Adapter II,...*/
	ti->adapter_type = readb(ti->mmio + AIPADAPTYPE);
 
	/* get Data Rate:  F=4Mb, E=16Mb, D=4Mb & 16Mb ?? */
	ti->data_rate = readb(ti->mmio + AIPDATARATE);
 
	/* Get Early Token Release support?: F=no, E=4Mb, D=16Mb, C=4&16Mb */
	ti->token_release = readb(ti->mmio + AIPEARLYTOKEN);
 
	/* How much shared RAM is on adapter ? */
	ti->avail_shared_ram = get_sram_size(ti);
 
	/* We need to set or do a bunch of work here based on previous results.. */
	/* Support paging?  What sizes?:  F=no, E=16k, D=32k, C=16 & 32k */
	ti->shared_ram_paging = readb(ti->mmio + AIPSHRAMPAGE);
 
  /* Available DHB  4Mb size:   F=2048, E=4096, D=4464 */
	ti->dhb_size4mb = readb(ti->mmio + AIP4MBDHB);
 
	/* Available DHB 16Mb size:  F=2048, E=4096, D=8192, C=16384, B=17960 */
	ti->dhb_size16mb = readb(ti->mmio + AIP16MBDHB);
 
#if !TR_NEWFORMAT
	DPRINTK("atype=%x, drate=%x, trel=%x, asram=%dK, srp=%x, "
		"dhb(4mb=%x, 16mb=%x)\n",ti->adapter_type,
		ti->data_rate, ti->token_release, ti->avail_shared_ram/2, 
		ti->shared_ram_paging, ti->dhb_size4mb, ti->dhb_size16mb);
#endif
 
	/* We must figure out how much shared memory space this adapter
	   will occupy so that if there are two adapters we can fit both
	   in.  Given a choice, we will limit this adapter to 32K.  The
	   maximum space will use for two adapters is 64K so if the adapter
	   we are working on demands 64K (it also doesn't support paging),
	   then only one adapter can be supported.  */
 
	/* determine how much of total RAM is mapped into PC space */
	ti->mapped_ram_size=1<<((((readb(ti->mmio+ ACA_OFFSET + ACA_RW + RRR_ODD)) >>2) & 0x03) + 4);
	ti->page_mask=0;
	if (ti->shared_ram_paging == 0xf) { /* No paging in adapter */
		ti->mapped_ram_size = ti->avail_shared_ram;
	} else {
#ifdef ENABLE_PAGING
		unsigned char pg_size;
#endif
 
#if !TR_NEWFORMAT
		DPRINTK("shared ram page size: %dK\n",ti->mapped_ram_size/2);
#endif
#ifdef ENABLE_PAGING
	switch(ti->shared_ram_paging) {
	      case 0xf:
		break;
	      case 0xe:
		ti->page_mask=(ti->mapped_ram_size==32) ? 0xc0 : 0;
		pg_size=32;   /* 16KB page size */
		break;
	      case 0xd:
		ti->page_mask=(ti->mapped_ram_size==64) ? 0x80 : 0;
		pg_size=64;   /* 32KB page size */
		break;
	      case 0xc:
		ti->page_mask=(ti->mapped_ram_size==32) ? 0xc0 : 0;
		ti->page_mask=(ti->mapped_ram_size==64) ? 0x80 : 0;
		DPRINTK("Dual size shared RAM page (code=0xC), don't support it!\n");
		/* nb/dwm: I did this because RRR (3,2) bits are documented as
		   R/O and I can't find how to select which page size
		   Also, the above conditional statement sequence is invalid
		   as page_mask will always be set by the second stmt */
		badti=ti;
		break;
	      default:
		DPRINTK("Unknown shared ram paging info %01X\n",ti->shared_ram_paging);
		badti=ti;    /* bail out if bad code */
		break;
	}
	if (ti->page_mask) {
		if (pg_size > ti->mapped_ram_size) {
			DPRINTK("Page size (%d) > mapped ram window (%d), can't page.\n",
				pg_size, ti->mapped_ram_size);
				ti->page_mask = 0;    /* reset paging */
		} else {
			ti->mapped_ram_size=ti->avail_shared_ram; 
			DPRINTK("Shared RAM paging enabled. Page size : %uK\n",
				((ti->page_mask^ 0xff)+1)>>2);
		}
#endif
	}
 
	/* finish figuring the shared RAM address */
	if (cardpresent==TR_ISA) {
		static unsigned char ram_bndry_mask[]={0xfe, 0xfc, 0xf8, 0xf0};
		unsigned char new_base, rrr_32, chk_base, rbm;
		rrr_32 = ((readb(ti->mmio+ ACA_OFFSET + ACA_RW + RRR_ODD))>>2) & 0x03;
		rbm = ram_bndry_mask[rrr_32];
		new_base = (Shared_Ram_Base + (~rbm)) & rbm; /* up to boundary */
		chk_base = new_base + (ti->mapped_ram_size>>3);
		if (chk_base > (IBMTR_SHARED_RAM_BASE+IBMTR_SHARED_RAM_SIZE)) {
			DPRINTK("Shared RAM for this adapter (%05x) exceeds driver"
				" limit (%05x), adapter not started.\n",
				chk_base<<12, (IBMTR_SHARED_RAM_BASE+
					       IBMTR_SHARED_RAM_SIZE)<<12);
			badti=ti;
		} else {  /* seems cool, record what we have figured out */
			ti->sram_base = new_base;
			Shared_Ram_Base = new_base;
		}
	}
 
	/* dwm: irq and other final setup moved here so if we find other
           unrecognized values OR shared ram conflicts, we can still
           bail out in a rather benign fashion.    */
 
	if (badti) return ENODEV;
#if !TR_NEWFORMAT
	DPRINTK("Using %dK shared RAM\n",ti->mapped_ram_size/2);
#endif
 
	if (request_irq (dev->irq = irq, &tok_interrupt,0,"IBM TR", NULL) != 0) {
		DPRINTK("Could not grab irq %d.  Halting Token Ring driver.\n",irq);
		badti = ti;    /*  keep track of unused tok_info */
		return ENODEV;
	}
	irq2dev_map[irq]=dev;
 
 /*?? Now, allocate some of the PIO PORTs for this driver.. */
	request_region(PIOaddr,TR_IO_EXTENT,"ibmtr");  /* record PIOaddr range
								  as busy */
#if !TR_NEWFORMAT
	DPRINTK("%s",version); /* As we have passed card identification,
                                  let the world know we're here! */
#else
	printk("%s",version);
	DPRINTK("%s %s found using irq %d, PIOaddr %4hx, %dK shared RAM.\n",
		channel_def[cardpresent-1], adapter_def(ti->adapter_type), irq,
		PIOaddr, ti->mapped_ram_size/2);
	DPRINTK("Hardware address : %02X:%02X:%02X:%02X:%02X:%02X\n",
		dev->dev_addr[0], dev->dev_addr[1], dev->dev_addr[2],
		dev->dev_addr[3], dev->dev_addr[4], dev->dev_addr[5]);
#endif
 
	dev->base_addr=PIOaddr; /* set the value for device */
 
	trdev_init(dev);
	tok_init_card(dev);
 
	return 0;  /* Return 0 to indicate we have found a Token Ring card. */
}
 
/* query the adapter for the size of shared RAM  */
 
unsigned char get_sram_size(struct tok_info *adapt_info)
{
 
	unsigned char avail_sram_code;
	static unsigned char size_code[]={ 0,16,32,64,127,128 };
 
	/* Adapter gives
	   'F' -- use RRR bits 3,2
	   'E' -- 8kb   'D' -- 16kb
	   'C' -- 32kb  'A' -- 64KB
	   'B' - 64KB less 512 bytes at top
	   (WARNING ... must zero top bytes in INIT */
 
	avail_sram_code=0xf-readb(adapt_info->mmio + AIPAVAILSHRAM);
	if (avail_sram_code) 
		return size_code[avail_sram_code];
	else  /* for code 'F', must compute size from RRR(3,2) bits */
		return 1<<((readb(adapt_info->mmio+ ACA_OFFSET + ACA_RW + RRR_ODD)>>2)+4);
}
 
int trdev_init(struct device *dev)
{
  struct tok_info *ti=(struct tok_info *)dev->priv;
 
  ti->open_status=CLOSED;
 
  dev->init=tok_init_card;
  dev->open=tok_open;
  dev->stop=tok_close;
  dev->hard_start_xmit=tok_send_packet;
  dev->get_stats = NULL;
  dev->get_stats = tok_get_stats;
  dev->set_multicast_list = NULL;
  tr_setup(dev);
 
  return 0;
}
 
 
 
static int tok_open(struct device *dev) 
{
	struct tok_info *ti=(struct tok_info *)dev->priv;
 
	if (ti->open_status==CLOSED) tok_init_card(dev);
 
	if (ti->open_status==IN_PROGRESS) sleep_on(&ti->wait_for_reset);
 
	if (ti->open_status==SUCCESS) {
		dev->tbusy=0;
		dev->interrupt=0;
		dev->start=1;
		/* NEED to see smem size *AND* reset high 512 bytes if needed */
 
		MOD_INC_USE_COUNT;
 
		return 0;
	} else return -EAGAIN;
 
}
 
static int tok_close(struct device *dev) 
{
 
	struct tok_info *ti=(struct tok_info *) dev->priv;
 
	writeb(DIR_CLOSE_ADAPTER, 
	       ti->srb + offsetof(struct srb_close_adapter, command));
	writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
 
	ti->open_status=CLOSED;
 
	sleep_on(&ti->wait_for_tok_int);		
 
	if (readb(ti->srb + offsetof(struct srb_close_adapter, ret_code)))
		DPRINTK("close adapter failed: %02X\n",
			(int)readb(ti->srb + offsetof(struct srb_close_adapter, ret_code)));
 
	MOD_DEC_USE_COUNT;
 
	return 0;
}
 
void tok_interrupt (int irq, void *dev_id, struct pt_regs *regs)
{
	unsigned char status;
	struct tok_info *ti;
	struct device *dev = (struct device *)(irq2dev_map[irq]);
 
#if TR_VERBOSE
	DPRINTK("Int from tok_driver, dev : %p\n",dev);
#endif
 
	ti=(struct tok_info *) dev->priv;
 
	switch (ti->do_tok_int) {
 
	      case NOT_FIRST:
 
		/*  Begin the regular interrupt handler HERE inline to avoid
		    the extra levels of logic and call depth for the
		    original solution.   */
 
		dev->interrupt=1;
 
		/* Disable interrupts till processing is finished */
		writeb((~INT_ENABLE), ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
 
		/* Reset interrupt for ISA boards */
		if (ti->global_int_enable)
			outb(0, ti->global_int_enable);
 
		status=readb(ti->mmio + ACA_OFFSET + ACA_RW + ISRP_ODD);
		#ifdef PCMCIA
      		/* Check if the PCMCIA card was pulled. */
    		if (status == 0xFF)
       		{
		          DPRINTK("PCMCIA card removed.\n");
        		  dev->interrupt = 0;
          		  return;
       		}
 
    	        /* Check ISRP EVEN too. */
      	        if ( *(unsigned char *)(ti->mmio + ACA_OFFSET + ACA_RW + ISRP_EVEN) == 0xFF)
    	        {
         		 DPRINTK("PCMCIA card removed.\n");
         		 dev->interrupt = 0;
         		 return;
      		 }
		#endif
 
 
		if (status & ADAP_CHK_INT) {
 
			int i;
			__u32 check_reason;
 
			check_reason=ti->mmio + ntohs(readw(ti->sram + ACA_OFFSET + ACA_RW +WWCR_EVEN));
 
			DPRINTK("Adapter check interrupt\n");
			DPRINTK("8 reason bytes follow: ");
			for(i=0; i<8; i++, check_reason++)
				printk("%02X ", (int)readb(check_reason));	
			printk("\n");
 
			writeb((~ADAP_CHK_INT), ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_ODD);
			writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET  + ISRP_EVEN);
			dev->interrupt=0;
 
		}	else if (readb(ti->mmio + ACA_OFFSET + ACA_RW + ISRP_EVEN)
				 & (TCR_INT | ERR_INT | ACCESS_INT)) {
 
			DPRINTK("adapter error: ISRP_EVEN : %02x\n", 
				(int)readb(ti->mmio + ACA_OFFSET + ACA_RW + ISRP_EVEN));
			writeb(~(TCR_INT | ERR_INT | ACCESS_INT),
			       ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
			writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET  + ISRP_EVEN);
			dev->interrupt=0;
 
		} else if (status 
			   & (SRB_RESP_INT | ASB_FREE_INT | ARB_CMD_INT | SSB_RESP_INT)) {
			/* SRB, ASB, ARB or SSB response */
 
			if (status & SRB_RESP_INT) { /* SRB response */
 
				switch(readb(ti->srb)) { /* SRB command check */
 
				      case XMIT_DIR_FRAME: {
					      unsigned char xmit_ret_code;
 
					      xmit_ret_code=readb(ti->srb + offsetof(struct srb_xmit, ret_code));
					      if (xmit_ret_code != 0xff) {
						      DPRINTK("error on xmit_dir_frame request: %02X\n", 
							      xmit_ret_code);
						      if (ti->current_skb) {
							      dev_kfree_skb(ti->current_skb, FREE_WRITE);
							      ti->current_skb=NULL;
						      }
						      dev->tbusy=0;
						      if (ti->readlog_pending) tr_readlog(dev);
					      }
				      }
				      break;
 
				      case XMIT_UI_FRAME: {
					      unsigned char xmit_ret_code;
 
					      xmit_ret_code=readb(ti->srb + offsetof(struct srb_xmit, ret_code));
					      if (xmit_ret_code != 0xff) {
						      DPRINTK("error on xmit_ui_frame request: %02X\n",
							      xmit_ret_code);
						      if (ti->current_skb) {
							      dev_kfree_skb(ti->current_skb, FREE_WRITE);
							      ti->current_skb=NULL;
						      }
						      dev->tbusy=0;
						      if (ti->readlog_pending) tr_readlog(dev);
					      }
				      }
				      break;
 
				      case DIR_OPEN_ADAPTER: {
					      unsigned char open_ret_code;
					      __u16 open_error_code;
 
					      ti->srb=ti->sram+ntohs(readw(ti->init_srb +offsetof(struct srb_open_response, srb_addr)));
					      ti->ssb=ti->sram+ntohs(readw(ti->init_srb +offsetof(struct srb_open_response, ssb_addr)));
					      ti->arb=ti->sram+ntohs(readw(ti->init_srb +offsetof(struct srb_open_response, arb_addr)));
					      ti->asb=ti->sram+ntohs(readw(ti->init_srb +offsetof(struct srb_open_response, asb_addr)));
					      ti->current_skb=NULL;
 
					      open_ret_code = readb(ti->init_srb +offsetof(struct srb_open_response, ret_code));
					      open_error_code = ntohs(readw(ti->init_srb +offsetof(struct srb_open_response, error_code)));
 
					      if (open_ret_code==7) {
 
						      if (!ti->auto_ringspeedsave && (open_error_code==0x24)) {
							      DPRINTK("open failed: Adapter speed must match ring "
								      "speed if Automatic Ring Speed Save is disabled\n");
							      ti->open_status=FAILURE;
							      wake_up(&ti->wait_for_reset);
						      } else if (open_error_code==0x24)
							      DPRINTK("retrying open to adjust to ring speed\n");
						      else if ((open_error_code==0x2d) && ti->auto_ringspeedsave)
							      DPRINTK("No signal detected for Auto Speed Detection\n");
						      else DPRINTK("Unrecoverable error: error code = %04x\n", 
								   open_error_code);
 
					      } else if (!open_ret_code) {
#if !TR_NEWFORMAT
						      DPRINTK("board opened...\n");
#else
						      DPRINTK("Adapter initialized and opened.\n");
#endif
						      writeb(~(SRB_RESP_INT), 
							     ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_ODD);
						      writeb(~(CMD_IN_SRB), 
							     ti->mmio + ACA_OFFSET + ACA_RESET + ISRA_ODD);
						      open_sap(EXTENDED_SAP,dev);
 
						      /* YdW probably hates me */
						      goto skip_reset;
					      } else
						      DPRINTK("open failed: ret_code = %02X, retrying\n",
							      open_ret_code);
 
					      if (ti->open_status != FAILURE) {
						      tr_timer.expires=jiffies+TR_RETRY_INTERVAL;
						      tr_timer.data=(unsigned long)dev;
						      tr_timer.next=tr_timer.prev=NULL;
						      add_timer(&tr_timer);
					      }
 
				      }
				      break;
 
				      case DIR_CLOSE_ADAPTER:
					wake_up(&ti->wait_for_tok_int);
					break;
 
				      case DLC_OPEN_SAP:
					if (readb(ti->srb+offsetof(struct dlc_open_sap, ret_code))) {
						DPRINTK("open_sap failed: ret_code = %02X,retrying\n",
							(int)readb(ti->srb+offsetof(struct dlc_open_sap, ret_code)));
						tr_timer.expires=jiffies+TR_RETRY_INTERVAL;
						tr_timer.data=(unsigned long)dev;
						tr_timer.next=tr_timer.prev=NULL;
						add_timer(&tr_timer);
					} else {
						ti->exsap_station_id=
							readw(ti->srb+offsetof(struct dlc_open_sap, station_id));
						ti->open_status=SUCCESS; /* TR adapter is now available */
						wake_up(&ti->wait_for_reset);
					}
					break;
 
				      case DIR_INTERRUPT:
				      case DIR_MOD_OPEN_PARAMS:	
				      case DIR_SET_GRP_ADDR:
				      case DIR_SET_FUNC_ADDR:
				      case DLC_CLOSE_SAP:
					if (readb(ti->srb+offsetof(struct srb_interrupt, ret_code)))
						DPRINTK("error on %02X: %02X\n",
							(int)readb(ti->srb+offsetof(struct srb_interrupt, command)),
							(int)readb(ti->srb+offsetof(struct srb_interrupt, ret_code)));
					break;
 
				      case DIR_READ_LOG:
					if (readb(ti->srb+offsetof(struct srb_read_log, ret_code)))
						DPRINTK("error on dir_read_log: %02X\n",
							(int)readb(ti->srb+offsetof(struct srb_read_log, ret_code)));
					else
						DPRINTK(
							"Line errors %02X, Internal errors %02X, Burst errors %02X\n"
							"A/C errors %02X, Abort delimiters %02X, Lost frames %02X\n"
							"Receive congestion count %02X, Frame copied errors %02X\n"
							"Frequency errors %02X, Token errors %02X\n",
							(int)readb(ti->srb+offsetof(struct srb_read_log, 
										    line_errors)),
							(int)readb(ti->srb+offsetof(struct srb_read_log, 
										    internal_errors)),
							(int)readb(ti->srb+offsetof(struct srb_read_log, 
										    burst_errors)),
							(int)readb(ti->srb+offsetof(struct srb_read_log, A_C_errors)),
							(int)readb(ti->srb+offsetof(struct srb_read_log, 
										    abort_delimiters)),
							(int)readb(ti->srb+offsetof(struct srb_read_log, 
										    lost_frames)),
							(int)readb(ti->srb+offsetof(struct srb_read_log, 
												    recv_congest_count)),
							(int)readb(ti->srb+offsetof(struct srb_read_log, 
										    frame_copied_errors)),
							(int)readb(ti->srb+offsetof(struct srb_read_log, 
										    frequency_errors)),
							(int)readb(ti->srb+offsetof(struct srb_read_log, 
												    token_errors)));
					dev->tbusy=0;
					break;
 
				      default:
					DPRINTK("Unknown command %02X encountered\n",
						(int)readb(ti->srb));
 
				} /* SRB command check */
 
				writeb(~CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_RESET + ISRA_ODD);
				writeb(~SRB_RESP_INT, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_ODD);
 
			  skip_reset:
			} /* SRB response */
 
			if (status & ASB_FREE_INT) { /* ASB response */
 
				switch(readb(ti->asb)) { /* ASB command check */
 
				      case REC_DATA:
				      case XMIT_UI_FRAME:
				      case XMIT_DIR_FRAME:
					break;
 
				      default:
					DPRINTK("unknown command in asb %02X\n",
						(int)readb(ti->asb));
 
				} /* ASB command check */
 
				if (readb(ti->asb+2)!=0xff) /* checks ret_code */
				    DPRINTK("ASB error %02X in cmd %02X\n", 
					    (int)readb(ti->asb+2),(int)readb(ti->asb));
				writeb(~ASB_FREE_INT, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_ODD);
 
			} /* ASB response */
 
			if (status & ARB_CMD_INT) { /* ARB response */
 
				switch (readb(ti->arb)) { /* ARB command check */
 
				      case DLC_STATUS:
					DPRINTK("DLC_STATUS new status: %02X on station %02X\n", 
						ntohs(readw(ti->arb + offsetof(struct arb_dlc_status, status))),
						ntohs(readw(ti->arb 
									    +offsetof(struct arb_dlc_status, station_id))));
					break;
 
				      case REC_DATA:
					tr_rx(dev);
					break;
 
				      case RING_STAT_CHANGE: {
					      unsigned short ring_status;
 
					      ring_status=ntohs(readw(ti->arb
								      +offsetof(struct arb_ring_stat_change, ring_status)));
 
					      if (ring_status & (SIGNAL_LOSS | LOBE_FAULT)) {
 
						      DPRINTK("Signal loss/Lobe fault\n");
						      DPRINTK("We try to reopen the adapter.\n");	
						      tr_timer.expires=jiffies+TR_RETRY_INTERVAL;
						      tr_timer.data=(unsigned long)dev;
						      tr_timer.next=tr_timer.prev=NULL;
						      add_timer(&tr_timer);
 
					      } else if (ring_status & (HARD_ERROR | XMIT_BEACON 
											| AUTO_REMOVAL | REMOVE_RECV | RING_RECOVER))
						      DPRINTK("New ring status: %02X\n", ring_status);
 
					      if (ring_status & LOG_OVERFLOW) {
						      if (dev->tbusy)
                                                              ti->readlog_pending = 1;
						      else
                                                              tr_readlog(dev);
					      }
				      }
				      break;
 
				      case XMIT_DATA_REQ:
					tr_tx(dev);
					break;
 
				      default:
					DPRINTK("Unknown command %02X in arb\n", 
						(int)readb(ti->arb));
					break;
 
				} /* ARB command check */
 
				writeb(~ARB_CMD_INT, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_ODD);
				writeb(ARB_FREE, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
 
			} /* ARB response */
 
			if (status & SSB_RESP_INT) { /* SSB response */
				unsigned char retcode;		
				switch (readb(ti->ssb)) { /* SSB command check */
 
				      case XMIT_DIR_FRAME:
				      case XMIT_UI_FRAME:
					retcode = readb(ti->ssb+2);
					if (retcode && (retcode != 0x22)) /* checks ret_code */
						DPRINTK("xmit ret_code: %02X xmit error code: %02X\n", 
							(int)retcode, (int)readb(ti->ssb+6));		
					else ti->tr_stats.tx_packets++;
					break;
 
				      case XMIT_XID_CMD:
					DPRINTK("xmit xid ret_code: %02X\n", (int)readb(ti->ssb+2));
 
				      default:
					DPRINTK("Unknown command %02X in ssb\n", (int)readb(ti->ssb));
 
				} /* SSB command check */
 
				writeb(~SSB_RESP_INT, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_ODD);
				writeb(SSB_FREE, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
 
			} /* SSB response */
 
		}	 /* SRB, ARB, ASB or SSB response */
 
		dev->interrupt=0;
		writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
		break;
 
	      case FIRST_INT:
		initial_tok_int(dev);
		break;
 
	      default:
		DPRINTK("Unexpected interrupt from tr adapter\n");
 
	}
}
 
static void initial_tok_int(struct device *dev) 
{
 
	__u32 encoded_addr;
	__u32 hw_encoded_addr;
	struct tok_info *ti;
 
	ti=(struct tok_info *) dev->priv;
 
	writeb(~INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
 
	/* Reset interrupt for ISA boards */
	if (ti->global_int_enable) outb(0,ti->global_int_enable);
 
	ti->do_tok_int=NOT_FIRST;
 
#ifndef TR_NEWFORMAT
	DPRINTK("Initial tok int received\n");
#endif
 
	/* we assign the address for ISA devices; set RRR even to D000 for 
	   shared RAM address */
	if(!ti->sram) {
		writeb(ti->sram_base, ti->mmio + ACA_OFFSET + ACA_RW + RRR_EVEN);
		ti->sram=((__u32)ti->sram_base << 12);
	}
	ti->init_srb=ti->sram
		+ntohs((unsigned short)readw(ti->mmio+ ACA_OFFSET + WRBR_EVEN));
	SET_PAGE(ntohs((unsigned short)readw(ti->mmio+ACA_OFFSET + WRBR_EVEN)));
 
#if TR_VERBOSE
	{
		int i;
		DPRINTK("init_srb(%p):", ti->init_srb);
		for (i=0;i<17;i++) printk("%02X ", (int)readb(ti->init_srb+i));
		printk("\n");
	}
#endif
 
	hw_encoded_addr = readw(ti->init_srb 
				+ offsetof(struct srb_init_response, encoded_address));
 
#if !TR_NEWFORMAT		
	DPRINTK("srb_init_response->encoded_address: %04X\n", hw_encoded_addr);
	DPRINTK("ntohs(srb_init_response->encoded_address): %04X\n",
		ntohs(hw_encoded_addr));
#endif
 
	encoded_addr=(ti->sram + ntohs(hw_encoded_addr));
 
#if !TR_NEWFORMAT
	DPRINTK("encoded addr (%04X,%04X,%08X): ", hw_encoded_addr, 
		ntohs(hw_encoded_addr), encoded_addr);
#else
	DPRINTK("Initial interrupt : shared RAM located at %08X.\n", encoded_addr);
#endif	
 
	ti->auto_ringspeedsave=readb(ti->init_srb
				     +offsetof(struct srb_init_response, init_status_2)) & 0x4 ? TRUE : FALSE;
 
#if !TR_NEWFORMAT
	for(i=0;i<TR_ALEN;i++) {
		dev->dev_addr[i]=readb(encoded_addr + i);
		printk("%02X%s", dev->dev_addr[i], (i==TR_ALEN-1) ? "" : ":" );
	}
	printk("\n");
#endif
 
	tok_open_adapter((unsigned long)dev);
}
 
static int tok_init_card(struct device *dev) 
{
	struct tok_info *ti;
	short PIOaddr;
	int i;
	PIOaddr = dev->base_addr;
	ti=(struct tok_info *) dev->priv;
 
	/* Special processing for first interrupt after reset */
	ti->do_tok_int=FIRST_INT;
 
	/* Reset adapter */
	dev->tbusy=1; /* nothing can be done before reset and open completed */
 
#ifdef ENABLE_PAGING
	if(ti->page_mask)
		writeb(SRPR_ENABLE_PAGING, ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
#endif
 
	writeb(~INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
 
#if !TR_NEWFORMAT
	DPRINTK("resetting card\n");
#endif
 
	outb(0, PIOaddr+ADAPTRESET);
	for (i=jiffies+TR_RESET_INTERVAL; jiffies<=i;); /* wait 50ms */
	outb(0,PIOaddr+ADAPTRESETREL);
 
#if !TR_NEWFORMAT
	DPRINTK("card reset\n");
#endif
 
	ti->open_status=IN_PROGRESS;
	writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
	return 0;	
}
 
static void open_sap(unsigned char type,struct device *dev) 
{
	int i;
	struct tok_info *ti=(struct tok_info *) dev->priv;
 
	SET_PAGE(ti->srb);
	for (i=0; i<sizeof(struct dlc_open_sap); i++)
		writeb(0, ti->srb+i);
 
	writeb(DLC_OPEN_SAP, ti->srb + offsetof(struct dlc_open_sap, command));
	writew(htons(MAX_I_FIELD), 
	       ti->srb + offsetof(struct dlc_open_sap, max_i_field));
	writeb(SAP_OPEN_IND_SAP | SAP_OPEN_PRIORITY, 
	       ti->srb + offsetof(struct dlc_open_sap, sap_options));
	writeb(SAP_OPEN_STATION_CNT, 
	       ti->srb + offsetof(struct dlc_open_sap, station_count));
	writeb(type, ti->srb + offsetof(struct dlc_open_sap, sap_value));
 
	writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
 
}
 
void tok_open_adapter(unsigned long dev_addr) 
{
 
	struct device *dev=(struct device *)dev_addr;
	struct tok_info *ti;
	int i;
 
	ti=(struct tok_info *) dev->priv;
 
#if !TR_NEWFORMAT
	DPRINTK("now opening the board...\n");
#endif
 
	writeb(~SRB_RESP_INT, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_ODD);
	writeb(~CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_RESET + ISRA_ODD);
 
	for (i=0; i<sizeof(struct dir_open_adapter); i++)
		writeb(0, ti->init_srb+i);
 
	writeb(DIR_OPEN_ADAPTER, 
	       ti->init_srb + offsetof(struct dir_open_adapter, command));
	writew(htons(OPEN_PASS_BCON_MAC), 
	       ti->init_srb + offsetof(struct dir_open_adapter, open_options));
	writew(htons(NUM_RCV_BUF), 
	       ti->init_srb + offsetof(struct dir_open_adapter, num_rcv_buf));
	writew(htons(RCV_BUF_LEN), 
	       ti->init_srb + offsetof(struct dir_open_adapter, rcv_buf_len));
	writew(htons(DHB_LENGTH), 
	       ti->init_srb + offsetof(struct dir_open_adapter, dhb_length));
	writeb(NUM_DHB, 
	       ti->init_srb + offsetof(struct dir_open_adapter, num_dhb));
	writeb(DLC_MAX_SAP, 
	       ti->init_srb + offsetof(struct dir_open_adapter, dlc_max_sap));
	writeb(DLC_MAX_STA, 
	       ti->init_srb + offsetof(struct dir_open_adapter, dlc_max_sta));
 
	ti->srb=ti->init_srb; /* We use this one in the interrupt handler */
 
	writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
	writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
 
}
 
static void tr_tx(struct device *dev) 
{
	struct tok_info *ti=(struct tok_info *) dev->priv;
	struct trh_hdr *trhdr=(struct trh_hdr *)ti->current_skb->data;
	unsigned int hdr_len;
	__u32 dhb;
	unsigned char xmit_command;
	int i;
	struct trllc	*llc;
 
	if (readb(ti->asb + offsetof(struct asb_xmit_resp, ret_code))!=0xFF)
		DPRINTK("ASB not free !!!\n");
 
	/* in providing the transmit interrupts,
	   is telling us it is ready for data and
	   providing a shared memory address for us
	   to stuff with data.  Here we compute the
	   effective address where we will place data.*/
	dhb=ti->sram 
		+ntohs(readw(ti->arb + offsetof(struct arb_xmit_req, dhb_address)));
	llc = (struct trllc *) &(ti->current_skb->data[sizeof(struct trh_hdr)]);
 
	xmit_command = readb(ti->srb + offsetof(struct srb_xmit, command));
 
	writeb(xmit_command, ti->asb + offsetof(struct asb_xmit_resp, command));
	writew(readb(ti->srb + offsetof(struct srb_xmit, station_id)),
	       ti->asb + offsetof(struct asb_xmit_resp, station_id));
	writeb(llc->ssap, ti->asb + offsetof(struct asb_xmit_resp, rsap_value));
	writeb(readb(ti->srb + offsetof(struct srb_xmit, cmd_corr)),
	       ti->asb + offsetof(struct asb_xmit_resp, cmd_corr));
	writeb(0, ti->asb + offsetof(struct asb_xmit_resp, ret_code));
 
	if ((xmit_command==XMIT_XID_CMD) || (xmit_command==XMIT_TEST_CMD)) {
 
		writew(htons(0x11), 
		       ti->asb + offsetof(struct asb_xmit_resp, frame_length));
		writeb(0x0e, ti->asb + offsetof(struct asb_xmit_resp, hdr_length));
		writeb(AC, dhb);
		writeb(LLC_FRAME, dhb+1);
 
		for (i=0; i<TR_ALEN; i++) writeb((int)0x0FF, dhb+i+2);
		for (i=0; i<TR_ALEN; i++) writeb(0, dhb+i+TR_ALEN+2);
 
		writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
		return;
 
	}
 
	/* the token ring packet is copied from sk_buff to the adapter
	   buffer identified in the command data received with the
	   interrupt.  The sk_buff area was set up with a maximum
	   sized route information field so here we must compress
	   out the extra (all) rif fields.   */
	/* nb/dwm .... I re-arranged code here to avoid copy of extra
	   bytes, ended up with fewer statements as well. */
 
	/* TR arch. identifies if RIF present by high bit of source
	   address.  So here we check if RIF present */
 
	if (!(trhdr->saddr[0] & 0x80)) { /* RIF present : preserve it */
		hdr_len=sizeof(struct trh_hdr)-18;
 
#if TR_VERBOSE
		DPRINTK("hdr_length: %d, frame length: %ld\n", hdr_len,
			ti->current_skb->len-18);
#endif
	} else hdr_len=((ntohs(trhdr->rcf) & TR_RCF_LEN_MASK)>>8)
		  +sizeof(struct trh_hdr)-18;
 
	/* header length including rif is computed above, now move the data
	   and set fields appropriately. */
	for (i=0; i<hdr_len; i++)
		writeb(*(unsigned char *)(ti->current_skb->data +i), dhb++);
 
	writeb(hdr_len, ti->asb + offsetof(struct asb_xmit_resp, hdr_length));
	writew(htons(ti->current_skb->len-sizeof(struct trh_hdr)+hdr_len),
	       ti->asb + offsetof(struct asb_xmit_resp, frame_length));
 
	/*  now copy the actual packet data next to hdr */
	for (i=0; i<ti->current_skb->len-sizeof(struct trh_hdr); i++)
		writeb(*(unsigned char *)(ti->current_skb->data +sizeof(struct trh_hdr)+i),
		       dhb+i);
 
	writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
	dev->tbusy=0;
	dev_kfree_skb(ti->current_skb,FREE_WRITE);
	ti->current_skb=NULL;
	mark_bh(NET_BH);
	if (ti->readlog_pending) tr_readlog(dev);
}
 
static void tr_rx(struct device *dev) 
{
	int i;
	struct tok_info *ti=(struct tok_info *) dev->priv;
	__u32 rbuffer;	
	__u32 llc;
	unsigned char *data;
	unsigned int rbuffer_len, lan_hdr_len;
	unsigned int arb_frame_len;
	struct sk_buff *skb;
	unsigned int skb_size = 0;
	int	is8022 = 0;
 
	rbuffer=(ti->sram
		 +ntohs(readw(ti->arb + offsetof(struct arb_rec_req, rec_buf_addr))));
 
	if(readb(ti->asb + offsetof(struct asb_rec, ret_code))!=0xFF)
		DPRINTK("ASB not free !!!\n");
 
	writeb(REC_DATA, 
	       ti->asb + offsetof(struct asb_rec, command));
	writew(readw(ti->arb + offsetof(struct arb_rec_req, station_id)),
	       ti->asb + offsetof(struct asb_rec, station_id));
	writew(readw(ti->arb + offsetof(struct arb_rec_req, rec_buf_addr)),
	       ti->asb + offsetof(struct asb_rec, rec_buf_addr));
 
	lan_hdr_len=readb(ti->arb + offsetof(struct arb_rec_req, lan_hdr_len));
 
	llc=(rbuffer+offsetof(struct rec_buf, data) + lan_hdr_len);
 
#if TR_VERBOSE
	DPRINTK("offsetof data: %02X lan_hdr_len: %02X\n",
		(unsigned int)offsetof(struct rec_buf,data), (unsigned int)lan_hdr_len);
	DPRINTK("llc: %08X rec_buf_addr: %04X ti->sram: %p\n", llc,
		ntohs(readw(ti->arb + offsetof(struct arb_rec_req, rec_buf_addr))), 
		ti->sram);
	DPRINTK("dsap: %02X, ssap: %02X, llc: %02X, protid: %02X%02X%02X, "
		"ethertype: %04X\n",
		(int)readb(llc + offsetof(struct trllc, dsap)),
		(int)readb(llc + offsetof(struct trllc, ssap)),
		(int)readb(llc + offsetof(struct trllc, protid)),
		(int)readb(llc + offsetof(struct trllc, protid)+1),
		(int)readb(llc + offsetof(struct trllc, protid)+2),
		(int)readw(llc + offsetof(struct trllc, ethertype)));
#endif
 
	if (readb(llc + offsetof(struct trllc, llc))!=UI_CMD) {
#if !TR_FILTERNONUI		
		DPRINTK("non-UI frame arrived. dropped. llc= %02X\n",
			(int)readb(llc + offsetof(struct trllc, llc))
#endif
			writeb(DATA_LOST, ti->asb + offsetof(struct asb_rec, ret_code));
			ti->tr_stats.rx_dropped++;
			writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
			return;
			}
 
		if ((readb(llc + offsetof(struct trllc, dsap))!=0xAA) ||
		    (readb(llc + offsetof(struct trllc, ssap))!=0xAA)) {
			is8022 = 1;
		}
 
#if TR_VERBOSE
		if ((readb(llc + offsetof(struct trllc, dsap))!=0xAA) ||
		    (readb(llc + offsetof(struct trllc, ssap))!=0xAA)) {
 
			__u32 trhhdr;
 
			trhhdr=(rbuffer+offsetof(struct rec_buf,data));
 
			DPRINTK("Probably non-IP frame received.\n");
			DPRINTK("ssap: %02X dsap: %02X saddr: %02X:%02X:%02X:%02X:%02X:%02X "
				"daddr: %02X:%02X:%02X:%02X:%02X:%02X\n",
				(int)readb(llc + offsetof(struct trllc, ssap)),
				(int)readb(llc + offsetof(struct trllc, dsap)),
				(int)readb(trhhdr + offsetof(struct trh_hdr, saddr)),
				(int)readb(trhhdr + offsetof(struct trh_hdr, saddr)+1),
				(int)readb(trhhdr + offsetof(struct trh_hdr, saddr)+2),
				(int)readb(trhhdr + offsetof(struct trh_hdr, saddr)+3),
				(int)readb(trhhdr + offsetof(struct trh_hdr, saddr)+4),
				(int)readb(trhhdr + offsetof(struct trh_hdr, saddr)+5),
				(int)readb(trhhdr + offsetof(struct trh_hdr, daddr)),
				(int)readb(trhhdr + offsetof(struct trh_hdr, daddr)+1),
				(int)readb(trhhdr + offsetof(struct trh_hdr, daddr)+2),
				(int)readb(trhhdr + offsetof(struct trh_hdr, daddr)+3),
				(int)readb(trhhdr + offsetof(struct trh_hdr, daddr)+4),
				(int)readb(trhhdr + offsetof(struct trh_hdr, daddr)+5));
		}
#endif
 
		arb_frame_len=ntohs(readw(ti->arb+offsetof(struct arb_rec_req, frame_len)));
		skb_size = arb_frame_len-lan_hdr_len+sizeof(struct trh_hdr);
		if (is8022) {
			skb_size += sizeof(struct trllc);
		}
 
		if (!(skb=dev_alloc_skb(skb_size))) {
			DPRINTK("out of memory. frame dropped.\n");	
			ti->tr_stats.rx_dropped++;
			writeb(DATA_LOST, ti->asb + offsetof(struct asb_rec, ret_code));
			writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
			return;
		}
 
		skb_put(skb, skb_size);
		skb->dev=dev;
 
		data=skb->data;
		for (i=0; i<lan_hdr_len; i++) 
			data[i]=readb(rbuffer + offsetof(struct rec_buf, data)+i);
 
		if (lan_hdr_len<sizeof(struct trh_hdr))
			memset(data+lan_hdr_len, 0, sizeof(struct trh_hdr)-lan_hdr_len);
 
		data+=sizeof(struct trh_hdr);
		rbuffer_len=ntohs(readw(rbuffer + offsetof(struct rec_buf, buf_len)))
			-lan_hdr_len;
		if (is8022) {
			struct trllc	*local_llc = (struct trllc *)data;
			memset(local_llc, 0, sizeof(*local_llc));
			local_llc->ethertype = htons(ETH_P_TR_802_2);
			data += sizeof(struct trllc);
		}
 
#if TR_VERBOSE
		DPRINTK("rbuffer_len: %d, data: %p\n", rbuffer_len, data);
#endif
 
		for (i=0; i<rbuffer_len; i++)
			data[i]=readb(rbuffer+ offsetof(struct rec_buf, data)+lan_hdr_len+i);
		data+=rbuffer_len;
 
		while (readw(rbuffer + offsetof(struct rec_buf, buf_ptr))) {
			rbuffer=(ti->sram
				 +ntohs(readw(rbuffer + offsetof(struct rec_buf, buf_ptr)))-2);
			rbuffer_len=ntohs(readw(rbuffer + offsetof(struct rec_buf, buf_len)));
			for (i=0; i<rbuffer_len; i++)
				data[i]=readb(rbuffer + offsetof(struct rec_buf, data)+i);
			data+=rbuffer_len;
 
#if TR_VERBOSE
			DPRINTK("buf_ptr: %d, data =%p\n", 
				ntohs((rbuffer + offsetof(struct rec_buf, buf_ptr))), data);
#endif
		} 
 
		writeb(0, ti->asb + offsetof(struct asb_rec, ret_code));
 
		writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
 
		ti->tr_stats.rx_packets++;
 
		skb->protocol=tr_type_trans(skb,dev);
		netif_rx(skb);
 
	}
 
static int tok_send_packet(struct sk_buff *skb, struct device *dev) 
{
	struct tok_info *ti;
	ti=(struct tok_info *) dev->priv;
 
	if (dev->tbusy) {
		int ticks_waited;
 
		ticks_waited=jiffies - dev->trans_start;
		if (ticks_waited<TR_BUSY_INTERVAL) return 1;
 
		DPRINTK("Arrg. Transmitter busy for more than 50 msec. "
			"Donald resets adapter, but resetting\n"
			"the IBM tokenring adapter takes a long time."
			" It might not even help when the\n"
			"ring is very busy, so we just wait a little longer "
			"and hope for the best.\n");		
		dev->trans_start+=5; /* we fake the transmission start time... */
		return 1;
	}
 
	/* Donald does this, so we do too. */
	if (skb==NULL) {
		dev_tint(dev);
		return 0;
	}
 
	if (set_bit(0,(void *)&dev->tbusy)!=0) {
		dev_kfree_skb(skb, FREE_WRITE);
		DPRINTK("Transmitter access conflict\n");
	} else {
		/* Save skb; we'll need it when the adapter asks for the data */
		ti->current_skb=skb; 
		writeb(XMIT_UI_FRAME, ti->srb + offsetof(struct srb_xmit, command));
		writew(ti->exsap_station_id, ti->srb 
		       +offsetof(struct srb_xmit, station_id));
		writeb(CMD_IN_SRB, (ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD));
		dev->trans_start=jiffies;
	}
 
	return 0;
}
 
void tr_readlog(struct device *dev) {
	 struct tok_info *ti;
	 ti=(struct tok_info *) dev->priv;
 
	 ti->readlog_pending = 0;
	 writeb(DIR_READ_LOG, ti->srb);
	 writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
	 writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
	 dev->tbusy=1; /* really srb busy... */
}
 
/* tok_get_stats():  Basically a scaffold routine which will return
   the address of the tr_statistics structure associated with
   this device -- the tr.... structure is a ethnet look-alike
   so at least for this iteration may suffice.   */
 
static struct enet_statistics * tok_get_stats(struct device *dev) {
 
	struct tok_info *toki;
	toki=(struct tok_info *) dev->priv;
	return (struct enet_statistics *) &toki->tr_stats;
}
 
#ifdef MODULE
 
 
static char devicename[9] = { 0, };
static struct device dev_ibmtr = {
	devicename, /* device name is inserted by linux/drivers/net/net_init.c */
	0, 0, 0, 0,
	0, 0,
	0, 0, 0, NULL, tok_probe };
 
static int io = 0xa20;
static char *device = NULL;
 
int init_module(void)
{
	if (device)
		strcpy(dev_ibmtr.name,device);
	else if (!dev_ibmtr.name[0]) strcpy(dev_ibmtr.name,"tr0");
 
	if (io == 0) 
		printk("ibmtr: You should not use auto-probing with insmod!\n");
	dev_ibmtr.base_addr = io;
	dev_ibmtr.irq       = 0;
 
	if (register_netdev(&dev_ibmtr) != 0) {
		printk("ibmtr: No adapters were found.\n");
		return -EIO;
	}
	return 0;
}
 
void cleanup_module(void)
{
	unregister_netdev(&dev_ibmtr);
 
	/* If we don't do this, we can't re-insmod it later. */
	free_irq(dev_ibmtr.irq, NULL);
	irq2dev_map[dev_ibmtr.irq] = NULL;
	release_region(dev_ibmtr.base_addr, TR_IO_EXTENT);
}
#endif /* MODULE */
 

Go to most recent revision | Compare with Previous | Blame | View Log

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.