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

Subversion Repositories or1k

[/] [or1k/] [trunk/] [rc203soc/] [sw/] [uClinux/] [drivers/] [net/] [smc91111.c] - Rev 1765

Compare with Previous | Blame | View Log

/*------------------------------------------------------------------------
 . smc91111.c
 . This is a driver for SMSC's 91C111 single-chip Ethernet device.
 .
 . Copyright (C) 2001 Standard Microsystems Corporation (SMSC)
 .       Developed by Simple Network Magic Corporation (SNMC)
 . Copyright (C) 1996 by Erik Stahlman (ES)
 .
 . 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.
 .
 . This program is distributed in the hope that it will be useful,
 . but WITHOUT ANY WARRANTY; without even the implied warranty of
 . MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 . GNU General Public License for more details.
 .
 . You should have received a copy of the GNU General Public License
 . along with this program; if not, write to the Free Software
 . Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 .
 . Information contained in this file was obtained from the LAN91C111
 . manual from SMC.  To get a copy, if you really want one, you can find 
 . information under www.smsc.com.
 . 
 .
 . "Features" of the SMC chip:
 .   Integrated PHY/MAC for 10/100BaseT Operation
 .   Supports internal and external MII
 .   Integrated 8K packet memory
 .   EEPROM interface for configuration
 .
 . Arguments:
 . 	io	= for the base address
 .	irq	= for the IRQ
 .	nowait	= 0 for normal wait states, 1 eliminates additional wait states
 .
 . author:
 . 	Erik Stahlman				( erik@vt.edu )
 . 	Daris A Nevil				( dnevil@snmc.com )
 .      Kendrick Hamilton                       ( hamilton@sedsystems.ca )
 .
 .
 . Hardware multicast code from Peter Cammaert ( pc@denkart.be )
 .
 . Sources:
 .    o   SMSC LAN91C111 databook (www.smsc.com)
 .    o   smc9194.c by Erik Stahlman
 .    o   skeleton.c by Donald Becker ( becker@cesdis.gsfc.nasa.gov )
 .
 . History:
 .	04/25/01  Daris A Nevil  Initial public release through SMSC
 .	03/16/01  Daris A Nevil  Modified smc9194.c for use with LAN91C111
 .	03/06/02  Greg Ungerer	 Code to support ColdFire (M5249C3 board)
 ----------------------------------------------------------------------------*/
 
// Use power-down feature of the chip
#define POWER_DOWN   0
#define NO_AUTOPROBE 1
 
//Should be part of the automatic configuration
#define CONFIG_SMC91C111_EXTRA_DELAY 1
// Do you want to use 32 bit xfers?  This should work on all chips, as
// the chipset is designed to accommodate them.
 
/*OpenRISC 1200 uses 16 bits*/
#undef CONFIG_SMC91C111_32_BIT 
 
#if defined(CONFIG_SMC91C111_EXTRA_DELAY)
#define SMC91C111_EXTRA_DELAY 20
#endif
 
static const char version[] =
    "smc91111.c:v1.2 01/29/02 by ???\n";
 
 
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/types.h>
#include <linux/fcntl.h>
#include <linux/interrupt.h>
#include <linux/ptrace.h>
#include <linux/ioport.h>
#include <linux/in.h>
#include <linux/malloc.h>
#include <linux/string.h>
#include <asm/bitops.h>
 
#include <asm/io.h>
 
#include <asm/irq.h>
 
#include <linux/errno.h>
#include <linux/delay.h>
 
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/skbuff.h>
 
//#define CONFIG_SYSCTL 1
 
#ifdef SMC_DEBUG
#undef SMC_DEBUG
#endif
 
#ifdef CONFIG_SYSCTL
#include <linux/proc_fs.h>
#include <linux/sysctl.h>
#endif
 
#include "smc91111.h"
 
//------------------------------------------------------------------------
//
// Configuration options, for the experienced user to change.
//
//------------------------------------------------------------------------
 
 
/*
 .the LAN91C111 can be at any of the following port addresses.  To change,
 .for a slightly different card, you can add it to the array.  Keep in
 .mind that the array must end in zero.
*/
 
static unsigned long int smc_portlist[] =
   { 0x92000000, 0};
 
#define SWAP16(x)  ((((x) & 0x00ff) << 8) | ( (x) >> 8))
 
/*
 . Wait time for memory to be free.  This probably shouldn't be
 . tuned that much, as waiting for this means nothing else happens
 . in the system
*/
#define MEMORY_WAIT_TIME 16
 
/*
 . DEBUGGING LEVELS
 .
 . 0 for normal operation
 . 1 for slightly more details
 . >2 for various levels of increasingly useless information
 .    2 for interrupt tracking, status flags
 .    3 for packet info
 .    4 for complete packet dumps
*/
#define SMC_DEBUG 0 // Must be defined in makefile
 
#if (SMC_DEBUG > 2 )
#define PRINTK3(args...) printk(args)
#else
#define PRINTK3(args...)
#endif
 
#if SMC_DEBUG > 1
#define PRINTK2(args...) printk(args)
#else
#define PRINTK2(args...)
#endif
 
#ifdef SMC_DEBUG
#define PRINTK(args...) printk(args)
#else
#define PRINTK(args...)
#endif
 
 
/*------------------------------------------------------------------------
 .
 . The internal workings of the driver.  If you are changing anything
 . here with the SMC stuff, you should have the datasheet and know
 . what you are doing.
 .
 -------------------------------------------------------------------------*/
#define CARDNAME "LAN91C111"
 
// Memory sizing constant
#define LAN91C111_MEMORY_MULTIPLIER	(1024*2)
 
/* store this information for the driver.. */
struct smc_local {
 
 	// these are things that the kernel wants me to keep, so users
	// can find out semi-useless statistics of how well the card is
	// performing
	//struct net_device_stats stats;
	struct enet_statistics stats;
 
	// If I have to wait until memory is available to send
	// a packet, I will store the skbuff here, until I get the
	// desired memory.  Then, I'll send it out and free it.
	struct sk_buff * saved_skb;
 
 	// This keeps track of how many packets that I have
 	// sent out.  When an TX_EMPTY interrupt comes, I know
	// that all of these have been sent.
	int	packets_waiting;
 
	// Set to true during the auto-negotiation sequence
	int	autoneg_active;
 
	// Address of our PHY port
	word	phyaddr;
 
	// Type of PHY
	word	phytype;
 
	// Last contents of PHY Register 18
	word	lastPhy18;
 
	// Contains the current active transmission mode
	word	tcr_cur_mode;
 
	// Contains the current active receive mode
	word	rcr_cur_mode;
 
	// Contains the current active receive/phy mode
	word	rpc_cur_mode;
 
 
#ifdef CONFIG_SYSCTL
 
	// Root directory /proc/sys/dev
	// Second entry must be null to terminate the table
	ctl_table root_table[2];
 
	// Directory for this device /proc/sys/dev/ethX
	// Again the second entry must be zero to terminate
	ctl_table eth_table[2];
 
	// This is the parameters (file) table
	ctl_table param_table[CTL_SMC_LAST_ENTRY];
 
	// Saves the sysctl header returned by register_sysctl_table()
	// we send this to unregister_sysctl_table()
	struct ctl_table_header *sysctl_header;
 
	// Parameter variables (files) go here
	char ctl_info[1024];
	int ctl_swfdup;
	int ctl_ephloop;
	int ctl_miiop;
	int ctl_autoneg;
	int ctl_rfduplx;
	int ctl_rspeed;
	int ctl_afduplx;
	int ctl_aspeed;
	int ctl_lnkfail;
	int ctl_forcol;
	int ctl_filtcar;
	int ctl_freemem;
	int ctl_totmem;
	int ctl_leda;
	int ctl_ledb;
	int ctl_chiprev;
#ifdef SMC_DEBUG
	int ctl_reg_bsr;
	int ctl_reg_tcr;
	int ctl_reg_esr;
	int ctl_reg_rcr;
	int ctl_reg_ctrr;
	int ctl_reg_mir;
	int ctl_reg_rpcr;
	int ctl_reg_cfgr;
	int ctl_reg_bar;
	int ctl_reg_iar0;
	int ctl_reg_iar1;
	int ctl_reg_iar2;
	int ctl_reg_gpr;
	int ctl_reg_ctlr;
	int ctl_reg_mcr;
	int ctl_reg_pnr;
	int ctl_reg_fpr;
	int ctl_reg_ptr;
	int ctl_reg_dr;
	int ctl_reg_isr;
	int ctl_reg_mtr1;
	int ctl_reg_mtr2;
	int ctl_reg_mtr3;
	int ctl_reg_mtr4;
	int ctl_reg_miir;
	int ctl_reg_revr;
	int ctl_reg_ercvr;
	int ctl_reg_extr;
	int ctl_phy_ctrl;
	int ctl_phy_stat;
	int ctl_phy_id1;
	int ctl_phy_id2;
	int ctl_phy_adc;
	int ctl_phy_remc;
	int ctl_phy_cfg1;
	int ctl_phy_cfg2;
	int ctl_phy_int;
	int ctl_phy_mask;
#endif // SMC_DEBUG
 
 
#endif // CONFIG_SYSCTL
 
};
 
 
/*-----------------------------------------------------------------
 .
 .  The driver can be entered at any of the following entry points.
 .
 .------------------------------------------------------------------  */
 
/*
 . This is called by  register_netdev().  It is responsible for
 . checking the portlist for the SMC9000 series chipset.  If it finds
 . one, then it will initialize the device, find the hardware information,
 . and sets up the appropriate device parameters.
 . NOTE: Interrupts are *OFF* when this procedure is called.
 .
 . NB:This shouldn't be static since it is referred to externally.
*/
int smc_init_91C111(struct device *dev);
 
/*
 . This is called by  unregister_netdev().  It is responsible for
 . cleaning up before the driver is finally unregistered and discarded.
*/
void smc_91C111_destructor(struct device *dev);
 
/*
 . The kernel calls this function when someone wants to use the device,
 . typically 'ifconfig ethX up'.
*/
static int smc_open(struct device *dev);
 
/*
 . This is called by the kernel to send a packet out into the net.  it's
 . responsible for doing a best-effort send, but if it's simply not possible
 . to send it, the packet gets dropped.
*/
static int smc_send_packet(struct sk_buff *skb, struct device *dev);
 
/*
 . This is called by the kernel in response to 'ifconfig ethX down'.  It
 . is responsible for cleaning up everything that the open routine
 . does, and maybe putting the card into a powerdown state.
*/
static int smc_close(struct device *dev);
 
/*
 . This routine allows the proc file system to query the driver's
 . statistics.
*/
static struct enet_statistics * smc_query_statistics( struct device *dev);
 
/*
 . Finally, a call to set promiscuous mode ( for TCPDUMP and related
 . programs ) and multicast modes.
*/
static void smc_set_multicast_list(struct device *dev);
 
/*
 . Configures the PHY through the MII Management interface
*/
static void smc_phy_configure(struct device* dev);
 
void smc_register_dump(const struct device *dev);
 
/*---------------------------------------------------------------
 .
 . Interrupt level calls..
 .
 ----------------------------------------------------------------*/
 
/*
 . Handles the actual interrupt
*/
static void smc_interrupt(int irq, void *, struct pt_regs *regs);
/*
 . This is a separate procedure to handle the receipt of a packet, to
 . leave the interrupt code looking slightly cleaner
*/
inline static void smc_rcv( struct device *dev );
/*
 . This handles a TX interrupt, which is only called when an error
 . relating to a packet is sent.
*/
inline static void smc_tx( struct device * dev );
 
/*
 . This handles interrupts generated from PHY register 18
*/
static void smc_phy_interrupt(struct device* dev);
 
/*
 ------------------------------------------------------------
 .
 . Internal routines
 .
 ------------------------------------------------------------
*/
 
/*
 . Test if a given location contains a chip, trying to cause as
 . little damage as possible if it's not a SMC chip.
*/
static int smc_probe( unsigned long ioaddr );
 
/*
 . this routine initializes the cards hardware, prints out the configuration
 . to the system log as well as the vanity message, and handles the setup
 . of a device parameter.
 . It will give an error if it can't initialize the card.
*/
static int smc_initcard( struct device *, unsigned long ioaddr );
static void smc_wait_ms(unsigned int ms);
 
/*
 . A rather simple routine to print out a packet for debugging purposes.
*/
#if SMC_DEBUG > 2
static void print_packet( byte *, int );
#endif
 
#define tx_done(dev) 1
 
/* this is called to actually send the packet to the chip */
static void smc_hardware_send_packet( struct device * dev );
 
/* Since I am not sure if I will have enough room in the chip's ram
 . to store the packet, I call this routine, which either sends it
 . now, or generates an interrupt when the card is ready for the
 . packet */
static int  smc_wait_to_send_packet( struct sk_buff * skb, struct device *dev );
 
/* this does a soft reset on the device */
static void smc_reset( struct device* dev );
 
/* Enable Interrupts, Receive, and Transmit */
static void smc_enable( struct device *dev );
 
/* this puts the device in an inactive state */
static void smc_shutdown( unsigned long ioaddr );
 
#ifndef NO_AUTOPROBE
/* This routine will find the IRQ of the driver if one is not
 . specified in the input to the device.  */
static int smc_findirq( unsigned long ioaddr );
#endif
 
/*
  this routine will set the hardware multicast table to the specified
  values given it by the higher level routines
*/
static void smc_setmulticast( unsigned long ioaddr, int count,
        struct dev_mc_list *  );
static int crc32( char *, int );
 
/* Routines to Read and Write the PHY Registers across the
   MII Management Interface
*/
 
static word smc_read_phy_register(unsigned long ioaddr, byte phyaddr,
        byte phyreg);
static void smc_write_phy_register(unsigned long ioaddr,
	byte phyaddr, byte phyreg, word phydata);
#if 0
//Interpret the read data, only understands some registers, more need to be
// added.
static word smc_interpret_phy_register(const struct device *dev,
        byte phyreg, word status);
#endif
 
/*
  Initilizes our device's sysctl proc filesystem
*/
 
#ifdef CONFIG_SYSCTL
static void smc_sysctl_register(struct device *dev);
static void smc_sysctl_unregister(struct device *dev);
#endif /* CONFIG_SYSCTL */ 
 
/*
 . Function: smc_reset( struct device* dev )
 . Purpose:
 .  	This sets the SMC91111 chip to its normal state, hopefully from whatever
 . 	mess that any other DOS driver has put it in.
 .
 . Maybe I should reset more registers to defaults in here?  SOFTRST  should
 . do that for me.
 .
 . Method:
 .	1.  send a SOFT RESET
 .	2.  wait for it to finish
 .	3.  enable autorelease mode
 .	4.  reset the memory management unit
 .	5.  clear all interrupts
 .
*/
static void smc_reset( struct device* dev )
{
	//struct smc_local *lp 	= (struct smc_local *)dev->priv;
	unsigned long	ioaddr = dev->base_addr;
 
	PRINTK2("%s:smc_reset\n", dev->name);
 
	/* This resets the registers mostly to defaults, but doesn't
	   affect EEPROM.  That seems unnecessary */
	SMC_SELECT_BANK( 0 );
	outw( RCR_SOFTRST, ioaddr + RCR_REG );
 
	/* Setup the Configuration Register */
	/* This is necessary because the CONFIG_REG is not affected */
	/* by a soft reset */
 
	SMC_SELECT_BANK( 1 );
	outw( CONFIG_DEFAULT, ioaddr + CONFIG_REG);
 
	/* Setup for fast accesses if requested */
	/* If the card/system can't handle it then there will */
	/* be no recovery except for a hard reset or power cycle */
 
	if (dev->dma)
		outw( inw( ioaddr + CONFIG_REG ) | CONFIG_NO_WAIT,
			ioaddr + CONFIG_REG );
 
 
	SMC_SELECT_BANK( 0 );
 
	/* this should pause enough for the chip to be happy */
	mdelay(10);
 
	/* Disable transmit and receive functionality */
	outw( RCR_CLEAR, ioaddr + RCR_REG );
	outw( TCR_CLEAR, ioaddr + TCR_REG );
 
	/* set the control register to automatically
	   release successfully transmitted packets, to make the best
	   use out of our limited memory */
	SMC_SELECT_BANK( 1 );
	outw( inw( ioaddr + CTL_REG ) | CTL_AUTO_RELEASE , ioaddr + CTL_REG );
 
	/* Reset the MMU */
	SMC_SELECT_BANK( 2 );
	outw( MC_RESET, ioaddr + MMU_CMD_REG );
 
	/* Note:  It doesn't seem that waiting for the MMU busy is needed here,
	   but this is a place where future chipsets _COULD_ break.  Be wary
 	   of issuing another MMU command right after this */
 
	/* Disable all interrupts */
	outb( 0, ioaddr + IM_REG );
 
}
 
/*
 . Function: smc_enable
 . Purpose: let the chip talk to the outside work
 . Method:
 .	1.  Enable the transmitter
 .	2.  Enable the receiver
 .	3.  Enable interrupts
*/
static void smc_enable( struct device *dev )
{
	unsigned long ioaddr 	= dev->base_addr;
	struct smc_local *lp 	= (struct smc_local *)dev->priv;
 
	PRINTK2("%s:smc_enable\n", dev->name);
 
	SMC_SELECT_BANK( 0 );
	/* see the header file for options in TCR/RCR DEFAULT*/
	outw( lp->tcr_cur_mode, ioaddr + TCR_REG );
	outw( lp->rcr_cur_mode, ioaddr + RCR_REG );
 
	/* now, enable interrupts */
	SMC_SELECT_BANK( 2 );
 
	outb( SMC_INTERRUPT_MASK, ioaddr + IM_REG );
 
}
 
/*
 . Function: smc_shutdown
 . Purpose:  closes down the SMC91xxx chip.
 . Method:
 .	1. zero the interrupt mask
 .	2. clear the enable receive flag
 .	3. clear the enable xmit flags
 .
 . TODO:
 .   (1) maybe utilize power down mode.
 .	Why not yet?  Because while the chip will go into power down mode,
 .	the manual says that it will wake up in response to any I/O requests
 .	in the register space.   Empirical results do not show this working.
*/
static void smc_shutdown( unsigned long ioaddr )
{
	PRINTK2(CARDNAME":smc_shutdown\n");
 
	/* no more interrupts for me */
	SMC_SELECT_BANK( 2 );
	outb( 0, ioaddr + IM_REG );
 
	/* and tell the card to stay away from that nasty outside world */
	SMC_SELECT_BANK( 0 );
	outb( RCR_CLEAR, ioaddr + RCR_REG );
	outb( TCR_CLEAR, ioaddr + TCR_REG );
 
#ifdef POWER_DOWN
	/* finally, shut the chip down */
	SMC_SELECT_BANK( 1 );
	outw( inw( ioaddr + CONFIG_REG ) & ~CONFIG_EPH_POWER_EN,
		ioaddr + CONFIG_REG  );
#endif
}
 
 
/*
 . Function: smc_setmulticast( int ioaddr, int count, dev_mc_list * adds )
 . Purpose:
 .    This sets the internal hardware table to filter out unwanted multicast
 .    packets before they take up memory.
 .
 .    The SMC chip uses a hash table where the high 6 bits of the CRC of
 .    address are the offset into the table.  If that bit is 1, then the
 .    multicast packet is accepted.  Otherwise, it's dropped silently.
 .
 .    To use the 6 bits as an offset into the table, the high 3 bits are the
 .    number of the 8 bit register, while the low 3 bits are the bit within
 .    that register.
 .
 . This routine is based very heavily on the one provided by Peter Cammaert.
*/
 
 
static void smc_setmulticast( unsigned long ioaddr, int count,
        struct dev_mc_list * addrs )
{
	int			i;
	unsigned char		multicast_table[ 8 ];
	struct dev_mc_list	* cur_addr;
	/* table for flipping the order of 3 bits */
	unsigned char invert3[] = { 0, 4, 2, 6, 1, 5, 3, 7 };
 
	PRINTK2(CARDNAME":smc_setmulticast\n");
 
	/* start with a table of all zeros: reject all */
	memset( multicast_table, 0, sizeof( multicast_table ) );
 
	cur_addr = addrs;
	for ( i = 0; i < count ; i ++, cur_addr = cur_addr->next  ) {
		int position;
 
		/* do we have a pointer here? */
		if ( !cur_addr )
			break;
		/* make sure this is a multicast address - shouldn't this
		   be a given if we have it here ? */
		if ( !( *cur_addr->dmi_addr & 1 ) )
			continue;
 
		/* only use the low order bits */
		position = crc32( cur_addr->dmi_addr, 6 ) & 0x3f;
 
		/* do some messy swapping to put the bit in the right spot */
		multicast_table[invert3[position&7]] |=
					(1<<invert3[(position>>3)&7]);
 
	}
	/* now, the table can be loaded into the chipset */
	SMC_SELECT_BANK( 3 );
 
	for ( i = 0; i < 8 ; i++ ) {
		outb( multicast_table[i], ioaddr + MCAST_REG1 + i );
	}
 
}
 
/*
  Finds the CRC32 of a set of bytes.
  Again, from Peter Cammaert's code.
*/
static int crc32( char * s, int length ) {
	/* indices */
	int perByte;
	int perBit;
	/* crc polynomial for Ethernet */
	const unsigned long poly = 0xedb88320;
	/* crc value - preinitialized to all 1's */
	unsigned long crc_value = 0xffffffff;
 
	for ( perByte = 0; perByte < length; perByte ++ ) {
		unsigned char	c;
 
		c = *(s++);
		for ( perBit = 0; perBit < 8; perBit++ ) {
			crc_value = (crc_value>>1)^
				(((crc_value^c)&0x01)?poly:0);
			c >>= 1;
		}
	}
	return	crc_value;
}
 
 
/*
 . Function: smc_wait_to_send_packet( struct sk_buff * skb, struct device * )
 . Purpose:
 .    Attempt to allocate memory for a packet, if chip-memory is not
 .    available, then tell the card to generate an interrupt when it
 .    is available.
 .
 . Algorithm:
 .
 . o	if the saved_skb is not currently null, then drop this packet
 .	on the floor.  This should never happen, because of TBUSY.
 . o	if the saved_skb is null, then replace it with the current packet,
 . o	See if I can sending it now.
 . o 	(NO): Enable interrupts and let the interrupt handler deal with it.
 . o	(YES):Send it now.
*/
static int smc_wait_to_send_packet( struct sk_buff * skb, struct device * dev )
{
    struct          smc_local *lp   = (struct smc_local *)dev->priv;
    unsigned long   ioaddr          = dev->base_addr;
    word            length;
    unsigned short  numPages;
    word            time_out;
    word            status;
 
    PRINTK3("%s:smc_wait_to_send_packet\n", dev->name);
 
    if (lp->saved_skb)
    {
        // THIS SHOULD NEVER HAPPEN.
        lp->stats.tx_aborted_errors++;
        printk("%s: Bad Craziness - sent packet while busy.\n", dev->name);
        return 1;
    }
    lp->saved_skb = skb;
 
    length = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
 
 
    //
    // The MMU wants the number of pages to be the number of 256 bytes
    // 'pages', minus 1 ( since a packet can't ever have 0 pages :) )
    //
    // The 91C111 ignores the size bits, but the code is left intact
    // for backwards and future compatibility.
    //
    // Pkt size for allocating is data length +6 (for additional status
    // words, length and ctl!)
    //
    // If odd size then last byte is included in this header.
    //
    numPages =   ((length & 0xfffe) + 6);
    numPages >>= 8; // Divide by 256
 
    if (numPages > 7 )
    {
        printk("%s: Far too big packet error. \n", dev->name);
        // freeing the packet is a good thing here... but should
        // . any packets of this size get down here?
        dev_kfree_skb (skb,FREE_WRITE);
        lp->saved_skb = NULL;
        // this IS an error, but, i don't want the skb saved
        return 0;
    }
	// either way, a packet is waiting now
    lp->packets_waiting++;
 
    // now, try to allocate the memory
    SMC_SELECT_BANK( 2 );
    outw( MC_ALLOC | numPages, ioaddr + MMU_CMD_REG );
    //
    // Performance Hack
    //
    // wait a short amount of time.. if I can send a packet now, I send
    // it now.  Otherwise, I enable an interrupt and wait for one to be
    // available.
    //
    // I could have handled this a slightly different way, by checking to
    // see if any memory was available in the FREE MEMORY register.  However,
    // either way, I need to generate an allocation, and the allocation works
    // no matter what, so I saw no point in checking free memory.
    //
    time_out = MEMORY_WAIT_TIME;
    do
    {
        status = inb( ioaddr + INT_REG );
        time_out = time_out - 1;
    } while ((time_out > 0) && ((status & IM_ALLOC_INT) == 0));
 
    //If interrupt, acknowledge interrupt
    if(status & IM_ALLOC_INT)
    {
        outb( IM_ALLOC_INT, ioaddr + INT_REG );
    }
    else
    {
        // oh well, wait until the chip finds memory later
        SMC_ENABLE_INT( IM_ALLOC_INT );
        // Check the status bit one more time just in case
        // it snuk in between the time we last checked it
        // and when we set the interrupt bit
        status = inb( ioaddr + INT_REG );
        if ( !(status & IM_ALLOC_INT) )
        {
            PRINTK2("%s: memory allocation deferred. \n", dev->name);
            smc_register_dump(dev);
            // it's deferred, but I'll handle it later
            return 0;
        }
 
        // Looks like it did sneak in, so disable the interrupt
        SMC_DISABLE_INT( IM_ALLOC_INT );
    }
    // or YES! I can send the packet now.
    smc_hardware_send_packet(dev);
 
    return 0;
}
 
/*
 . Function:  smc_hardware_send_packet(struct device * )
 . Purpose:
 .	This sends the actual packet to the SMC9xxx chip.
 .
 . Algorithm:
 . 	First, see if a saved_skb is available.
 .		( this should NOT be called if there is no 'saved_skb'
 .	Now, find the packet number that the chip allocated
 .	Point the data pointers at it in memory
 .	Set the length word in the chip's memory
 .	Dump the packet to chip memory
 .	Check if a last byte is needed ( odd length packet )
 .		if so, set the control flag right
 . 	Tell the card to send it
 .	Enable the transmit interrupt, so I know if it failed
 . 	Free the kernel data if I actually sent it.
*/
static void smc_hardware_send_packet( struct device * dev )
{
	struct smc_local *lp = (struct smc_local *)dev->priv;
	byte	 		packet_no;
	struct sk_buff * 	skb = lp->saved_skb;
	word			length;
	unsigned long		ioaddr;
	byte			* buf;
	byte                    *bufb;
	word                    lengtht;
 
	PRINTK3("%s:smc_hardware_send_packet\n", dev->name);
 
	ioaddr = dev->base_addr;
	PRINTK3("%s:smc io address is 0x%08lx\n", dev->name, ioaddr);
 
	if ( !skb )
	{
		PRINTK("%s: In XMIT with no packet to send \n", dev->name);
		return;
	}
	length = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
	buf = skb->data;
 
	/* I can send the packet now.. */
 
	bufb = (byte *) buf;
 
	/* If I get here, I _know_ there is a packet slot waiting for me */
	packet_no = REG8( ioaddr+AR_REG);
	if (packet_no & AR_FAILED) {
		/* or isn't there?  BAD CHIP! */
		printk ("Memory allocation failed. \n");
		return;
	}
 
	/* we have a packet address, so tell the card to use it */
	REG8( ioaddr+PN_REG)=packet_no;
 
	/* point to the beginning of the packet */
	REG16( ioaddr+PTR_REG)=PTR_AUTOINC;
 
 
	/* send the packet length ( +6 for status, length and ctl byte )
	   and the status word ( set to zeros ) */
	REG16(ioaddr+DATA_REG)=0;
	/* send the packet length ( +6 for status words, length, and ctl */
	REG16(ioaddr+DATA_REG)=length + 6;
 
 
	/* send the actual data */
	lengtht=length>>1;
	while(lengtht-->0){
 	  REG16(ioaddr+DATA_REG)=SWAP16(*((word*)bufb));
	  bufb+=sizeof(word);
	}
 
 
	/* Send the last byte, if there is one.	  */
	if ((length & 1) == 0) {
		REG16(ioaddr+DATA_REG)=0;
	} else {
		REG16(ioaddr+DATA_REG)=bufb[length - 1] | 0x2000;
	}
 
	/* and let the chipset deal with it */
	REG16(ioaddr+MMU_CMD_REG)=MC_ENQUEUE;
 
 
	PRINTK2("%s: Sent packet of length %d \n", dev->name, length);
 
	lp->saved_skb = NULL;
	dev_kfree_skb (skb,FREE_WRITE);
 
	dev->trans_start = jiffies;
 
	/* we can send another packet */
	dev->tbusy = 0;
 
 
	return;
}
 
/*-------------------------------------------------------------------------
 |
 | smc_init( struct device * dev )
 |   Input parameters:
 |	dev->base_addr == 0, try to find all possible locations
 |	dev->base_addr == 1, return failure code
 |	dev->base_addr == 2, always allocate space,  and return success
 |	dev->base_addr == <anything else>   this is the address to check
 |
 |   Output:
 |	0 --> there is a device
 |	anything else, error
 |
 ---------------------------------------------------------------------------
*/
int smc_init_91C111(struct device *dev)
{
        int i;
        int base_addr = dev ? dev->base_addr : 0;
 
        PRINTK2(CARDNAME":smc_init_91C111\n");
        printk(CARDNAME":smc_init_91C111\n");
 
        /*  try a specific location */
        if (base_addr > 0x1ff)
        {
                int	error;
                error = smc_probe(base_addr);
                if ( 0 == error )
                {
                        return smc_initcard( dev, base_addr );
                }
                return error;
        }
        else
        {
                if ( 0 != base_addr )
                {
                        return -ENXIO;
                }
        }
 
        /* check every ethernet address */
        for (i = 0; smc_portlist[i]; i++)
        {
                int ioaddr = smc_portlist[i];
 
                // check if the area is available & check this specific address
                if(check_region(ioaddr , SMC_IO_EXTENT) == 0)
                {
                        if(smc_probe(ioaddr) == 0)
                                return smc_initcard(dev, ioaddr);
                        else
                                printk("<1>Error during smc probe.\n");
                }
        }
 
        // couldn't find anything
        return -ENODEV;
}
 
 
/*-------------------------------------------------------------------------
 |
 | smc_destructor( struct device * dev )
 |   Input parameters:
 |	dev, pointer to the device structure
 |
 |   Output:
 |	None.
 |
 ---------------------------------------------------------------------------
*/
void smc_91C111_destructor(struct device *dev)
{
	PRINTK2(CARDNAME":smc_91C111_destructor\n");
}
 
 
 
/*----------------------------------------------------------------------
 . Function: smc_probe( unsigned int ioaddr )
 .
 . Purpose:
 .	Tests to see if a given ioaddr points to an SMC91111 chip.
 .	Returns a 0 on success
 .
 . Algorithm:
 .	(1) see if the high byte of BANK_SELECT is 0x33
 . 	(2) compare the ioaddr with the base register's address
 .	(3) see if I recognize the chip ID in the appropriate register
 .
 .---------------------------------------------------------------------
 */
 
static int smc_probe( unsigned long ioaddr )
{
        unsigned int	bank;
        word	revision_register;
        word  base_address_register;
 
        PRINTK2(CARDNAME":smc_probe\n");
 
        SMC_SELECT_BANK(0);
 
        /* First, see if the high byte is 0x33 */
        bank = inw( ioaddr + BANK_SELECT );
        if ( (bank & 0xFF00) != 0x3300 )
        {
                printk("<1>Smc probe bank check 1 failed. %X %X\n",bank,ioaddr);
                return -ENODEV;
        }
        /* The above MIGHT indicate a device, but I need to write to further
           test this.  */
        outw( 0x0, ioaddr + BANK_SELECT );
        bank = inw( ioaddr + BANK_SELECT );
        if ( (bank & 0xFF00 ) != 0x3300 )
        {
                printk("<1>Smc probe bank check 2 failed.\n");
                return -ENODEV;
        }
#if SMC_DEBUG > 3
        PRINTK3(CARDNAME":Bank read as a 16 bit value:0x%04x\n",
                        inw(ioaddr + BANK_SELECT));
        PRINTK3(CARDNAME":Bank read as an 8 bit value:0x%02x\n",
                        inb(ioaddr + BANK_SELECT));
        PRINTK3(CARDNAME":Bank + 1 read as an 8 bit value:0x%02x\n",
                        inb(ioaddr + BANK_SELECT + 1));
#endif
 
        /*  check if the revision register is something that I recognize.
            These might need to be added to later, as future revisions
            could be added.  */
        SMC_SELECT_BANK(3);
        revision_register  = inw( ioaddr + REV_REG );
        if ( !chip_ids[ ( revision_register  >> 4 ) & 0xF  ] )
        {
                /* I don't recognize this chip, so... */
                printk(CARDNAME": IO %lx: Unrecognized revision register:"
                                " %x, Contact author. \n",
                                ioaddr, revision_register );
 
                return -ENODEV;
        }
 
        /* at this point I'll assume that the chip is an SMC9xxx. It might be
           prudent to check a listing of MAC addresses against the hardware
           address, or do some other tests. */
        return 0;
}
 
/*---------------------------------------------------------------
 . Here I do typical initialization tasks.
 .
 . o  Initialize the structure if needed
 . o  print out my vanity message if not done so already
 . o  print out what type of hardware is detected
 . o  print out the ethernet address
 . o  find the IRQ
 . o  set up my private data
 . o  configure the dev structure with my subroutines
 . o  actually GRAB the irq.
 . o  GRAB the region
 .-----------------------------------------------------------------
*/
static int  smc_initcard(struct device *dev, unsigned long ioaddr)
{
        int i;
 
        static unsigned version_printed = 0;
 
        /* registers */
        word	revision_register;
        word  	memory_info_register;
 
        const char *	version_string;
        int	memory;
 
        int   irqval;
 
        PRINTK2("%s:smc_initcard\n", dev->name);
 
        /* see if I need to initialize the ethernet card structure */
        if (dev == NULL)
        {
                dev = init_etherdev(0, 0);
                if (dev == NULL)
                        return -ENOMEM;
        }
 
        if (version_printed++ == 0)
                printk("%s", version);
 
        /* fill in some of the fields */
        dev->base_addr = ioaddr;
 
        /* . Get the MAC address ( bank 1, regs 4 - 9 ) */
        dev->dev_addr[0]=0x12;
	dev->dev_addr[1]=0x34;
	dev->dev_addr[2]=0x56;
	dev->dev_addr[3]=0x78;
	dev->dev_addr[4]=0xAC;
	dev->dev_addr[5]=0xCD;
 
        /* get the memory information */
 
        SMC_SELECT_BANK( 0 );
        memory_info_register = inw( ioaddr + MIR_REG );
        memory = memory_info_register & (word)0x00ff;
        memory *= LAN91C111_MEMORY_MULTIPLIER;
 
        /*
           Now, I want to find out more about the chip.  This is sort of
           redundant, but it's cleaner to have it in both, rather than having
           one VERY long probe procedure.
         */
        SMC_SELECT_BANK(3);
        revision_register  = inw( ioaddr + REV_REG );
        version_string = chip_ids[ ( revision_register  >> 4 ) & 0xF  ];
        if ( !version_string )
        {
                /* I shouldn't get here because this call was done before.... */
                return -ENODEV;
        }
 
        /* now, reset the chip, and put it into a known state */
        smc_reset( dev );
 
        /*
           . If dev->irq is 0, then the device has to be banged on to see
           . what the IRQ is.
           .
           . This banging doesn't always detect the IRQ, for unknown reasons.
           . a workaround is to reset the chip and try again.
           .
           . Interestingly, the DOS packet driver *SETS* the IRQ on the card to
           . be what is requested on the command line. I don't do that, mostly
           . because the card that I have uses a non-standard method of
           . accessing the IRQs, and because this _should_ work in most
           .  configurations.
	   . Specifying an IRQ is done with the assumption that the user knows
	   . what (s)he is doing.  No checking is done!!!!
 	 .
	*/
 
        /*OpenRISC ETH IRQ*/
        dev->irq=4;
 
	/* now, print out the card info, in a short format.. */
 
	printk("%s: %s(rev:%d) at %#3lx IRQ:%d MEMSIZE:%db NOWAIT:%d ",
		dev->name,
		version_string, revision_register & 0xF, ioaddr, dev->irq,
		memory, dev->dma);
	/*
	 . Print the Ethernet address
	*/
	printk("\n\tADDR: ");
	for (i = 0; i < 5; i++)
		printk("%2.2x:", dev->dev_addr[i] );
	printk("%2.2x \n", dev->dev_addr[5] );
 
 
	// Initialize the private structure.
	if (dev->priv == NULL)
	{
		PRINTK3("%s:Requesting memory for private data\n", dev->name);
		dev->priv = kmalloc(sizeof(struct smc_local), GFP_KERNEL);
		if (dev->priv == NULL)
			return -ENOMEM;
	}
	else
	{
		PRINTK3("%s:Memory already allocated for private data at 0x%08lx\n",
			dev->name, (unsigned long)dev->priv);
	}
	/* set the private data to zero by default */
	memset(dev->priv, 0, sizeof(struct smc_local));
 
	/* Fill in the fields of the device structure with ethernet values. */
	ether_setup(dev);
 
	/* Grab the IRQ */
      	irqval = request_irq(dev->irq, smc_interrupt, 0, dev->name, dev);
      	if (irqval) {
       	  printk("%s: unable to get IRQ %d (irqval=%d).\n",
		dev->name, dev->irq, irqval);
       	  return -EAGAIN;
      	}
	irq2dev_map[dev->irq] =dev; 
	/* Grab the region so that no one else tries to probe our ioports. */
	request_region(ioaddr, SMC_IO_EXTENT, dev->name);
 
	dev->open		        = smc_open;
	dev->stop		        = smc_close;
	dev->hard_start_xmit    	= smc_send_packet;
	dev->get_stats			= smc_query_statistics;
#ifdef	HAVE_MULTICAST
	dev->set_multicast_list 	= &smc_set_multicast_list;
#endif
 
	return 0;
}
 
#if SMC_DEBUG > 2
static void print_packet( byte * buf, int length )
{
#if SMC_DEBUG > 3
	int i;
	int remainder;
	int lines;
#endif
 
	printk("Packet of length %d \n", length );
 
#if SMC_DEBUG > 3
	lines = length / 16;
	remainder = length % 16;
 
	for ( i = 0; i < lines ; i ++ ) {
		int cur;
 
		for ( cur = 0; cur < 8; cur ++ ) {
			byte a, b;
 
			a = *(buf ++ );
			b = *(buf ++ );
			printk("%02x%02x ", a, b );
		}
		printk("\n");
	}
	for ( i = 0; i < remainder/2 ; i++ ) {
		byte a, b;
 
		a = *(buf ++ );
		b = *(buf ++ );
		printk("%02x%02x ", a, b );
	}
	printk("\n");
#endif
}
#endif
 
 
/*
 * Open and Initialize the board
 *
 * Set up everything, reset the card, etc ..
 *
 */
static int smc_open(struct device *dev)
{
	struct smc_local *lp 	= (struct smc_local *)dev->priv;
	unsigned long   ioaddr = dev->base_addr;
	int	i;	/* used to set hw ethernet address */
 
	PRINTK2("%s:smc_open\n", dev->name);
 
	/* clear out all the junk that was put here before... */
	memset(dev->priv, 0, sizeof(struct smc_local));
 
	dev->tbusy 	= 0;
	dev->interrupt  = 0;
	dev->start 	= 1;
 
	// Setup the default Register Modes
	lp->tcr_cur_mode = TCR_DEFAULT;
	lp->rcr_cur_mode = RCR_DEFAULT;
	lp->rpc_cur_mode = RPC_DEFAULT;
 
#ifdef CONFIG_SYSCTL
	// Set default parameters (files)
	lp->ctl_swfdup = 0;
	lp->ctl_ephloop = 0;
	lp->ctl_miiop = 0;
	lp->ctl_autoneg = 1;
	lp->ctl_rfduplx = 1;
	lp->ctl_rspeed = 100;
	lp->ctl_afduplx = 1;
	lp->ctl_aspeed = 100;
	lp->ctl_lnkfail = 1;
	lp->ctl_forcol = 0;
	lp->ctl_filtcar = 0;
#endif
	/* reset the hardware */
 
	smc_reset( dev );
	smc_enable( dev );
 
	/* Configure the PHY */
	smc_phy_configure(dev);
 
	/*
  		According to Becker, I have to set the hardware address
		at this point, because the (l)user can set it with an
		ioctl.  Easily done...
	*/
	SMC_SELECT_BANK( 1 );	
 
	for ( i = 0; i < 6; i += 2 ) {
		word	address;
 
		address = dev->dev_addr[ i + 1 ] << 8 ;
		address  |= dev->dev_addr[ i ];
		outw( address, ioaddr + ADDR0_REG + i );
	}
 
 
#ifdef CONFIG_SYSCTL
	smc_sysctl_register(dev);
#endif /* CONFIG_SYSCTL */ 
 
	return 0;
}
 
/*--------------------------------------------------------
 . Called by the kernel to send a packet out into the void
 . of the net.  This routine is largely based on
 . skeleton.c, from Becker.
 .--------------------------------------------------------
*/
static int smc_send_packet(struct sk_buff *skb, struct device *dev)
{
 
	PRINTK3("%s:smc_send_packet\n", dev->name);
 
	if (dev->tbusy) {
		/* If we get here, some higher level has decided we are broken.
		   There should really be a "kick me" function call instead. */
		int tickssofar = jiffies - dev->trans_start;
		if (tickssofar < 5)
			return 1;
		printk(KERN_WARNING "%s: transmit timed out, %s?\n",
			dev->name, tx_done(dev) ? "IRQ conflict" :
			"network cable problem");
		/* "kick" the adaptor */
		smc_reset( dev );
		smc_enable( dev );
 
		/* Reconfigure the PHY */
		smc_phy_configure(dev);
 
 
		dev->tbusy = 0;
		dev->trans_start = jiffies;
		/* clear anything saved */
		((struct smc_local *)dev->priv)->saved_skb = NULL;
	}
 
	/* Block a timer-based transmit from overlapping.  This could better be
	   done with atomic_swap(1, dev->tbusy), but set_bit() works as well. */
	if (test_and_set_bit(0, (void*)&dev->tbusy) != 0) {
		printk(KERN_WARNING "%s: Transmitter access conflict.\n",
			dev->name);
		dev_kfree_skb (skb,FREE_WRITE);
	} else {
		/* Well, I want to send the packet.. but I don't know
		   if I can send it right now...  */
		return smc_wait_to_send_packet( skb, dev );
	}
	return 0;
}
 
/*--------------------------------------------------------------------
 .
 . This is the main routine of the driver, to handle the device when
 . it needs some attention.
 .
 . So:
 .   first, save state of the chipset
 .   branch off into routines to handle each case, and acknowledge
 .	    each to the interrupt register
 .   and finally restore state.
 .
 ---------------------------------------------------------------------*/
static void smc_interrupt(int irq, void * dev_id,  struct pt_regs * regs)
{
	struct device *dev      = dev_id;
	//Don't initializes these until after testing that the pointer is not NULL
	unsigned long ioaddr;
	struct smc_local *lp;
 
	byte	status;
	word	card_stats;
	byte	mask;
	int	timeout;
	/* state registers */
	word	saved_bank;
	word	saved_pointer;
 
	PRINTK3("%s: SMC interrupt started ---------------------\n", dev->name);
 
	if (dev == NULL) {
		printk(KERN_WARNING "irq %d for unknown device.\n", irq);
		return;
	}
	ioaddr = dev->base_addr;
	lp = (struct smc_local *)dev->priv;
 
	/* will Linux let this happen ??  If not, this costs some speed */
	if ( dev->interrupt ) {
		printk(KERN_WARNING "%s: interrupt inside interrupt.\n",
			dev->name);
		return;
	}
 
	dev->interrupt = 1;
	smc_register_dump(dev);
 
	saved_bank = inw( ioaddr + BANK_SELECT );
 
	SMC_SELECT_BANK(2);
	saved_pointer = inw( ioaddr + PTR_REG );
 
	/* read the interrupt status register */
	mask = inb( ioaddr + IM_REG );
 
	/* disable all interrupts */
	outb( 0, ioaddr + IM_REG );
 
	/* set a timeout value, so I don't stay here forever */
	timeout = 4;
 
	PRINTK2(KERN_WARNING "%s: MASK IS %x \n", dev->name, mask);
	do
    {
        /* read the status flag, and mask it */
        status = inb( ioaddr + INT_REG ) & mask;
        if (!status )
            break;
 
        PRINTK3(KERN_WARNING "%s: Handling interrupt status %x \n",
                dev->name, status);
 
        if (status & IM_RCV_INT)
        {
            /* Got a packet(s). */
            PRINTK2(KERN_WARNING"%s: Receive Interrupt\n", dev->name);
            smc_rcv(dev);
        }
        else
            if (status & IM_TX_INT )
            {
                PRINTK2(KERN_WARNING "%s: TX ERROR handled\n", dev->name);
                smc_tx(dev);
                // Acknowledge the interrupt
                outb(IM_TX_INT, ioaddr + INT_REG );
            }
            else
                if (status & IM_TX_EMPTY_INT )
                {
                    /* update stats */
                    SMC_SELECT_BANK( 0 );
                    card_stats = inw( ioaddr + COUNTER_REG );
                    /* single collisions */
                    lp->stats.collisions += card_stats & 0xF;
                    card_stats >>= 4;
                    /* multiple collisions */
                    lp->stats.collisions += card_stats & 0xF;
                    /* these are for when linux supports these statistics */
 
                    SMC_SELECT_BANK( 2 );
                    PRINTK2(KERN_WARNING "%s: TX_BUFFER_EMPTY handled\n",
                            dev->name);
                    // Acknowledge the interrupt
 
                    outb( IM_TX_EMPTY_INT, ioaddr + INT_REG );
 
                    mask &= ~IM_TX_EMPTY_INT;
                    lp->stats.tx_packets += lp->packets_waiting;
                    lp->packets_waiting = 0;
                }
                else
                    if (status & IM_ALLOC_INT )
                    {
                        PRINTK2(KERN_DEBUG "%s: Allocation interrupt \n",
                                dev->name);
                        /* clear this interrupt so it doesn't happen again */
                        mask &= ~IM_ALLOC_INT;
 
                        smc_hardware_send_packet( dev );
 
                        /* enable xmit interrupts based on this */
                        mask |= ( IM_TX_EMPTY_INT | IM_TX_INT );
 
                        /* and let the card send more packets to me */
                        mark_bh( NET_BH );
 
                        PRINTK2("%s: Handoff done successfully.\n", dev->name);
                    }
                    else
                        if (status & IM_RX_OVRN_INT )
                        {
                            lp->stats.rx_errors++;
                            lp->stats.rx_fifo_errors++;
                            // Acknowledge the interrupt
 
                            outb( IM_RX_OVRN_INT, ioaddr + INT_REG );
                        }
                        else
                            if (status & IM_EPH_INT )
                            {
                                PRINTK("%s: UNSUPPORTED: EPH INTERRUPT \n",
                                        dev->name);
                            }
                            else
                                if (status & IM_MDINT )
                                {
                                    smc_phy_interrupt(dev);
                                    // Acknowledge the interrupt
 
                                    outb(IM_MDINT, ioaddr + INT_REG );
                                }
                                else
                                    if (status & IM_ERCV_INT )
                                    {
                                        PRINTK("%s: UNSUPPORTED: ERCV INTERRUPT"
                                               " \n", dev->name);
                                        // Acknowledge the interrupt
                                        outb( IM_ERCV_INT, ioaddr + INT_REG );
                                    }
    } while ( timeout -- );
 
 
	/* restore register states */
	SMC_SELECT_BANK( 2 );
 
	outb( mask, ioaddr + IM_REG );
 
	PRINTK3( KERN_WARNING "%s: MASK is now %x \n", dev->name, mask);
	outw( saved_pointer, ioaddr + PTR_REG );
 
	SMC_SELECT_BANK( saved_bank );
 
	dev->interrupt = 0;
	PRINTK3("%s: Interrupt done\n", dev->name);
	return;
}
 
/*-------------------------------------------------------------
 .
 . smc_rcv -  receive a packet from the card
 .
 . There is ( at least ) a packet waiting to be read from
 . chip-memory.
 .
 . o Read the status
 . o If an error, record it
 . o otherwise, read in the packet
 --------------------------------------------------------------
*/
static void smc_rcv(struct device *dev)
{
    struct smc_local *lp = (struct smc_local *)dev->priv;
    unsigned long ioaddr = dev->base_addr;
    int 	packet_number;
    word	status;
    word	packet_length;
    word	packet_length_loop;
    word        word_readed;
    byte        *datab;
 
    PRINTK3("%s:smc_rcv\n", dev->name);
 
    // assume bank 2 -valid since this is called from ISR
 
    packet_number = inw( ioaddr + RXFIFO_REG );
 
    if ( packet_number & RXFIFO_REMPTY )
    {
        // we got called , but nothing was on the FIFO
        PRINTK("%s: WARNING: smc_rcv with nothing on FIFO. \n", dev->name);
        // don't need to restore anything
        return;
    }
 
	// start reading from the start of the packet
    outw( PTR_READ | PTR_RCV | PTR_AUTOINC, ioaddr + PTR_REG );
 
    status          = inw( ioaddr + DATA_REG );
    packet_length   = inw( ioaddr + DATA_REG );
 
    // Handle odd number of bytes bug, problems with reading data register,...
    packet_length = (packet_length & 0xfffc) + 4;
    packet_length &= 0x07ff;  // mask off top bits
 
    PRINTK2("%s:receive  status 0x%04x length field 0x%04x length 0x%04x\n",
            dev->name, status, packet_length, (packet_length&0x07ff));
 
    if ( !(status & RS_ERRORS ))
    {
        // do stuff to make a new packet
        struct sk_buff  * skb;
        byte		* data;
        PRINTK3("%s:No errors on receive\n", dev->name);
        if(packet_length == 0)
            panic("Zero lengthed packet receieved.");
 
        // set multicast stats
        if ( status & RS_MULTICAST )
            lp->stats.multicast++;
 
        // Allocate enough memory for entire receive frame, to be safe
        skb = dev_alloc_skb( packet_length );
 
		// Adjust for having already read the first two words
        packet_length -= 4;
 
	    if ( skb == NULL )
        {
            printk(KERN_NOTICE "%s: Low memory, packet dropped.\n", dev->name);
            lp->stats.rx_dropped++;
        }
 
		/*
		 ! This should work without alignment, but it could be
		 ! in the worse case
		*/
		/* TODO: Should I use 32bit alignment here ? */
		skb_reserve( skb, 2 );   /* 16 bit alignment */
 
		skb->dev = dev;
 
		// set odd length for bug in LAN91C111,
		// which never sets RS_ODDFRAME
		// Instead, just round up to the next dword size
		//data = skb_put( skb, packet_length + 1 );
		data = skb_put( skb, packet_length);
 
		PRINTK3(" Reading %d words and %d byte(s) \n",
			(packet_length >> 1 ), packet_length & 1 );
 
	       	packet_length_loop=packet_length>>1;
 
		//insw(ioaddr + DATA_REG , data, packet_length >> 1);
 
                datab=(byte*)data;
		while(packet_length_loop-->0){
 		  word_readed=REG16(ioaddr+DATA_REG);
	 	  *((word*)datab)=SWAP16(word_readed);
		  datab+=sizeof(word);
		}
 
#if SMC_DEBUG > 2
		printk("Receiving Packet\n");
		print_packet( data, packet_length );
#endif
 
		skb->protocol = eth_type_trans(skb, dev );
		netif_rx(skb);
		lp->stats.rx_packets++;
	} else {
		/* error ... */
		lp->stats.rx_errors++;
 
		if ( status & RS_ALGNERR )  lp->stats.rx_frame_errors++;
		if ( status & (RS_TOOSHORT | RS_TOOLONG ) )
			lp->stats.rx_length_errors++;
		if ( status & RS_BADCRC)	lp->stats.rx_crc_errors++;
	}
 
	while ( inw( ioaddr + MMU_CMD_REG ) & MC_BUSY )
		udelay(1); // Wait until not busy
 
	/*  error or good, tell the card to get rid of this packet */
	outw( MC_RELEASE, ioaddr + MMU_CMD_REG );
 
 
	return;
}
 
 
/*************************************************************************
 . smc_tx
 .
 . Purpose:  Handle a transmit error message.   This will only be called
 .   when an error, because of the AUTO_RELEASE mode.
 .
 . Algorithm:
 .	Save pointer and packet no
 .	Get the packet no from the top of the queue
 .	check if it's valid ( if not, is this an error??? )
 .	read the status word
 .	record the error
 .	( resend?  Not really, since we don't want old packets around )
 .	Restore saved values
 ************************************************************************/
static void smc_tx( struct device * dev )
{
	unsigned long ioaddr = dev->base_addr;
	struct smc_local *lp = (struct smc_local *)dev->priv;
	byte saved_packet;
	byte packet_no;
	word tx_status;
 
 
	PRINTK3("%s:smc_tx\n", dev->name);
 
	/* assume bank 2  */
 
	saved_packet = inb( ioaddr + PN_REG );
	packet_no = inw( ioaddr + RXFIFO_REG );
	packet_no &= 0x7F;
 
	/* If the TX FIFO is empty then nothing to do */
	if ( packet_no & TXFIFO_TEMPTY ) {
		return;
	}
 
	/* select this as the packet to read from */
	outb( packet_no, ioaddr + PN_REG );
 
	/* read the first word (status word) from this packet */
	outw( PTR_AUTOINC | PTR_READ, ioaddr + PTR_REG );
 
	tx_status = inw( ioaddr + DATA_REG );
	PRINTK3("%s: TX DONE STATUS: %4x \n", dev->name, tx_status);
 
	lp->stats.tx_errors++;
	if ( tx_status & TS_LOSTCAR ) lp->stats.tx_carrier_errors++;
	if ( tx_status & TS_LATCOL  ) {
		printk(KERN_DEBUG
			"%s: Late collision occurred on last xmit.\n",
			dev->name);
		lp->stats.tx_window_errors++;
#ifdef CONFIG_SYSCTL
		lp->ctl_forcol = 0; // Reset forced collsion
#endif
    }
 
	if ( tx_status & TS_SUCCESS ) {
		printk("%s: Successful packet caused interrupt \n", dev->name);
	}
	/* re-enable transmit */
	SMC_SELECT_BANK( 0 );
	outw( inw( ioaddr + TCR_REG ) | TCR_ENABLE, ioaddr + TCR_REG );
 
	/* kill the packet */
	SMC_SELECT_BANK( 2 );
	outw( MC_FREEPKT, ioaddr + MMU_CMD_REG );
 
	/* one less packet waiting for me */
	lp->packets_waiting--;
 
	/* Don't change Packet Number Reg until busy bit is cleared */
	/* Per LAN91C111 Spec, Page 50 */
	while ( inw( ioaddr + MMU_CMD_REG ) & MC_BUSY );
 
	outb( saved_packet, ioaddr + PN_REG );
	return;
}
 
 
/*----------------------------------------------------
 . smc_close
 .
 . this makes the board clean up everything that it can
 . and not talk to the outside world.   Caused by
 . an 'ifconfig ethX down'
 .
 -----------------------------------------------------*/
static int smc_close(struct device *dev)
{
	dev->tbusy = 1;
	dev->start = 0;
 
	PRINTK2("%s:smc_close\n", dev->name);
 
#ifdef CONFIG_SYSCTL
	smc_sysctl_unregister(dev);
#endif /* CONFIG_SYSCTL */ 
 
	/* clear everything */
	smc_shutdown( dev->base_addr );
 
	/* Update the statistics here. */
 
	return 0;
}
 
/*------------------------------------------------------------
 . Get the current statistics.
 . This may be called with the card open or closed.
 .-------------------------------------------------------------*/
static struct enet_statistics* smc_query_statistics(struct device *dev) {
	struct smc_local *lp = (struct smc_local *)dev->priv;
 
	PRINTK2("%s:smc_query_statistics\n", dev->name);
 
	return &lp->stats;
}
 
/*-----------------------------------------------------------
 . smc_set_multicast_list
 .
 . This routine will, depending on the values passed to it,
 . either make it accept multicast packets, go into
 . promiscuous mode ( for TCPDUMP and cousins ) or accept
 . a select set of multicast packets
*/
static void smc_set_multicast_list(struct device *dev)
{
	unsigned long ioaddr = dev->base_addr;
 
	PRINTK2("%s:smc_set_multicast_list\n", dev->name);
 
	SMC_SELECT_BANK(0);
	if ( dev->flags & IFF_PROMISC )
		{
		PRINTK2("%s:smc_set_multicast_list:RCR_PRMS\n", dev->name);
		outw( inw(ioaddr + RCR_REG ) | RCR_PRMS, ioaddr + RCR_REG );
		}
 
/* BUG?  I never disable promiscuous mode if multicasting was turned on.
   Now, I turn off promiscuous mode, but I don't do anything to multicasting
   when promiscuous mode is turned on.
*/
 
	/* Here, I am setting this to accept all multicast packets.
	   I don't need to zero the multicast table, because the flag is
	   checked before the table is
	*/
	else if (dev->flags & IFF_ALLMULTI)
		{
		outw( inw(ioaddr + RCR_REG ) | RCR_ALMUL, ioaddr + RCR_REG );
		PRINTK2("%s:smc_set_multicast_list:RCR_ALMUL\n", dev->name);
		}
 
	/* We just get all multicast packets even if we only want them
	 . from one source.  This will be changed at some future
	 . point. */
	else if (dev->mc_count )  {
		/* support hardware multicasting */
 
		/* be sure I get rid of flags I might have set */
		outw( inw( ioaddr + RCR_REG ) & ~(RCR_PRMS | RCR_ALMUL),
			ioaddr + RCR_REG );
		/* NOTE: this has to set the bank, so make sure it is the
		   last thing called.  The bank is set to zero at the top */
		smc_setmulticast( ioaddr, dev->mc_count, dev->mc_list );
	} else  {
		PRINTK2("%s:smc_set_multicast_list:~(RCR_PRMS|RCR_ALMUL)\n",
			dev->name);
		outw( inw( ioaddr + RCR_REG ) & ~(RCR_PRMS | RCR_ALMUL),
			ioaddr + RCR_REG );
 
		/*
		  since I'm disabling all multicast entirely, I need to
		  clear the multicast list
		*/
		SMC_SELECT_BANK( 3 );
		outw( 0, ioaddr + MCAST_REG1 );
		outw( 0, ioaddr + MCAST_REG2 );
		outw( 0, ioaddr + MCAST_REG3 );
		outw( 0, ioaddr + MCAST_REG4 );
	}
}
 
#ifdef MODULE
 
static char devicename[9] = { 0, };
static struct device devSMC91111 = {
	devicename, /* device name is inserted by linux/drivers/net/net_init.c */
	0, 0, 0, 0,
	0, 0,  /* I/O address, IRQ */
	0, 0, 0, NULL, smc_init_91C111, smc_91C111_destructor};
 
int io = 0;
int irq = 0;
int nowait = 0;
 
MODULE_PARM(io, "i");
MODULE_PARM(irq, "i");
MODULE_PARM(nowait, "i");
 
/*------------------------------------------------------------
 . Module initialization function
 .-------------------------------------------------------------*/
int init_module(void)
{
	int result;
 
	PRINTK2(CARDNAME":init_module\n");
 
	if (io == 0)
		printk(KERN_WARNING
		CARDNAME": You shouldn't use auto-probing with insmod!\n" );
 
	/* copy the parameters from insmod into the device structure */
	devSMC91111.base_addr	= io;
	devSMC91111.irq		= irq;
	devSMC91111.dma		= nowait; // Use DMA field for nowait
	if ((result = register_netdev(&devSMC91111)) != 0)
		return result;
 
	return 0;
}
 
/*------------------------------------------------------------
 . Cleanup when module is removed with rmmod
 .-------------------------------------------------------------*/
void cleanup_module(void)
{
	/* No need to check MOD_IN_USE, as sys_delete_module() checks. */
	unregister_netdev(&devSMC91111);
 
	free_irq(devSMC91111.irq, &devSMC91111);
	release_region(devSMC91111.base_addr, SMC_IO_EXTENT);
 
	if (devSMC91111.priv)
		kfree_s(devSMC91111.priv, sizeof(struct smc_local));
}
 
#endif /* MODULE */
 
 
#ifdef CONFIG_SYSCTL
 
 
/*------------------------------------------------------------
 . Modify a bit in the LAN91C111 register set
 .-------------------------------------------------------------*/
static word smc_modify_regbit(int bank, unsigned long ioaddr, int reg,
	unsigned int bit, int val)
{
	word regval;
 
	SMC_SELECT_BANK( bank );
 
	regval = inw( ioaddr+reg );
	if (val)
		regval |= bit;
	else
		regval &= ~bit;
 
	outw( regval, ioaddr );
	return(regval);
}
 
 
/*------------------------------------------------------------
 . Retrieve a bit in the LAN91C111 register set
 .-------------------------------------------------------------*/
static int smc_get_regbit(int bank, unsigned long ioaddr, int reg,
        unsigned int bit)
{
	SMC_SELECT_BANK( bank );
	if ( inw( ioaddr+reg ) & bit)
		return(1);
	else
		return(0);
}
 
 
/*------------------------------------------------------------
 . Modify a LAN91C111 register (word access only)
 .-------------------------------------------------------------*/
static void smc_modify_reg(int bank, unsigned long ioaddr, int reg, word val)
{
	SMC_SELECT_BANK( bank );
	outw( val, ioaddr+reg );
}
 
 
/*------------------------------------------------------------
 . Retrieve a LAN91C111 register (word access only)
 .-------------------------------------------------------------*/
static int smc_get_reg(int bank, unsigned long ioaddr, int reg)
{
	SMC_SELECT_BANK( bank );
	return(inw( ioaddr+reg ));
}
 
 
static const char smc_info_string[] =
"\n"
"info           Provides this information blurb\n"
"swver          Prints the software version information of this driver\n"
"autoneg        Auto-negotiate Mode = 1\n"
"rspeed         Requested Speed, 100=100Mbps, 10=10Mpbs\n"
"rfduplx        Requested Full Duplex Operation\n"
"aspeed         Actual Speed, 100=100Mbps, 10=10Mpbs\n"
"afduplx        Actual Full Duplex Operation\n"
"lnkfail        PHY Link Failure when 1\n"
"miiop          External MII when 1, Internal PHY when 0\n"
"swfdup         Switched Full Duplex Mode (allowed only in MII operation)\n"
"ephloop        EPH Block Loopback\n"
"forcol         Force a collision\n"
"filtcar        Filter leading edge of carrier sense for 12 bit times\n"
"freemem        Free buffer memory in bytes\n"
"totmem         Total buffer memory in bytes\n"
"leda           Output of LED-A (green)\n"
"ledb           Output of LED-B (yellow)\n"
"chiprev        Revision ID of the LAN91C111 chip\n"
"";
 
/*------------------------------------------------------------
 . Sysctl handler for all integer parameters
 .-------------------------------------------------------------*/
static int smc_sysctl_handler(ctl_table *ctl, int write, struct file * filp,
				void *buffer, size_t *lenp)
{
	struct device *dev = (struct device*)ctl->extra1;
	struct smc_local *lp = (struct smc_local *)ctl->extra2;
	unsigned long ioaddr = dev->base_addr;
	int *valp = ctl->data;
	int val;
	int ret;
 
	// Update parameters from the real registers
	switch (ctl->ctl_name)
	{
	case CTL_SMC_FORCOL:
		*valp = smc_get_regbit(0, ioaddr, TCR_REG, TCR_FORCOL);
		break;
 
	case CTL_SMC_FREEMEM:
		*valp = ( (word)smc_get_reg(0, ioaddr, MIR_REG) >> 8 )
			* LAN91C111_MEMORY_MULTIPLIER;
		break;
 
 
	case CTL_SMC_TOTMEM:
		*valp = ( smc_get_reg(0, ioaddr, MIR_REG) & (word)0x00ff )
			* LAN91C111_MEMORY_MULTIPLIER;
		break;
 
	case CTL_SMC_CHIPREV:
		*valp = smc_get_reg(3, ioaddr, REV_REG);
		break;
 
	case CTL_SMC_AFDUPLX:
		*valp = (lp->lastPhy18 & PHY_INT_DPLXDET) ? 1 : 0;
		break;
 
	case CTL_SMC_ASPEED:
		*valp = (lp->lastPhy18 & PHY_INT_SPDDET) ? 100 : 10;
		break;
 
	case CTL_SMC_LNKFAIL:
		*valp = (lp->lastPhy18 & PHY_INT_LNKFAIL) ? 1 : 0;
		break;
 
	case CTL_SMC_LEDA:
		*valp = (lp->rpc_cur_mode >> RPC_LSXA_SHFT) & (word)0x0007;
		break;
 
	case CTL_SMC_LEDB:
		*valp = (lp->rpc_cur_mode >> RPC_LSXB_SHFT) & (word)0x0007;
		break;
 
	case CTL_SMC_MIIOP:
		*valp = smc_get_regbit(1, ioaddr, CONFIG_REG, CONFIG_EXT_PHY);
		break;
 
#ifdef SMC_DEBUG
	case CTL_SMC_REG_BSR:	// Bank Select
		*valp = smc_get_reg(0, ioaddr, BSR_REG);
		break;
 
	case CTL_SMC_REG_TCR:	// Transmit Control
		*valp = smc_get_reg(0, ioaddr, TCR_REG);
		break;
 
	case CTL_SMC_REG_ESR:	// EPH Status
		*valp = smc_get_reg(0, ioaddr, EPH_STATUS_REG);
		break;
 
	case CTL_SMC_REG_RCR:	// Receive Control
		*valp = smc_get_reg(0, ioaddr, RCR_REG);
		break;
 
	case CTL_SMC_REG_CTRR:	// Counter
		*valp = smc_get_reg(0, ioaddr, COUNTER_REG);
		break;
 
	case CTL_SMC_REG_MIR:	// Memory Information
		*valp = smc_get_reg(0, ioaddr, MIR_REG);
		break;
 
	case CTL_SMC_REG_RPCR:	// Receive/Phy Control
		*valp = smc_get_reg(0, ioaddr, RPC_REG);
		break;
 
	case CTL_SMC_REG_CFGR:	// Configuration
		*valp = smc_get_reg(1, ioaddr, CONFIG_REG);
		break;
 
	case CTL_SMC_REG_BAR:	// Base Address
		*valp = smc_get_reg(1, ioaddr, BASE_REG);
		break;
 
	case CTL_SMC_REG_IAR0:	// Individual Address
		*valp = smc_get_reg(1, ioaddr, ADDR0_REG);
		break;
 
	case CTL_SMC_REG_IAR1:	// Individual Address
		*valp = smc_get_reg(1, ioaddr, ADDR1_REG);
		break;
 
	case CTL_SMC_REG_IAR2:	// Individual Address
		*valp = smc_get_reg(1, ioaddr, ADDR2_REG);
		break;
 
	case CTL_SMC_REG_GPR:	// General Purpose
		*valp = smc_get_reg(1, ioaddr, GP_REG);
		break;
 
	case CTL_SMC_REG_CTLR:	// Control
		*valp = smc_get_reg(1, ioaddr, CTL_REG);
		break;
 
	case CTL_SMC_REG_MCR:	// MMU Command
		*valp = smc_get_reg(2, ioaddr, MMU_CMD_REG);
		break;
 
	case CTL_SMC_REG_PNR:	// Packet Number
		*valp = smc_get_reg(2, ioaddr, PN_REG);
		break;
 
	case CTL_SMC_REG_FPR:	// Allocation Result/FIFO Ports
		*valp = smc_get_reg(2, ioaddr, RXFIFO_REG);
		break;
 
	case CTL_SMC_REG_PTR:	// Pointer
		*valp = smc_get_reg(2, ioaddr, PTR_REG);
		break;
 
	case CTL_SMC_REG_DR:	// Data 
		*valp = smc_get_reg(2, ioaddr, DATA_REG);
		break;
 
	case CTL_SMC_REG_ISR:	// Interrupt Status/Mask
		*valp = smc_get_reg(2, ioaddr, INT_REG);
		break;
 
	case CTL_SMC_REG_MTR1:	// Multicast Table Entry 1
		*valp = smc_get_reg(3, ioaddr, MCAST_REG1);
		break;
 
	case CTL_SMC_REG_MTR2:	// Multicast Table Entry 2
		*valp = smc_get_reg(3, ioaddr, MCAST_REG2);
		break;
 
	case CTL_SMC_REG_MTR3:	// Multicast Table Entry 3
		*valp = smc_get_reg(3, ioaddr, MCAST_REG3);
		break;
 
	case CTL_SMC_REG_MTR4:	// Multicast Table Entry 4
		*valp = smc_get_reg(3, ioaddr, MCAST_REG4);
		break;
 
	case CTL_SMC_REG_MIIR:	// Management Interface
		*valp = smc_get_reg(3, ioaddr, MII_REG);
		break;
 
	case CTL_SMC_REG_REVR:	// Revision
		*valp = smc_get_reg(3, ioaddr, REV_REG);
		break;
 
	case CTL_SMC_REG_ERCVR:	// Early RCV
		*valp = smc_get_reg(3, ioaddr, ERCV_REG);
		break;
 
	case CTL_SMC_REG_EXTR:	// External
		*valp = smc_get_reg(7, ioaddr, EXT_REG);
		break;
 
	case CTL_SMC_PHY_CTRL:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_CNTL_REG);
		break;
 
	case CTL_SMC_PHY_STAT:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_STAT_REG);
		break;
 
	case CTL_SMC_PHY_ID1:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_ID1_REG);
		break;
 
	case CTL_SMC_PHY_ID2:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_ID2_REG);
		break;
 
	case CTL_SMC_PHY_ADC:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_AD_REG);
		break;
 
	case CTL_SMC_PHY_REMC:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_RMT_REG);
		break;
 
	case CTL_SMC_PHY_CFG1:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_CFG1_REG);
		break;
 
	case CTL_SMC_PHY_CFG2:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_CFG2_REG);
		break;
 
	case CTL_SMC_PHY_INT:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_INT_REG);
		break;
 
	case CTL_SMC_PHY_MASK:
		*valp = smc_read_phy_register(ioaddr, lp->phyaddr,
			PHY_MASK_REG);
		break;
 
#endif // SMC_DEBUG
 
	default:
		// Just ignore unsupported parameters
		break;
	}
 
	// Save old state
	val = *valp;
 
	// Perform the generic integer operation	
	if ((ret = proc_dointvec(ctl, write, filp, buffer, lenp)) != 0)
		return(ret);
 
	// Write changes out to the registers
	if (write && *valp != val) {
 
		val = *valp;
		switch (ctl->ctl_name) {
 
		case CTL_SMC_SWFDUP:
			if (val)
				lp->tcr_cur_mode |= TCR_SWFDUP;
			else
				lp->tcr_cur_mode &= ~TCR_SWFDUP;
 
			smc_modify_regbit(0, ioaddr, TCR_REG, TCR_SWFDUP, val);
			break;
 
		case CTL_SMC_EPHLOOP:
			if (val)
				lp->tcr_cur_mode |= TCR_EPH_LOOP;
			else
				lp->tcr_cur_mode &= ~TCR_EPH_LOOP;
 
			smc_modify_regbit(0, ioaddr, TCR_REG, TCR_EPH_LOOP, val);
			break;
 
		case CTL_SMC_FORCOL:
			if (val)
				lp->tcr_cur_mode |= TCR_FORCOL;
			else
				lp->tcr_cur_mode &= ~TCR_FORCOL;
 
			// Update the EPH block
			smc_modify_regbit(0, ioaddr, TCR_REG, TCR_FORCOL, val);
			break;
 
		case CTL_SMC_FILTCAR:
			if (val)
				lp->rcr_cur_mode |= RCR_FILT_CAR;
			else
				lp->rcr_cur_mode &= ~RCR_FILT_CAR;
 
			// Update the EPH block
			smc_modify_regbit(0, ioaddr, RCR_REG, RCR_FILT_CAR, val);
			break;
 
		case CTL_SMC_RFDUPLX:
			// Disallow changes if in auto-negotiation mode
			if (lp->ctl_autoneg)
				break;
 
			if (val)
				{
				lp->rpc_cur_mode |= RPC_DPLX;
				}
			else
				{
				lp->rpc_cur_mode &= ~RPC_DPLX;
				}
 
			// Reconfigure the PHY
			smc_phy_configure(dev);
 
			break;
 
		case CTL_SMC_RSPEED:
			// Disallow changes if in auto-negotiation mode
			if (lp->ctl_autoneg)
				break;
 
			if (val > 10)
				lp->rpc_cur_mode |= RPC_SPEED;
			else
				lp->rpc_cur_mode &= ~RPC_SPEED;
 
			// Reconfigure the PHY
			smc_phy_configure(dev);
 
			break;
 
		case CTL_SMC_AUTONEG:
			if (val)
				lp->rpc_cur_mode |= RPC_ANEG;
			else
				lp->rpc_cur_mode &= ~RPC_ANEG;
 
			// Reconfigure the PHY
			smc_phy_configure(dev);
 
			break;
 
		case CTL_SMC_LEDA:
			val &= 0x07; // Restrict to 3 ls bits
			lp->rpc_cur_mode &= ~(word)(0x07<<RPC_LSXA_SHFT);
			lp->rpc_cur_mode |= (word)(val<<RPC_LSXA_SHFT);
 
			// Update the Internal PHY block
			smc_modify_reg(0, ioaddr, RPC_REG, lp->rpc_cur_mode);
			break;
 
		case CTL_SMC_LEDB:
			val &= 0x07; // Restrict to 3 ls bits
			lp->rpc_cur_mode &= ~(word)(0x07<<RPC_LSXB_SHFT);
			lp->rpc_cur_mode |= (word)(val<<RPC_LSXB_SHFT);
 
			// Update the Internal PHY block
			smc_modify_reg(0, ioaddr, RPC_REG, lp->rpc_cur_mode);
			break;
 
		case CTL_SMC_MIIOP:
			// Update the Internal PHY block
			smc_modify_regbit(1, ioaddr, CONFIG_REG,
				CONFIG_EXT_PHY, val);
			break;
 
#ifdef SMC_DEBUG
		case CTL_SMC_REG_BSR:	// Bank Select
			smc_modify_reg(0, ioaddr, BSR_REG, val);
			break;
 
		case CTL_SMC_REG_TCR:	// Transmit Control
			smc_modify_reg(0, ioaddr, TCR_REG, val);
			break;
 
		case CTL_SMC_REG_ESR:	// EPH Status
			smc_modify_reg(0, ioaddr, EPH_STATUS_REG, val);
			break;
 
		case CTL_SMC_REG_RCR:	// Receive Control
			smc_modify_reg(0, ioaddr, RCR_REG, val);
			break;
 
		case CTL_SMC_REG_CTRR:	// Counter
			smc_modify_reg(0, ioaddr, COUNTER_REG, val);
			break;
 
		case CTL_SMC_REG_MIR:	// Memory Information
			smc_modify_reg(0, ioaddr, MIR_REG, val);
			break;
 
		case CTL_SMC_REG_RPCR:	// Receive/Phy Control
			smc_modify_reg(0, ioaddr, RPC_REG, val);
			break;
 
		case CTL_SMC_REG_CFGR:	// Configuration
			smc_modify_reg(1, ioaddr, CONFIG_REG, val);
			break;
 
		case CTL_SMC_REG_BAR:	// Base Address
			smc_modify_reg(1, ioaddr, BASE_REG, val);
			break;
 
		case CTL_SMC_REG_IAR0:	// Individual Address
			smc_modify_reg(1, ioaddr, ADDR0_REG, val);
			break;
 
		case CTL_SMC_REG_IAR1:	// Individual Address
			smc_modify_reg(1, ioaddr, ADDR1_REG, val);
			break;
 
		case CTL_SMC_REG_IAR2:	// Individual Address
			smc_modify_reg(1, ioaddr, ADDR2_REG, val);
			break;
 
		case CTL_SMC_REG_GPR:	// General Purpose
			smc_modify_reg(1, ioaddr, GP_REG, val);
			break;
 
		case CTL_SMC_REG_CTLR:	// Control
			smc_modify_reg(1, ioaddr, CTL_REG, val);
			break;
 
		case CTL_SMC_REG_MCR:	// MMU Command
			smc_modify_reg(2, ioaddr, MMU_CMD_REG, val);
			break;
 
		case CTL_SMC_REG_PNR:	// Packet Number
			smc_modify_reg(2, ioaddr, PN_REG, val);
			break;
 
		case CTL_SMC_REG_FPR:	// Allocation Result/FIFO Ports
			smc_modify_reg(2, ioaddr, RXFIFO_REG, val);
			break;
 
		case CTL_SMC_REG_PTR:	// Pointer
			smc_modify_reg(2, ioaddr, PTR_REG, val);
			break;
 
		case CTL_SMC_REG_DR:	// Data 
			smc_modify_reg(2, ioaddr, DATA_REG, val);
			break;
 
		case CTL_SMC_REG_ISR:	// Interrupt Status/Mask
			smc_modify_reg(2, ioaddr, INT_REG, val);
			break;
 
		case CTL_SMC_REG_MTR1:	// Multicast Table Entry 1
			smc_modify_reg(3, ioaddr, MCAST_REG1, val);
			break;
 
		case CTL_SMC_REG_MTR2:	// Multicast Table Entry 2
			smc_modify_reg(3, ioaddr, MCAST_REG2, val);
			break;
 
		case CTL_SMC_REG_MTR3:	// Multicast Table Entry 3
			smc_modify_reg(3, ioaddr, MCAST_REG3, val);
			break;
 
		case CTL_SMC_REG_MTR4:	// Multicast Table Entry 4
			smc_modify_reg(3, ioaddr, MCAST_REG4, val);
			break;
 
		case CTL_SMC_REG_MIIR:	// Management Interface
			smc_modify_reg(3, ioaddr, MII_REG, val);
			break;
 
		case CTL_SMC_REG_REVR:	// Revision
			smc_modify_reg(3, ioaddr, REV_REG, val);
			break;
 
		case CTL_SMC_REG_ERCVR:	// Early RCV
			smc_modify_reg(3, ioaddr, ERCV_REG, val);
			break;
 
		case CTL_SMC_REG_EXTR:	// External
			smc_modify_reg(7, ioaddr, EXT_REG, val);
			break;
 
		case CTL_SMC_PHY_CTRL:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_CNTL_REG, val);
			break;
 
		case CTL_SMC_PHY_STAT:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_STAT_REG, val);
			break;
 
		case CTL_SMC_PHY_ID1:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_ID1_REG, val);
			break;
 
		case CTL_SMC_PHY_ID2:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_ID2_REG, val);
			break;
 
		case CTL_SMC_PHY_ADC:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_AD_REG, val);
			break;
 
		case CTL_SMC_PHY_REMC:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_RMT_REG, val);
			break;
 
		case CTL_SMC_PHY_CFG1:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_CFG1_REG, val);
			break;
 
		case CTL_SMC_PHY_CFG2:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_CFG2_REG, val);
			break;
 
		case CTL_SMC_PHY_INT:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_INT_REG, val);
			break;
 
		case CTL_SMC_PHY_MASK:
			smc_write_phy_register(ioaddr, lp->phyaddr,
				PHY_MASK_REG, val);
			break;
 
#endif // SMC_DEBUG
 
		default:
			// Just ignore unsupported parameters
			break;
		} // end switch
 
	} // end if
 
        return ret;
}
 
 
#ifdef MODULE
/*
 * This is called as the fill_inode function when an inode
 * is going into (fill = 1) or out of service (fill = 0).
 * We use it here to manage the module use counts.
 *
 * Note: only the top-level directory needs to do this; if
 * a lower level is referenced, the parent will be as well.
 */
static void smc_procfs_modcount(struct inode *inode, int fill)
{
	if (fill) {
		MOD_INC_USE_COUNT;
	} else {
		MOD_DEC_USE_COUNT;
	}
}
#endif // MODULE
 
/*------------------------------------------------------------
 . Sysctl registration function for all parameters (files)
 .-------------------------------------------------------------*/
static void smc_sysctl_register(struct device *dev)
{
	struct smc_local *lp = (struct smc_local *)dev->priv;
	//static int ctl_name = CTL_SMC;
	static int ctl_name = "SMC91111";
	ctl_table* ct;
	int i;
 
	// Make sure the ctl_tables start out as all zeros
	memset(lp->root_table, 0, sizeof lp->root_table);
	memset(lp->eth_table, 0, sizeof lp->eth_table);
	memset(lp->param_table, 0, sizeof lp->param_table);
 
	// Initialize the root table
	ct = lp->root_table;
	ct->ctl_name = CTL_DEV;
	ct->procname = "dev";
	ct->maxlen = 0;
	ct->mode = 0555;
	ct->child = lp->eth_table;
	// remaining fields are zero
 
	// Initialize the ethX table (this device's table)
	ct = lp->eth_table;
	ct->ctl_name = ctl_name++; // Must be unique
	ct->procname = dev->name;
	ct->maxlen = 0;
	ct->mode = 0555;
	ct->child = lp->param_table;
	// remaining fields are zero
 
	// Initialize the parameter (files) table
	// Make sure the last entry remains null
	ct = lp->param_table;
	for (i = 0; i < (CTL_SMC_LAST_ENTRY-1); ++i)
		{
		// Initialize fields common to all table entries
		ct[i].proc_handler = smc_sysctl_handler;
		ct[i].extra1 = (void*)dev; // Save our device pointer
		ct[i].extra2 = (void*)lp;  // Save our smc_local data pointer
		}
 
	// INFO - this is our only string parameter
	i = 0;
	ct[i].proc_handler = proc_dostring; // use default handler
	ct[i].ctl_name = CTL_SMC_INFO;
	ct[i].procname = "info";
	ct[i].data = (void*)smc_info_string;
	ct[i].maxlen = sizeof smc_info_string;
	ct[i].mode = 0444; // Read only
 
	// SWVER
	++i;
	ct[i].proc_handler = proc_dostring; // use default handler
	ct[i].ctl_name = CTL_SMC_SWVER;
	ct[i].procname = "swver";
	ct[i].data = (void*)version;
	ct[i].maxlen = sizeof version;
	ct[i].mode = 0444; // Read only
 
	// SWFDUP
	++i;
	ct[i].ctl_name = CTL_SMC_SWFDUP;
	ct[i].procname = "swfdup";
	ct[i].data = (void*)&(lp->ctl_swfdup);
	ct[i].maxlen = sizeof lp->ctl_swfdup;
	ct[i].mode = 0644; // Read by all, write by root
 
	// EPHLOOP
	++i;
	ct[i].ctl_name = CTL_SMC_EPHLOOP;
	ct[i].procname = "ephloop";
	ct[i].data = (void*)&(lp->ctl_ephloop);
	ct[i].maxlen = sizeof lp->ctl_ephloop;
	ct[i].mode = 0644; // Read by all, write by root
 
	// MIIOP
	++i;
	ct[i].ctl_name = CTL_SMC_MIIOP;
	ct[i].procname = "miiop";
	ct[i].data = (void*)&(lp->ctl_miiop);
	ct[i].maxlen = sizeof lp->ctl_miiop;
	ct[i].mode = 0644; // Read by all, write by root
 
	// AUTONEG
	++i;
	ct[i].ctl_name = CTL_SMC_AUTONEG;
	ct[i].procname = "autoneg";
	ct[i].data = (void*)&(lp->ctl_autoneg);
	ct[i].maxlen = sizeof lp->ctl_autoneg;
	ct[i].mode = 0644; // Read by all, write by root
 
	// RFDUPLX
	++i;
	ct[i].ctl_name = CTL_SMC_RFDUPLX;
	ct[i].procname = "rfduplx";
	ct[i].data = (void*)&(lp->ctl_rfduplx);
	ct[i].maxlen = sizeof lp->ctl_rfduplx;
	ct[i].mode = 0644; // Read by all, write by root
 
	// RSPEED
	++i;
	ct[i].ctl_name = CTL_SMC_RSPEED;
	ct[i].procname = "rspeed";
	ct[i].data = (void*)&(lp->ctl_rspeed);
	ct[i].maxlen = sizeof lp->ctl_rspeed;
	ct[i].mode = 0644; // Read by all, write by root
 
	// AFDUPLX
	++i;
	ct[i].ctl_name = CTL_SMC_AFDUPLX;
	ct[i].procname = "afduplx";
	ct[i].data = (void*)&(lp->ctl_afduplx);
	ct[i].maxlen = sizeof lp->ctl_afduplx;
	ct[i].mode = 0444; // Read only
 
	// ASPEED
	++i;
	ct[i].ctl_name = CTL_SMC_ASPEED;
	ct[i].procname = "aspeed";
	ct[i].data = (void*)&(lp->ctl_aspeed);
	ct[i].maxlen = sizeof lp->ctl_aspeed;
	ct[i].mode = 0444; // Read only
 
	// LNKFAIL
	++i;
	ct[i].ctl_name = CTL_SMC_LNKFAIL;
	ct[i].procname = "lnkfail";
	ct[i].data = (void*)&(lp->ctl_lnkfail);
	ct[i].maxlen = sizeof lp->ctl_lnkfail;
	ct[i].mode = 0444; // Read only
 
	// FORCOL
	++i;
	ct[i].ctl_name = CTL_SMC_FORCOL;
	ct[i].procname = "forcol";
	ct[i].data = (void*)&(lp->ctl_forcol);
	ct[i].maxlen = sizeof lp->ctl_forcol;
	ct[i].mode = 0644; // Read by all, write by root
 
	// FILTCAR
	++i;
	ct[i].ctl_name = CTL_SMC_FILTCAR;
	ct[i].procname = "filtcar";
	ct[i].data = (void*)&(lp->ctl_filtcar);
	ct[i].maxlen = sizeof lp->ctl_filtcar;
	ct[i].mode = 0644; // Read by all, write by root
 
	// FREEMEM
	++i;
	ct[i].ctl_name = CTL_SMC_FREEMEM;
	ct[i].procname = "freemem";
	ct[i].data = (void*)&(lp->ctl_freemem);
	ct[i].maxlen = sizeof lp->ctl_freemem;
	ct[i].mode = 0444; // Read only
 
	// TOTMEM
	++i;
	ct[i].ctl_name = CTL_SMC_TOTMEM;
	ct[i].procname = "totmem";
	ct[i].data = (void*)&(lp->ctl_totmem);
	ct[i].maxlen = sizeof lp->ctl_totmem;
	ct[i].mode = 0444; // Read only
 
	// LEDA
	++i;
	ct[i].ctl_name = CTL_SMC_LEDA;
	ct[i].procname = "leda";
	ct[i].data = (void*)&(lp->ctl_leda);
	ct[i].maxlen = sizeof lp->ctl_leda;
	ct[i].mode = 0644; // Read by all, write by root
 
	// LEDB
	++i;
	ct[i].ctl_name = CTL_SMC_LEDB;
	ct[i].procname = "ledb";
	ct[i].data = (void*)&(lp->ctl_ledb);
	ct[i].maxlen = sizeof lp->ctl_ledb;
	ct[i].mode = 0644; // Read by all, write by root
 
	// CHIPREV
	++i;
	ct[i].ctl_name = CTL_SMC_CHIPREV;
	ct[i].procname = "chiprev";
	ct[i].data = (void*)&(lp->ctl_chiprev);
	ct[i].maxlen = sizeof lp->ctl_chiprev;
	ct[i].mode = 0444; // Read only
 
#ifdef SMC_DEBUG
	// REG_BSR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_BSR;
	ct[i].procname = "reg_bsr";
	ct[i].data = (void*)&(lp->ctl_reg_bsr);
	ct[i].maxlen = sizeof lp->ctl_reg_bsr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_TCR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_TCR;
	ct[i].procname = "reg_tcr";
	ct[i].data = (void*)&(lp->ctl_reg_tcr);
	ct[i].maxlen = sizeof lp->ctl_reg_tcr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_ESR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_ESR;
	ct[i].procname = "reg_esr";
	ct[i].data = (void*)&(lp->ctl_reg_esr);
	ct[i].maxlen = sizeof lp->ctl_reg_esr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_RCR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_RCR;
	ct[i].procname = "reg_rcr";
	ct[i].data = (void*)&(lp->ctl_reg_rcr);
	ct[i].maxlen = sizeof lp->ctl_reg_rcr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_CTRR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_CTRR;
	ct[i].procname = "reg_ctrr";
	ct[i].data = (void*)&(lp->ctl_reg_ctrr);
	ct[i].maxlen = sizeof lp->ctl_reg_ctrr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_MIR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_MIR;
	ct[i].procname = "reg_mir";
	ct[i].data = (void*)&(lp->ctl_reg_mir);
	ct[i].maxlen = sizeof lp->ctl_reg_mir;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_RPCR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_RPCR;
	ct[i].procname = "reg_rpcr";
	ct[i].data = (void*)&(lp->ctl_reg_rpcr);
	ct[i].maxlen = sizeof lp->ctl_reg_rpcr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_CFGR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_CFGR;
	ct[i].procname = "reg_cfgr";
	ct[i].data = (void*)&(lp->ctl_reg_cfgr);
	ct[i].maxlen = sizeof lp->ctl_reg_cfgr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_BAR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_BAR;
	ct[i].procname = "reg_bar";
	ct[i].data = (void*)&(lp->ctl_reg_bar);
	ct[i].maxlen = sizeof lp->ctl_reg_bar;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_IAR0
	++i;
	ct[i].ctl_name = CTL_SMC_REG_IAR0;
	ct[i].procname = "reg_iar0";
	ct[i].data = (void*)&(lp->ctl_reg_iar0);
	ct[i].maxlen = sizeof lp->ctl_reg_iar0;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_IAR1
	++i;
	ct[i].ctl_name = CTL_SMC_REG_IAR1;
	ct[i].procname = "reg_iar1";
	ct[i].data = (void*)&(lp->ctl_reg_iar1);
	ct[i].maxlen = sizeof lp->ctl_reg_iar1;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_IAR2
	++i;
	ct[i].ctl_name = CTL_SMC_REG_IAR2;
	ct[i].procname = "reg_iar2";
	ct[i].data = (void*)&(lp->ctl_reg_iar2);
	ct[i].maxlen = sizeof lp->ctl_reg_iar2;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_GPR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_GPR;
	ct[i].procname = "reg_gpr";
	ct[i].data = (void*)&(lp->ctl_reg_gpr);
	ct[i].maxlen = sizeof lp->ctl_reg_gpr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_CTLR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_CTLR;
	ct[i].procname = "reg_ctlr";
	ct[i].data = (void*)&(lp->ctl_reg_ctlr);
	ct[i].maxlen = sizeof lp->ctl_reg_ctlr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_MCR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_MCR;
	ct[i].procname = "reg_mcr";
	ct[i].data = (void*)&(lp->ctl_reg_mcr);
	ct[i].maxlen = sizeof lp->ctl_reg_mcr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_PNR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_PNR;
	ct[i].procname = "reg_pnr";
	ct[i].data = (void*)&(lp->ctl_reg_pnr);
	ct[i].maxlen = sizeof lp->ctl_reg_pnr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_FPR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_FPR;
	ct[i].procname = "reg_fpr";
	ct[i].data = (void*)&(lp->ctl_reg_fpr);
	ct[i].maxlen = sizeof lp->ctl_reg_fpr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_PTR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_PTR;
	ct[i].procname = "reg_ptr";
	ct[i].data = (void*)&(lp->ctl_reg_ptr);
	ct[i].maxlen = sizeof lp->ctl_reg_ptr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_DR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_DR;
	ct[i].procname = "reg_dr";
	ct[i].data = (void*)&(lp->ctl_reg_dr);
	ct[i].maxlen = sizeof lp->ctl_reg_dr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_ISR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_ISR;
	ct[i].procname = "reg_isr";
	ct[i].data = (void*)&(lp->ctl_reg_isr);
	ct[i].maxlen = sizeof lp->ctl_reg_isr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_MTR1
	++i;
	ct[i].ctl_name = CTL_SMC_REG_MTR1;
	ct[i].procname = "reg_mtr1";
	ct[i].data = (void*)&(lp->ctl_reg_mtr1);
	ct[i].maxlen = sizeof lp->ctl_reg_mtr1;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_MTR2
	++i;
	ct[i].ctl_name = CTL_SMC_REG_MTR2;
	ct[i].procname = "reg_mtr2";
	ct[i].data = (void*)&(lp->ctl_reg_mtr2);
	ct[i].maxlen = sizeof lp->ctl_reg_mtr2;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_MTR3
	++i;
	ct[i].ctl_name = CTL_SMC_REG_MTR3;
	ct[i].procname = "reg_mtr3";
	ct[i].data = (void*)&(lp->ctl_reg_mtr3);
	ct[i].maxlen = sizeof lp->ctl_reg_mtr3;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_MTR4
	++i;
	ct[i].ctl_name = CTL_SMC_REG_MTR4;
	ct[i].procname = "reg_mtr4";
	ct[i].data = (void*)&(lp->ctl_reg_mtr4);
	ct[i].maxlen = sizeof lp->ctl_reg_mtr4;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_MIIR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_MIIR;
	ct[i].procname = "reg_miir";
	ct[i].data = (void*)&(lp->ctl_reg_miir);
	ct[i].maxlen = sizeof lp->ctl_reg_miir;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_REVR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_REVR;
	ct[i].procname = "reg_revr";
	ct[i].data = (void*)&(lp->ctl_reg_revr);
	ct[i].maxlen = sizeof lp->ctl_reg_revr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_ERCVR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_ERCVR;
	ct[i].procname = "reg_ercvr";
	ct[i].data = (void*)&(lp->ctl_reg_ercvr);
	ct[i].maxlen = sizeof lp->ctl_reg_ercvr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// REG_EXTR
	++i;
	ct[i].ctl_name = CTL_SMC_REG_EXTR;
	ct[i].procname = "reg_extr";
	ct[i].data = (void*)&(lp->ctl_reg_extr);
	ct[i].maxlen = sizeof lp->ctl_reg_extr;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY Control
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_CTRL;
	ct[i].procname = "phy_ctrl";
	ct[i].data = (void*)&(lp->ctl_phy_ctrl);
	ct[i].maxlen = sizeof lp->ctl_phy_ctrl;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY Status
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_STAT;
	ct[i].procname = "phy_stat";
	ct[i].data = (void*)&(lp->ctl_phy_stat);
	ct[i].maxlen = sizeof lp->ctl_phy_stat;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY ID1
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_ID1;
	ct[i].procname = "phy_id1";
	ct[i].data = (void*)&(lp->ctl_phy_id1);
	ct[i].maxlen = sizeof lp->ctl_phy_id1;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY ID2
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_ID2;
	ct[i].procname = "phy_id2";
	ct[i].data = (void*)&(lp->ctl_phy_id2);
	ct[i].maxlen = sizeof lp->ctl_phy_id2;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY Advertise Capabilities
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_ADC;
	ct[i].procname = "phy_adc";
	ct[i].data = (void*)&(lp->ctl_phy_adc);
	ct[i].maxlen = sizeof lp->ctl_phy_adc;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY Remote Capabilities
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_REMC;
	ct[i].procname = "phy_remc";
	ct[i].data = (void*)&(lp->ctl_phy_remc);
	ct[i].maxlen = sizeof lp->ctl_phy_remc;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY Configuration 1
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_CFG1;
	ct[i].procname = "phy_cfg1";
	ct[i].data = (void*)&(lp->ctl_phy_cfg1);
	ct[i].maxlen = sizeof lp->ctl_phy_cfg1;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY Configuration 2
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_CFG2;
	ct[i].procname = "phy_cfg2";
	ct[i].data = (void*)&(lp->ctl_phy_cfg2);
	ct[i].maxlen = sizeof lp->ctl_phy_cfg2;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY Interrupt/Status Output
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_INT;
	ct[i].procname = "phy_int";
	ct[i].data = (void*)&(lp->ctl_phy_int);
	ct[i].maxlen = sizeof lp->ctl_phy_int;
	ct[i].mode = 0644; // Read by all, write by root
 
	// PHY Interrupt/Status Mask
	++i;
	ct[i].ctl_name = CTL_SMC_PHY_MASK;
	ct[i].procname = "phy_mask";
	ct[i].data = (void*)&(lp->ctl_phy_mask);
	ct[i].maxlen = sizeof lp->ctl_phy_mask;
	ct[i].mode = 0644; // Read by all, write by root
 
#endif // SMC_DEBUG
 
	// Register /proc/sys/dev/ethX
	lp->sysctl_header = register_sysctl_table(lp->root_table, 1);
 
#ifdef MODULE
	// Register our modcount function which adjusts the module count
	lp->root_table->child->de->fill_inode = smc_procfs_modcount;
#endif // MODULE
 
}
 
 
/*------------------------------------------------------------
 . Sysctl unregistration when driver is closed
 .-------------------------------------------------------------*/
static void smc_sysctl_unregister(struct device *dev)
{
	struct smc_local *lp = (struct smc_local *)dev->priv;
 
	unregister_sysctl_table(lp->sysctl_header);
}
 
#endif /* endif CONFIG_SYSCTL */
 
 
//---PHY CONTROL AND CONFIGURATION-----------------------------------------
 
 
/*------------------------------------------------------------
 . Debugging function for viewing MII Management serial bitstream
 .-------------------------------------------------------------*/
#if (SMC_DEBUG > 2 )
static void smc_dump_mii_stream(byte* bits, int size)
{
#if (SMC_DEBUG > 3 )
	int i;
 
	printk("BIT#:");
	for (i = 0; i < size; ++i)
		{
		printk("%d", i%10);
		}
 
	printk("\nMDOE:");
	for (i = 0; i < size; ++i)
		{
		if (bits[i] & MII_MDOE)
			printk("1");
		else
			printk("0");
		}
 
	printk("\nMDO :");
	for (i = 0; i < size; ++i)
		{
		if (bits[i] & MII_MDO)
			printk("1");
		else
			printk("0");
		}
 
	printk("\nMDI :");
	for (i = 0; i < size; ++i)
		{
		if (bits[i] & MII_MDI)
			printk("1");
		else
			printk("0");
		}
 
	printk("\n");
#endif
}
#endif
 
#if 0
static word smc_interpret_phy_register(const struct device *dev,
        byte phyreg, word status)
{
#if (SMC_DEBUG > 3)
    switch(phyreg)
    {
        case PHY_STAT_REG:
            if(status & PHY_STAT_CAP_T4)
                printk("<1>%s:100 Base T4 capable\n", dev->name);
            else
                printk("<1>%s:100 Base T4 incapable\n", dev->name);
 
            if(status & PHY_STAT_CAP_TXF)
                printk("<1>%s:100 Base X, Full Duplex capable\n", dev->name);
            else
                printk("<1>%s:100 Base X, Full Duplex incapable\n", dev->name);
 
            if(status & PHY_STAT_CAP_TXH)
                printk("<1>%s:100 Base X, Half Duplex capable\n", dev->name);
            else
                printk("<1>%s:100 Base X, Half Duplex incapable\n", dev->name);
 
            if(status & PHY_STAT_CAP_TF)
                printk("<1>%s:10 Base X, Full Duplex capable\n", dev->name);
            else
                printk("<1>%s:10 Base X, Full Duplex incapable\n", dev->name);
 
            if(status & PHY_STAT_RESERVED)
                printk("<1>%s:Reserved bits set 0x%x(bad thing :-(\n",
                        dev->name, status & PHY_STAT_RESERVED);
            else
                printk("<1>%s:Reserved bits not set(good thing :-)\n",
                        dev->name);
 
            if(status & PHY_STAT_CAP_SUPR)
                printk("<1>%s:MI Preamble suppression capable\n", dev->name);
            else
                printk("<1>%s:MI Preamble suppression incapable\n", dev->name);
 
            if(status & PHY_STAT_ANEG_ACK)
                printk("<1>%s:Auto-Negotiation Acknowledgment completed\n",
                        dev->name);
            else
                printk("<1>%s:Auto-Negotiation Acknowledgment incomplete\n",
                        dev->name);
 
            if(status & PHY_STAT_REM_FLT)
                printk("<1>%s:Remote Fault Detected :-(\n", dev->name);
            else
                printk("<1>%s:Remote Fault NOT Detected :-)\n", dev->name);
 
            if(status & PHY_STAT_CAP_ANEG)
                printk("<1>%s:Auto-Negotiate Capable\n", dev->name);
            else
                printk("<1>%s:Auto-Negotiate InCapable\n", dev->name);
 
            if(status & PHY_STAT_LINK)
                printk("<1>%s:Valid Link Detected\n", dev->name);
            else
                printk("<1>%s:Invalid Link Detected\n", dev->name);
 
            if(status & PHY_STAT_JAB)
                printk("<1>%s:Jabber Detected\n", dev->name);
            else
                printk("<1>%s:Jabber Not Detected\n", dev->name);
 
            if(status & PHY_STAT_EXREG)
                printk("<1>%s:Extended Registers Implemented\n", dev->name);
            else
                printk("<1>%s:Extended Registers Not Implemented\n", dev->name);
 
            break;
 
        case PHY_INT_REG:
            if(status & PHY_INT_INT)
                printk("<1>%s:Bits have changed since last read\n", dev->name);
            else
                printk("<1>%s:Bits have not changed since last read\n",
                        dev->name);
 
            if(status & PHY_INT_LNKFAIL)
                printk("<1>%s:Link Fail Detected\n", dev->name);
            else
                printk("<1>%s:Link Normal Detected\n", dev->name);
 
            if(status & PHY_INT_LOSSSYNC)
                printk("<1>%s:Descrambler lost sync\n", dev->name);
            else
                printk("<1>%s:No loss of sync\n", dev->name);
 
            if(status & PHY_INT_CWRD)
                printk("<1>%s:Invalid 4B5B Code Word received\n", dev->name);
            else
                printk("<1>%s:No Invalid 4B5B Code Word\n", dev->name);
 
            if(status & PHY_INT_SSD)
                printk("<1>%s:No Start of stream detected on rx\n", dev->name);
            else
                printk("<1>%s:Start of stream detected on rx\n", dev->name);
 
            if(status & PHY_INT_ESD)
                printk("<1>%s:No End of stream detected on rx\n", dev->name);
            else
                printk("<1>%s:End of stream detected on rx\n", dev->name);
 
            if(status & PHY_INT_RPOL)
                printk("<1>%s:Reverse Polarity Detected\n", dev->name);
            else
                printk("<1>%s:Normal Polarity Detected\n", dev->name);
 
            if(status & PHY_INT_JAB)
                printk("<1>%s:Jabber Detected\n", dev->name);
            else
                printk("<1>%s:Jabber Not Detected\n", dev->name);
 
            if(status & PHY_INT_SPDDET)
                printk("<1>%s:100 MBps Operation\n", dev->name);
            else
                printk("<1>%s:10 MBps Operation\n", dev->name);
 
            if(status & PHY_INT_DPLXDET)
                printk("<1>%s:Device in Full Duplex Mode\n", dev->name);
            else
                printk("<1>%s:Device in Half Duplex Mode\n", dev->name);
 
            break;
 
        default:
            printk(KERN_DEBUG
                    "%s:Don't Know How to interpret the specified register\n",
                    dev->name);
            break;
    }
#endif
    return(status);
}
#endif
 
/*------------------------------------------------------------
 . Reads a register from the MII Management serial interface
 .-------------------------------------------------------------*/
static word smc_read_phy_register(unsigned long ioaddr, byte phyaddr,
        byte phyreg)
{
	int oldBank;
	int i;
	byte mask;
	word mii_reg;
	byte bits[64];
	int clk_idx = 0;
	int input_idx;
	word phydata;
 
	// 32 consecutive ones on MDO to establish sync
    for (i = 0; i < 32; ++i)
        bits[clk_idx++] = MII_MDOE | MII_MDO;
 
	// Start code <01>
	bits[clk_idx++] = MII_MDOE;
	bits[clk_idx++] = MII_MDOE | MII_MDO;
 
	// Read command <10>
	bits[clk_idx++] = MII_MDOE | MII_MDO;
	bits[clk_idx++] = MII_MDOE;
 
	// Output the PHY address, msb first
	mask = (byte)0x10;
	for (i = 0; i < 5; ++i)
    {
        if (phyaddr & mask)
            bits[clk_idx++] = MII_MDOE | MII_MDO;
        else
            bits[clk_idx++] = MII_MDOE;
        // Shift to next lowest bit
        mask >>= 1;
    }
 
	// Output the phy register number, msb first
	mask = (byte)0x10;
	for (i = 0; i < 5; ++i)
    {
        if (phyreg & mask)
            bits[clk_idx++] = MII_MDOE | MII_MDO;
        else
            bits[clk_idx++] = MII_MDOE;
        // Shift to next lowest bit
        mask >>= 1;
    }
 
	// Tristate and turnaround (2 bit times)
	bits[clk_idx++] = 0;
	//bits[clk_idx++] = 0;
 
	// Input starts at this bit time
	input_idx = clk_idx;
 
	// Will input 16 bits
	for (i = 0; i < 16; ++i)
		bits[clk_idx++] = 0;
 
	// Final clock bit
	bits[clk_idx++] = 0;
 
	// Save the current bank
	oldBank = inw( ioaddr+BANK_SELECT );
 
	// Select bank 3
	SMC_SELECT_BANK( 3 );
 
	// Get the current MII register value
	mii_reg = inw( ioaddr+MII_REG );
 
	// Turn off all MII Interface bits
	mii_reg &= ~(MII_MDOE|MII_MCLK|MII_MDI|MII_MDO);
 
	// Clock all 64 cycles
	for (i = 0; i < sizeof bits; ++i)
		{
		// Clock Low - output data
		outw( mii_reg | bits[i], ioaddr+MII_REG );
		udelay(50);
 
 
		// Clock Hi - input data
		outw( mii_reg | bits[i] | MII_MCLK, ioaddr+MII_REG );
		udelay(50);
		bits[i] |= inw( ioaddr+MII_REG ) & MII_MDI;
		}
 
	// Return to idle state
	// Set clock to low, data to low, and output tristated
	outw( mii_reg, ioaddr+MII_REG );
	udelay(50);
 
	// Restore original bank select
	SMC_SELECT_BANK( oldBank );
 
	// Recover input data
	phydata = 0;
	for (i = 0; i < 16; ++i)
		{
		phydata <<= 1;
 
		if (bits[input_idx++] & MII_MDI)
			phydata |= 0x0001;
		}
 
//    printk("Slow the system down by a bit.\n");
#if defined(CONFIG_SMC91C111_EXTRA_DELAY)
    mdelay(SMC91C111_EXTRA_DELAY);
#endif
#if (SMC_DEBUG > 2 )
	printk("smc_read_phy_register(): phyaddr=%x,phyreg=%x,phydata=%x\n",
		phyaddr, phyreg, phydata);
	smc_dump_mii_stream(bits, sizeof bits);
#endif
 
	return(phydata);	
}
 
 
/*------------------------------------------------------------
 . Writes a register to the MII Management serial interface
 .-------------------------------------------------------------*/
static void smc_write_phy_register(unsigned long ioaddr,
	byte phyaddr, byte phyreg, word phydata)
{
	int oldBank;
	int i;
	word mask;
	word mii_reg;
	byte bits[65];
	int clk_idx = 0;
 
	// 32 consecutive ones on MDO to establish sync
	for (i = 0; i < 32; ++i)
		bits[clk_idx++] = MII_MDOE | MII_MDO;
 
	// Start code <01>
	bits[clk_idx++] = MII_MDOE;
	bits[clk_idx++] = MII_MDOE | MII_MDO;
 
	// Write command <01>
	bits[clk_idx++] = MII_MDOE;
	bits[clk_idx++] = MII_MDOE | MII_MDO;
 
	// Output the PHY address, msb first
	mask = (byte)0x10;
	for (i = 0; i < 5; ++i)
		{
		if (phyaddr & mask)
			bits[clk_idx++] = MII_MDOE | MII_MDO;
		else
			bits[clk_idx++] = MII_MDOE;
 
		// Shift to next lowest bit
		mask >>= 1;
		}
 
	// Output the phy register number, msb first
	mask = (byte)0x10;
	for (i = 0; i < 5; ++i)
		{
		if (phyreg & mask)
			bits[clk_idx++] = MII_MDOE | MII_MDO;
		else
			bits[clk_idx++] = MII_MDOE;
 
		// Shift to next lowest bit
		mask >>= 1;
		}
 
	// Tristate and turnaround (2 bit times)
	bits[clk_idx++] = 0;
	bits[clk_idx++] = 0;
 
	// Write out 16 bits of data, msb first
	mask = 0x8000;
	for (i = 0; i < 16; ++i)
		{
		if (phydata & mask)
			bits[clk_idx++] = MII_MDOE | MII_MDO;
		else
			bits[clk_idx++] = MII_MDOE;
 
		// Shift to next lowest bit
		mask >>= 1;
		}
 
	// Final clock bit (tristate)
	bits[clk_idx++] = 0;
 
	// Save the current bank
	oldBank = inw( ioaddr+BANK_SELECT );
 
	// Select bank 3
	SMC_SELECT_BANK( 3 );
 
	// Get the current MII register value
	mii_reg = inw( ioaddr+MII_REG );
 
	// Turn off all MII Interface bits
	mii_reg &= ~(MII_MDOE|MII_MCLK|MII_MDI|MII_MDO);
 
	// Clock all cycles
	for (i = 0; i < sizeof bits; ++i)
		{
		// Clock Low - output data
		outw( mii_reg | bits[i], ioaddr+MII_REG );
		udelay(50);
 
 
		// Clock Hi - input data
		outw( mii_reg | bits[i] | MII_MCLK, ioaddr+MII_REG );
		udelay(50);
		bits[i] |= inw( ioaddr+MII_REG ) & MII_MDI;
		}
 
	// Return to idle state
	// Set clock to low, data to low, and output tristated
	outw( mii_reg, ioaddr+MII_REG );
	udelay(50);
 
	// Restore original bank select
	SMC_SELECT_BANK( oldBank );
 
//    printk("Slow the system down by a bit.\n");
#if defined(CONFIG_SMC91C111_EXTRA_DELAY)
    mdelay(20);
#endif
#if (SMC_DEBUG > 2 )
	printk("smc_write_phy_register(): phyaddr=%x,phyreg=%x,phydata=%x\n",
		phyaddr, phyreg, phydata);
	smc_dump_mii_stream(bits, sizeof bits);
#endif
}
 
 
/*------------------------------------------------------------
 . Finds and reports the PHY address
 .-------------------------------------------------------------*/
static int smc_detect_phy(struct device* dev)
{
	struct smc_local *lp = (struct smc_local *)dev->priv;
	unsigned long ioaddr = dev->base_addr;
	word phy_id1;
	word phy_id2;
	int phyaddr;
	int found = 0;
 
	PRINTK3("%s:smc_detect_phy()\n", dev->name);
 
	// Scan all 32 PHY addresses if necessary
	for (phyaddr = 0; phyaddr < 32; ++phyaddr)
		{
		// Read the PHY identifiers
		phy_id1  = smc_read_phy_register(ioaddr, phyaddr, PHY_ID1_REG);
		phy_id2  = smc_read_phy_register(ioaddr, phyaddr, PHY_ID2_REG);
 
		PRINTK3("%s: phy_id1=%x, phy_id2=%x\n",
			dev->name, phy_id1, phy_id2);
 
		// Make sure it is a valid identifier	
		if ((phy_id2 > 0x0000) && (phy_id2 < 0xffff) &&
		    (phy_id1 > 0x0000) && (phy_id1 < 0xffff))
			{
			if ((phy_id1 != 0x8000) && (phy_id2 != 0x8000))
				{
				// Save the PHY's address
				lp->phyaddr = phyaddr;
				found = 1;
				break;
				}
			}
		}
 
	if (!found)
		{
		PRINTK("%s: No PHY found\n", dev->name);
		return(0);
		}
 
	// Set the PHY type
	if ( (phy_id1 == 0x0016) && ((phy_id2 & 0xFFF0) == 0xF840 ) )
		{
		lp->phytype = PHY_LAN83C183;
		PRINTK("%s: PHY=LAN83C183 (LAN91C111 Internal)\n", dev->name);
		}
 
	if ( (phy_id1 == 0x0282) && ((phy_id2 & 0xFFF0) == 0x1C50) )
		{
		lp->phytype = PHY_LAN83C180;
		PRINTK("%s: PHY=LAN83C180\n", dev->name);
		}
 
 
	return(1);
}
 
/*------------------------------------------------------------
 . Waits the specified number of milliseconds - kernel friendly
 .-------------------------------------------------------------*/
static void smc_wait_ms(unsigned int ms)
{
 
	if (!in_interrupt())
		{
		current->state = TASK_UNINTERRUPTIBLE;
		schedule_timeout(1 + ms * HZ / 1000);
		}
	else
		{
		current->state = TASK_INTERRUPTIBLE;
		schedule_timeout(1 + ms * HZ / 1000);
		current->state = TASK_RUNNING;
		}
}
 
/*------------------------------------------------------------
 . Sets the PHY to a configuration as determined by the user
 .-------------------------------------------------------------*/
#ifdef CONFIG_SYSCTL
static int smc_phy_fixed(struct device* dev)
{
	unsigned long ioaddr = dev->base_addr;
	struct smc_local *lp = (struct smc_local *)dev->priv;
	byte phyaddr = lp->phyaddr;
	word my_fixed_caps;
	word cfg1;
 
	PRINTK3("%s:smc_phy_fixed()\n", dev->name);
 
	// Enter Link Disable state
	cfg1 = smc_read_phy_register(ioaddr, phyaddr, PHY_CFG1_REG);
	cfg1 |= PHY_CFG1_LNKDIS;
	smc_write_phy_register(ioaddr, phyaddr, PHY_CFG1_REG, cfg1);
 
	// Set our fixed capabilities
	// Disable auto-negotiation
	my_fixed_caps = 0;
 
#ifdef CONFIG_SYSCTL
	if (lp->ctl_rfduplx)
		my_fixed_caps |= PHY_CNTL_DPLX;
 
	if (lp->ctl_rspeed == 100)
		my_fixed_caps |= PHY_CNTL_SPEED;
#endif
 
	// Write our capabilities to the phy control register
	smc_write_phy_register(ioaddr, phyaddr, PHY_CNTL_REG, my_fixed_caps);
 
	// Re-Configure the Receive/Phy Control register
	outw( lp->rpc_cur_mode, ioaddr + RPC_REG );
 
	// Success
	return(1);
}
#endif
 
/*------------------------------------------------------------
 . Configures the specified PHY using Autonegotiation. Calls
 . smc_phy_fixed() if the user has requested a certain config.
 .-------------------------------------------------------------*/
static void smc_phy_configure(struct device* dev)
{
	int ioaddr = dev->base_addr;
	struct smc_local *lp = (struct smc_local *)dev->priv;
	int timeout;
	byte phyaddr;
	word my_phy_caps; // My PHY capabilities
	word my_ad_caps; // My Advertised capabilities
	word status = 0;
	int failed = 0;
 
	PRINTK3("%s:smc_program_phy()\n", dev->name);
 
	// Set the blocking flag
	lp->autoneg_active = 1;
 
	// Find the address and type of our phy
	if (!smc_detect_phy(dev))
		{
		goto smc_phy_configure_exit;
		}
 
	// Get the detected phy address
	phyaddr = lp->phyaddr;
 
	// Reset the PHY, setting all other bits to zero
	smc_write_phy_register(ioaddr, phyaddr, PHY_CNTL_REG, PHY_CNTL_RST);
 
	// Wait for the reset to complete, or time out
	timeout = 6; // Wait up to 3 seconds
	while (timeout--)
		{
		if (!(smc_read_phy_register(ioaddr, phyaddr, PHY_CNTL_REG)
		    & PHY_CNTL_RST))
			{
			// reset complete
			break;
			}
 
		smc_wait_ms(500); // wait 500 millisecs
		if (signal_pending(current)) // Exit anyway if signaled
			{
			PRINTK2("%s:PHY reset interrupted by signal\n",
				dev->name);
			timeout = 0;
			break;
			}
		}
 
	if (timeout < 1)
		{
		PRINTK2("%s:PHY reset timed out\n", dev->name);
		goto smc_phy_configure_exit;
		}
 
	// Read PHY Register 18, Status Output
	lp->lastPhy18 = smc_read_phy_register(ioaddr, phyaddr, PHY_INT_REG);
 
	// Enable PHY Interrupts (for register 18)
	// Interrupts listed here are disabled
	smc_write_phy_register(ioaddr, phyaddr, PHY_MASK_REG, 
		PHY_INT_LOSSSYNC | PHY_INT_CWRD | PHY_INT_SSD |
		PHY_INT_ESD | PHY_INT_RPOL | PHY_INT_JAB |
		PHY_INT_SPDDET | PHY_INT_DPLXDET);
 
	/* Configure the Receive/Phy Control register */
	SMC_SELECT_BANK( 0 );
	outw( lp->rpc_cur_mode, ioaddr + RPC_REG );
 
	// Copy our capabilities from PHY_STAT_REG to PHY_AD_REG
	my_phy_caps = smc_read_phy_register(ioaddr, phyaddr, PHY_STAT_REG);
	my_ad_caps  = PHY_AD_CSMA; // I am CSMA capable
 
	if (my_phy_caps & PHY_STAT_CAP_T4)
		my_ad_caps |= PHY_AD_T4;
 
	if (my_phy_caps & PHY_STAT_CAP_TXF)
		my_ad_caps |= PHY_AD_TX_FDX;
 
	if (my_phy_caps & PHY_STAT_CAP_TXH)
		my_ad_caps |= PHY_AD_TX_HDX;
 
	if (my_phy_caps & PHY_STAT_CAP_TF)
		my_ad_caps |= PHY_AD_10_FDX;
 
	if (my_phy_caps & PHY_STAT_CAP_TH)
		my_ad_caps |= PHY_AD_10_HDX;
 
#if 0
	// Disable capabilities not selected by our user
	if (lp->ctl_rspeed != 100)
		{
		my_ad_caps &= ~(PHY_AD_T4|PHY_AD_TX_FDX|PHY_AD_TX_HDX);
		}
 
	if (!lp->ctl_rfduplx)
		{
		my_ad_caps &= ~(PHY_AD_TX_FDX|PHY_AD_10_FDX);
		}
#endif
 
	// Update our Auto-Neg Advertisement Register
	smc_write_phy_register(ioaddr, phyaddr, PHY_AD_REG, my_ad_caps);
 
	PRINTK2("%s:phy caps=%x\n", dev->name, my_phy_caps);
	PRINTK2("%s:phy advertised caps=%x\n", dev->name, my_ad_caps);
 
#if 0
	// If the user requested no auto neg, then go set his request
	if (!(lp->ctl_autoneg))
		{
		smc_phy_fixed(dev);
		goto smc_phy_configure_exit;
		}
#endif
 
	// Restart auto-negotiation process in order to advertise my caps
	smc_write_phy_register( ioaddr, phyaddr, PHY_CNTL_REG,
		PHY_CNTL_ANEG_EN | PHY_CNTL_ANEG_RST );
 
	// Wait for the auto-negotiation to complete.  This may take from
	// 2 to 3 seconds.
	// Wait for the reset to complete, or time out
	timeout = 20; // Wait up to 10 seconds
	while (timeout--)
		{
		status = smc_read_phy_register(ioaddr, phyaddr, PHY_STAT_REG);
		if (status & PHY_STAT_ANEG_ACK)
			{
			// auto-negotiate complete
			break;
			}
 
		smc_wait_ms(500); // wait 500 millisecs
		if (signal_pending(current)) // Exit anyway if signaled
			{
			printk(KERN_DEBUG
				"%s:PHY auto-negotiate interrupted by signal\n",
				dev->name);
			timeout = 0;
			break;
			}
 
		// Restart auto-negotiation if remote fault
		if (status & PHY_STAT_REM_FLT)
			{
			PRINTK2("%s:PHY remote fault detected\n", dev->name);
 
			// Restart auto-negotiation
			PRINTK2("%s:PHY restarting auto-negotiation\n",
				dev->name);
			smc_write_phy_register( ioaddr, phyaddr, PHY_CNTL_REG,
				PHY_CNTL_ANEG_EN | PHY_CNTL_ANEG_RST |
				PHY_CNTL_SPEED | PHY_CNTL_DPLX);
			}
		}
 
	if (timeout < 1)
		{
		printk(KERN_DEBUG "%s:PHY auto-negotiate timed out\n",
			dev->name);
		PRINTK2("%s:PHY auto-negotiate timed out\n", dev->name);
		failed = 1;
		}
 
	// Fail if we detected an auto-negotiate remote fault
	if (status & PHY_STAT_REM_FLT)
		{
		PRINTK2("%s:PHY remote fault detected\n", dev->name);
		failed = 1;
		}
 
	// The smc_phy_interrupt() routine will be called to update lastPhy18
 
	// Set our sysctl parameters to match auto-negotiation results
	if ( lp->lastPhy18 & PHY_INT_SPDDET )
		{
		PRINTK2("%s:PHY 100BaseT\n", dev->name);
		lp->rpc_cur_mode |= RPC_SPEED;
		}
	else
		{
		PRINTK2("%s:PHY 10BaseT\n", dev->name);
		lp->rpc_cur_mode &= ~RPC_SPEED;
		}
 
	if ( lp->lastPhy18 & PHY_INT_DPLXDET )
		{
		PRINTK2("%s:PHY Full Duplex\n", dev->name);
		lp->rpc_cur_mode |= RPC_DPLX;
		}
	else
		{
		PRINTK2("%s:PHY Half Duplex\n", dev->name);
		lp->rpc_cur_mode &= ~RPC_DPLX;
		}
 
	// Re-Configure the Receive/Phy Control register
	outw( lp->rpc_cur_mode, ioaddr + RPC_REG );
 
  smc_phy_configure_exit:
 
	// Exit auto-negotiation
	lp->autoneg_active = 0;
}
 
 
void smc_register_dump(const struct device *dev)
{
#if SMC_DEBUG > 3
    //Read all of the configuration registers.
    unsigned long ioaddr = dev->base_addr;
    word current_bank = inw(ioaddr + BANK_SELECT);
    int i;
 
    SMC_SELECT_BANK(0);
    PRINTK("%s:Register Dump Bank 0\n", dev->name);
    for(i = 0; i <= 0x0a; i = i + 2)
        PRINTK("\t%s:Bank 0 Register 0x%02x: 0x%04x\n", dev->name,
                i, inw(ioaddr + i));
 
    SMC_SELECT_BANK(1);
    PRINTK("%s:Register Dump Bank 1\n", dev->name);
    for(i = 0; i <= 0x0c; i = i + 2)
        PRINTK("\t%s:Bank 1 Register 0x%02x: 0x%04x\n", dev->name,
                i, inw(ioaddr + i));
 
    SMC_SELECT_BANK(2);
    PRINTK("%s:Register Dump Bank 2\n", dev->name);
    for(i = 0; i <= 0x0c; i = i + 2)
        PRINTK("\t%s:Bank 2 Register 0x%02x: 0x%04x\n", dev->name,
                i, inw(ioaddr + i));
 
    SMC_SELECT_BANK(3);
    PRINTK("%s:Register Dump Bank 3\n", dev->name);
    for(i = 0; i <= 0x0c; i = i + 2)
        PRINTK("\t%s:Bank 3 Register 0x%02x: 0x%04x\n", dev->name,
                i, inw(ioaddr + i));
 
    PRINTK("%s:Current Bank is 0x%04x\n", dev->name, current_bank);
    SMC_SELECT_BANK((current_bank&0x0007));
#endif
}
 
 
 
/*************************************************************************
 . smc_phy_interrupt
 .
 . Purpose:  Handle interrupts relating to PHY register 18. This is
 .  called from the "hard" interrupt handler.
 .
 ************************************************************************/
static void smc_phy_interrupt(struct device* dev)
{
	unsigned long ioaddr 		= dev->base_addr;
	struct smc_local *lp 	= (struct smc_local *)dev->priv;
	byte phyaddr = lp->phyaddr;
	word phy18;
 
	PRINTK2("%s: smc_phy_interrupt\n", dev->name);
 
  while (1)
	{ 
	// Read PHY Register 18, Status Output
	phy18 = smc_read_phy_register(ioaddr, phyaddr, PHY_INT_REG);
 
	// Exit if not more changes
	if (phy18 == lp->lastPhy18)
		break;
 
#if (SMC_DEBUG > 1 )
 
	PRINTK2("%s:     phy18=0x%x\n", dev->name, phy18);
	PRINTK2("%s: lastPhy18=0x%x\n", dev->name, lp->lastPhy18);
 
	// Handle events
	if ((phy18 & PHY_INT_LNKFAIL) != (lp->lastPhy18 & PHY_INT_LNKFAIL))
		{
		PRINTK2("%s: PHY Link Fail=%x\n", dev->name,
			phy18 & PHY_INT_LNKFAIL);
		}
 
	if ((phy18 & PHY_INT_LOSSSYNC) != (lp->lastPhy18 & PHY_INT_LOSSSYNC))
		{
		PRINTK2("%s: PHY LOSS SYNC=%x\n", dev->name,
			phy18 & PHY_INT_LOSSSYNC);
		}
 
	if ((phy18 & PHY_INT_CWRD) != (lp->lastPhy18 & PHY_INT_CWRD))
		{
		PRINTK2("%s: PHY INVALID 4B5B code=%x\n", dev->name,
			phy18 & PHY_INT_CWRD);
		}
 
	if ((phy18 & PHY_INT_SSD) != (lp->lastPhy18 & PHY_INT_SSD))
		{
		PRINTK2("%s: PHY No Start Of Stream=%x\n", dev->name,
			phy18 & PHY_INT_SSD);
		}
 
	if ((phy18 & PHY_INT_ESD) != (lp->lastPhy18 & PHY_INT_ESD))
		{
		PRINTK2("%s: PHY No End Of Stream=%x\n", dev->name,
			phy18 & PHY_INT_ESD);
		}
 
	if ((phy18 & PHY_INT_RPOL) != (lp->lastPhy18 & PHY_INT_RPOL))
		{
		PRINTK2("%s: PHY Reverse Polarity Detected=%x\n", dev->name,
			phy18 & PHY_INT_RPOL);
		}
 
	if ((phy18 & PHY_INT_JAB) != (lp->lastPhy18 & PHY_INT_JAB))
		{
		PRINTK2("%s: PHY Jabber Detected=%x\n", dev->name,
			phy18 & PHY_INT_JAB);
		}
 
	if ((phy18 & PHY_INT_SPDDET) != (lp->lastPhy18 & PHY_INT_SPDDET))
		{
		PRINTK2("%s: PHY Speed Detect=%x\n", dev->name,
			phy18 & PHY_INT_SPDDET);
		}
 
	if ((phy18 & PHY_INT_DPLXDET) != (lp->lastPhy18 & PHY_INT_DPLXDET))
		{
		PRINTK2("%s: PHY Duplex Detect=%x\n", dev->name,
			phy18 & PHY_INT_DPLXDET);
		}
#endif
 
	// Update the last phy 18 variable
	lp->lastPhy18 = phy18;
 
	} // end while
}
 
 
 

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.