Update to version stable-165

Submitted by:	Ustimenko Semen <semen@iclub.nsu.ru>

1 files changed, 251 insertions, 196 deletions

diff --git a/sys/dev/tx/if_tx.c b/sys/dev/tx/if_tx.c
index c2882cb..713cc24 100644
--- a/sys/dev/tx/if_tx.c
+++ b/sys/dev/tx/if_tx.c
@@ -23,7 +23,7 @@
  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  * SUCH DAMAGE.
  *
- * version: stable-163
+ * version: stable-165
  *
  */
 
@@ -55,6 +55,12 @@
  *
  * stable-163:
  *	added media control code
+ *
+ * stable-164:
+ *	fixed some bugs
+ *
+ * stable-165:
+ *	fixed media control code
  */
 
 #include <sys/param.h>
@@ -65,7 +71,11 @@
 #include <sys/errno.h>
 #include <sys/malloc.h>
 #include <sys/kernel.h>
-#include <sys/ioctl.h>			/* makes problem in FreeBSD 3.x */
+#if defined(__FreeBSD__) && __FreeBSD__ >= 3
+#include <sys/sockio.h>
+#else
+#include <sys/ioctl.h>
+#endif
 #include <machine/clock.h>
 #include <net/if.h>
 #include <net/if_dl.h>
@@ -117,8 +127,6 @@ epic_ifioctl(register struct ifnet * ifp, int command, caddr_t data){
 	epic_softc_t *sc = ifp->if_softc;
 	struct ifreq *ifr = (struct ifreq *) data;
 	int x, error = 0;
-	u_int32_t media=0;
-	u_int32_t rxcon=0;
 
 	x = splimp();
 
@@ -144,79 +152,33 @@ epic_ifioctl(register struct ifnet * ifp, int command, caddr_t data){
 			}
 		}
 
-		/* Set broadcast mode */
-		if( ifp->if_flags & IFF_BROADCAST )
-			rxcon |= RXCON_RECEIVE_BROADCAST_FRAMES;
-		else
-			rxcon &= ~RXCON_RECEIVE_BROADCAST_FRAMES;
-
-		/* Set media */
-
-		if( ifp->if_flags & IFF_NOAUTONEG ){
-			if( ifp->if_flags & IFF_100MB ) media |= 0x2000;
-			else media &= ~0x2000;
-
-			if( ifp->if_flags & IFF_FULLDUPLEX )
-				media |= 0x0100;
-			else
-				media &= ~0x0100;
-
-		} else {
-			media |= 0x1200;	/* Set and restart autoneg */
-		}
-
-#if NBPFILTER > 0
-		/* Set promisc mode */
-		if( ifp->if_flags & IFF_PROMISC )
-			sc->rxcon |= RXCON_PROMISCUOUS_MODE;
-		else
-			sc->rxcon &= ~RXCON_PROMISCUOUS_MODE;
-
-#endif
-		/*
-		 * Update hardware if media changed
-		 */
-		if( sc->media != media ){
-			if( media & 0x1000 ){
-				printf("tx%d: autonegotiation started\n",sc->unit);
-				epic_write_phy_register( sc->iobase, 0, (sc->media=media) );
-				ifp->if_timer=3;
-				sc->pending_txs++;
-			} else {
-				epic_write_phy_register( sc->iobase, 0, (sc->media=media) );
-				epic_update_if_media_flags(sc);
-				printf("tx%d: %dMbps %s\n",sc->unit,
-					(ifp->if_flags&IFF_100MB)?100:10,
-					(ifp->if_flags&IFF_FULLDUPLEX)?"full-duplex":"half-duplex" );
-			}
-		}
+		/* Update RXCON register */
+		epic_set_rx_mode( sc );
 
-		if( sc->rxcon != rxcon )
-			outl( sc->iobase + RXCON, (sc->rxcon = rxcon) );
+		/* Update SPEED */
+		epic_set_media_speed( sc );
 
 		break;
 
-#if 0				/* XXXXXXXX: no multicast filtering */
 	case SIOCADDMULTI:
 	case SIOCDELMULTI:
-		/*
-		 * Update out multicast list.
-		 */
+
+		/* Update out multicast list */
+
+#if defined(__FreeBSD__) && __FreeBSD__ >= 3
+		epic_set_mc_table(sc);
+		error = 0;
+#else
 		error = (command == SIOCADDMULTI) ?
-		    ether_addmulti(ifr, &sc->arpcom) :
-		    ether_delmulti(ifr, &sc->arpcom);
+		    ether_addmulti(ifr, &sc->epic_ac) :
+		    ether_delmulti(ifr, &sc->epic_ac);
 
 		if (error == ENETRESET) {
-
-			/*
-			 * Multicast list has changed; set the hardware filter
-			 * accordingly.
-			 */
-			ed_setrcr(sc);
+			epic_set_mc_table(sc);
 			error = 0;
 		}
-		break;
 #endif
+		break;
 
 	case SIOCSIFMTU:
 		/*
@@ -238,7 +200,7 @@ epic_ifioctl(register struct ifnet * ifp, int command, caddr_t data){
 }
 
 /*
- *  IFSTART function
+ * Ifstart function
  */
 static void
 epic_ifstart(struct ifnet * const ifp){
@@ -283,10 +245,6 @@ epic_ifstart(struct ifnet * const ifp){
 		sc->pending_txs++;
 	}
 
-#if defined(EPIC_DEBUG)
-	printf("tx%d: txring overflowed\n",sc->unit);
-#endif
-
 	sc->epic_if.if_flags |= IFF_OACTIVE;
 
 	return;
@@ -305,30 +263,16 @@ epic_ifwatchdog(
 	int i;
 
 	x = splimp();
-	if( sc->media & 0x0200 ){
-		i=epic_read_phy_register( sc->iobase, 0 );
-		if( i & 0x0200 ) {
-			printf("tx%d: autoneg failed\n",sc->unit);
-			sc->media=0xFFFFFFFF;
-		} else {
-			epic_update_if_media_flags(sc);
-			printf("tx%d: autonegotiated: %dMbps %s\n",sc->unit,
-				(ifp->if_flags&IFF_100MB)?100:10,
-				(ifp->if_flags&IFF_FULLDUPLEX)?"full-duplex":"half-duplex" );
-		}
-		sc->pending_txs--;
-		sc->media &= ~0x0200;
-	} else {
-		printf("tx%d: device timeout %d packets\n",
-				sc->unit,sc->pending_txs);
 
-		ifp->if_oerrors+=sc->pending_txs;
+	printf("tx%d: device timeout %d packets\n",
+			sc->unit,sc->pending_txs);
 
-		epic_stop(sc);
-		epic_init(sc);
+	ifp->if_oerrors+=sc->pending_txs;
 
-		epic_ifstart(&sc->epic_if);
-	}
+	epic_stop(sc);
+	epic_init(sc);
+
+	epic_ifstart(&sc->epic_if);
 
 	splx(x);
 }
@@ -348,16 +292,31 @@ epic_intr_normal(
 	status = inl(iobase + INTSTAT);
 
 	/* Acknowledge all of the current interrupt sources ASAP. */
-	outl( iobase + INTSTAT, status & 0x00007fff);
+	outl( iobase + INTSTAT, status & 0x0000ffff);
 
-	if( status & (INTSTAT_RQE|INTSTAT_RCC|INTSTAT_OVW) )
+	if( status & (INTSTAT_RQE|INTSTAT_HCC|INTSTAT_RCC|INTSTAT_OVW) )
 		epic_rx_done( sc );
 
-	if( status & (INTSTAT_TQE|INTSTAT_TCC|INTSTAT_TXU) )
+	if( status & (INTSTAT_TXC|INTSTAT_TQE|INTSTAT_TCC|INTSTAT_TXU) )
 		epic_tx_done( sc );
-        /*
-	 * UPDATE statistics
-	 */
+
+/*
+	if( status & INTSTAT_GP2 ){
+		printf("tx%d: GP2 int occured\n",sc->unit);
+		epic_read_phy_register(sc->iobase,DP83840_BMSR);
+		epic_read_phy_register(sc->iobase,DP83840_BMCR);
+	}
+*/
+	if( status & (INTSTAT_FATAL|INTSTAT_PMA|INTSTAT_PTA|INTSTAT_APE|INTSTAT_DPE) ){
+		printf("tx%d: PCI fatal error occured (%s%s%s%s)",
+			sc->unit,
+			(status&INTSTAT_PMA)?"PMA":"",
+			(status&INTSTAT_PTA)?" PTA":"",
+			(status&INTSTAT_APE)?" APE":"",
+			(status&INTSTAT_DPE)?" DPE":"");
+	}
+
+        /* UPDATE statistics */
 	if (status & (INTSTAT_CNT | INTSTAT_TXU | INTSTAT_OVW | INTSTAT_RXE)) {
 		/*
 		 * update dot3 Rx statistics
@@ -366,19 +325,16 @@ epic_intr_normal(
 		sc->dot3stats.dot3StatsFrameTooLongs += inb(iobase + ALICNT);
 		sc->dot3stats.dot3StatsFCSErrors += inb(iobase + CRCCNT);
 
-		/*
-		 * update if Rx statistics
-		 */
+		/* Update if Rx statistics */
 		if (status & (INTSTAT_OVW | INTSTAT_RXE))
 			sc->epic_if.if_ierrors++;
 
 		/* Tx FIFO underflow. */
 		if (status & INTSTAT_TXU) {
+			/* Inc. counters */
 			sc->dot3stats.dot3StatsInternalMacTransmitErrors++;
 			sc->epic_if.if_oerrors++;
-#if defined(EPIC_DEBUG)
-			printf("tx%d: restart transmit\n",sc->unit);
-#endif
+
 			/* Restart the transmit process. */
 			outl(iobase + COMMAND, COMMAND_TXUGO);
 		}
@@ -388,15 +344,11 @@ epic_intr_normal(
 	}
 
 	/* If no packets are pending, thus no timeouts */
-	if( sc->pending_txs == 0 ){
+	if( sc->pending_txs == 0 )
 		sc->epic_if.if_timer = 0;
-		if( sc->cur_tx != sc->dirty_tx ){
-			printf("tx%d: algorithm error1\n",sc->unit);
-		}
-	}
 
 	/* We should clear all interrupt sources. */
-	outl(iobase + INTSTAT, 0x0001ffff );
+	outl(iobase + INTSTAT, 0xffffffff );
 
 	return;
 }
@@ -485,23 +437,18 @@ epic_rx_done(
 
 #if NBPFILTER > 0
 		if( sc->epic_if.if_bpf ) bpf_mtap( &sc->epic_if, m );
-#if 0
-		/* Accept only our packets */
+
+		/* Accept only our packets, broadcasts and multicasts */
 		if( (eh->ether_dhost[0] & 1) == 0 &&
 		    bcmp(eh->ether_dhost,sc->epic_ac.ac_enaddr,ETHER_ADDR_LEN)){
 			m_freem(m);
 			goto rxerror;
 		}
 #endif
-#endif
 		m->m_pkthdr.len = len - sizeof(struct ether_header);
 		m->m_len = len - sizeof( struct ether_header );
 		m->m_data += sizeof( struct ether_header );
 
-#if defined(EPIC_DEBUG)
-		printf("tx%d: received %d bytes\n",sc->unit,len);
-#endif
-
 		ether_input(&sc->epic_if, eh, m);
 
 		sc->epic_if.if_ipackets++;
@@ -537,9 +484,6 @@ epic_tx_done( epic_softc_t *sc ){
 			break;	/* following packets are not Txed yet */
 
 		if( stt == 0 ){
-			if( sc->pending_txs != 0 ||
-			    sc->dirty_tx != sc->cur_tx ) 
-				printf("tx%d: algoritm error\n",sc->unit);
 			if_flags = ~IFF_OACTIVE;
 			break;
 		}
@@ -625,13 +569,13 @@ epic_pci_probe(
     pcici_t config_id,
     pcidi_t device_id)
 {
-    if (PCI_VENDORID(device_id) != SMC_VENDORID)
-	return NULL;
+	if( PCI_VENDORID(device_id) != SMC_VENDORID )
+		return NULL;
 
-    if (PCI_CHIPID(device_id) == CHIPID_83C170)
-	return "SMC 83c170";
+	if( PCI_CHIPID(device_id) == CHIPID_83C170 )
+		return "SMC 83c170";
 
-    return NULL;
+	return NULL;
 }
 
 /*
@@ -646,6 +590,7 @@ epic_pci_attach(
 	epic_softc_t *sc;
 	u_int32_t iobase;
 	u_int32_t irq;
+	u_int32_t phyid;
 	int i;
 	int s;
 	int phy, phy_idx;
@@ -682,41 +627,33 @@ epic_pci_attach(
 	/* Magic?!  If we don't set this bit the MII interface won't work. */
 	outl( iobase + TEST1, 0x0008 );
 
-	/* Read mac address */
+	/* Read mac address (may be better is read from EEPROM?) */
 	for (i = 0; i < ETHER_ADDR_LEN / sizeof( u_int16_t); i++)
 		((u_int16_t *)sc->epic_macaddr)[i] = inw(iobase + LAN0 + i*4);
 
-	printf("tx%d:",sc->unit);
-	printf(" address %02x:%02x:%02x:%02x:%02x:%02x,",sc->epic_macaddr[0],sc->epic_macaddr[1],sc->epic_macaddr[2],sc->epic_macaddr[3],sc->epic_macaddr[4],sc->epic_macaddr[5]);
-	printf(" type SMC9432TX [");
-	
-	i = epic_read_phy_register(iobase,0);
-	if( i & 0x1000 ) printf("Auto-Neg.");
-	if( i & 0x2000 ) printf(" 100 Mb/s");
-	else printf(" 10 Mb/s");
-	if( i & 0x100 ) printf(" Full-duplex");
-	else printf(" Half-duplex");
-	printf("]\n");
+	/* Display some info */
+	printf("tx%d: address %02x:%02x:%02x:%02x:%02x:%02x,",sc->unit,
+		sc->epic_macaddr[0],sc->epic_macaddr[1],sc->epic_macaddr[2],
+		sc->epic_macaddr[3],sc->epic_macaddr[4],sc->epic_macaddr[5]);
 
-	/*
-	 * Map interrupt
-	 */
-	if (!pci_map_int(config_id, epic_intr_normal, (void*) sc, &net_imask)) {
+
+	s = splimp();
+
+	/* Map interrupt */
+	if( !pci_map_int(config_id, epic_intr_normal, (void*)sc, &net_imask) ) {
 		printf("tx%d: couldn't map interrupt\n",unit);
+		epics[ unit ] = NULL;
+		free(sc, M_DEVBUF);
 		return;
 	}
 
-	/*
-	 * Fill ifnet structure
-	 */
-	s = splimp();
-
+	/* Fill ifnet structure */
 	ifp = &sc->epic_if;
 
 	ifp->if_unit = unit;
 	ifp->if_name = "tx";
 	ifp->if_softc = sc;
-	ifp->if_flags = IFF_BROADCAST|IFF_SIMPLEX;	/*IFF_MULTICAST*/
+	ifp->if_flags = IFF_BROADCAST|IFF_SIMPLEX|IFF_MULTICAST|IFF_ALLMULTI;
 	ifp->if_ioctl = epic_ifioctl;
 	ifp->if_start = epic_ifstart;
 	ifp->if_watchdog = epic_ifwatchdog;
@@ -732,6 +669,55 @@ epic_pci_attach(
 
 	sc->dot3stats.dot3Compliance = DOT3COMPLIANCE_COLLS;
 
+	printf(" type SMC9432TX");
+	
+	i = epic_read_phy_register(iobase, DP83840_BMCR);
+
+	if( i & BMCR_AUTONEGOTIATION ){
+		printf(" [Auto-Neg.");
+
+		if( i & BMCR_100MBPS ) printf(" 100Mbps");
+		else printf(" 10Mbps");
+
+		if( i & BMCR_FULL_DUPLEX ) printf(" FD");
+
+		printf("]\n");
+
+		if( i & BMCR_FULL_DUPLEX )
+			 printf("tx%d: WARNING! FD autonegotiated, not supported\n",sc->unit);
+
+	} else {
+		ifp->if_flags |= IFF_LINK0;
+		if( i & BMCR_100MBPS ) {
+			printf(" [100Mbps");
+			ifp->if_flags |= IFF_LINK2;
+		} else printf(" [10Mbps");
+
+		if( i & BMCR_FULL_DUPLEX ) {
+			printf(" FD");
+			ifp->if_flags |= IFF_LINK1;
+		}
+		printf("]\n");
+	}
+#if defined(EPIC_DEBUG)
+	printf("tx%d: PHY id: (",sc->unit);
+	i=epic_read_phy_register(iobase,DP83840_PHYIDR1);
+	printf("%04x:",i);
+	phyid=i<<6;
+	i=epic_read_phy_register(iobase,DP83840_PHYIDR2);
+	printf("%04x)",i);
+	phyid|=((i>>10)&0x3F);
+	printf(" %08x, rev %x, mod %x\n",phyid,(i)&0xF, (i>>4)&0x3f);
+#endif
+
+	epic_read_phy_register(iobase,DP83840_BMSR);
+	epic_read_phy_register(iobase,DP83840_BMSR);
+	epic_read_phy_register(iobase,DP83840_BMSR);
+	i=epic_read_phy_register(iobase,DP83840_BMSR);
+
+	if( !(i & BMSR_LINK_STATUS) )
+		printf("tx%d: WARNING! no link estabilished/n",sc->unit);
+
 	/*
 	 *  Attach to if manager
 	 */
@@ -773,40 +759,34 @@ epic_init(
 	/* Initialize rings or reinitialize */
 	epic_init_rings( sc );
 
-	epic_update_if_media_flags( sc );
-
 	/* Put node address to EPIC */
 	outl( iobase + LAN0 + 0x0, ((u_int16_t *)sc->epic_macaddr)[0] );
         outl( iobase + LAN0 + 0x4, ((u_int16_t *)sc->epic_macaddr)[1] );
 	outl( iobase + LAN0 + 0x8, ((u_int16_t *)sc->epic_macaddr)[2] );
 
 	/* Enable interrupts,  set for PCI read multiple and etc */
-	sc->genctl = GENCTL_ENABLE_INTERRUPT | GENCTL_MEMORY_READ_MULTIPLE | \
-			GENCTL_ONECOPY | GENCTL_RECEIVE_FIFO_THRESHOLD128;
-
-	outl( iobase + GENCTL, sc->genctl );
+	outl( iobase + GENCTL,
+		GENCTL_ENABLE_INTERRUPT | GENCTL_MEMORY_READ_MULTIPLE |
+		GENCTL_ONECOPY | GENCTL_RECEIVE_FIFO_THRESHOLD128 );
 
 	/* Set transmit threshold */
 	outl( iobase + ETXTHR, 0x40 );
 
-	/* Compute rx mode. */
-	if( sc->epic_if.if_flags & IFF_BROADCAST )
-		sc->rxcon |= RXCON_RECEIVE_BROADCAST_FRAMES;
-	else
-		sc->rxcon &= ~RXCON_RECEIVE_BROADCAST_FRAMES;
+	/* Compute and set RXCON. */
+	epic_set_rx_mode( sc );
 
-	if( sc->epic_if.if_flags & IFF_PROMISC )
-		sc->rxcon |= RXCON_PROMISCUOUS_MODE;
-	else
-		sc->rxcon &= ~RXCON_PROMISCUOUS_MODE;
+	/* Set MII speed mode */
+	epic_set_media_speed( sc );
 
-	/* Set rx and tx modes */
-	outl( iobase + RXCON, sc->rxcon );
-	outl( iobase + TXCON, sc->txcon );
+	/* Set multicast table */
+	epic_set_mc_table( sc );
 
 	/* Enable interrupts by setting the interrupt mask. */
-	outl( iobase + INTMASK, INTSTAT_CNT | INTSTAT_TXU | INTSTAT_TCC |
-		 INTSTAT_RXE | INTSTAT_OVW | INTSTAT_RQE | INTSTAT_RCC );
+	outl( iobase + INTMASK,
+		INTSTAT_RCC | INTSTAT_RQE | INTSTAT_OVW | INTSTAT_RXE |
+		INTSTAT_TXC | INTSTAT_TCC | INTSTAT_TQE | INTSTAT_TXU |
+		INTSTAT_CNT | /*INTSTAT_GP2 |*/ INTSTAT_FATAL |
+		INTSTAT_PTA | INTSTAT_PMA | INTSTAT_APE | INTSTAT_DPE );
 
 	/* Start rx process */
 	outl( iobase + COMMAND, COMMAND_RXQUEUED | COMMAND_START_RX );
@@ -818,59 +798,135 @@ epic_init(
 	/* ... and free */
 	ifp->if_flags &= ~IFF_OACTIVE;
 
+	return;
 }
 
+/*
+ * This function should set EPIC's registers according IFF_* flags
+ */
 static void
-epic_stop(
+epic_set_rx_mode(
     epic_softc_t * sc)
 {
-	int iobase = sc->iobase;
+	struct ifnet *ifp = &sc->epic_if;
+        u_int16_t rxcon = 0;
 
-	sc->genctl &= ~GENCTL_ENABLE_INTERRUPT;
-	outl( iobase + INTMASK, 0 );
-	outl( iobase + COMMAND, COMMAND_STOP_RX | COMMAND_STOP_TDMA | \
-				COMMAND_STOP_TDMA );
+#if NBPFILTER > 0
+	if( sc->epic_if.if_flags & IFF_PROMISC )
+		rxcon |= RXCON_PROMISCUOUS_MODE;
+#endif
 
-	sc->epic_if.if_timer = 0;
+	if( sc->epic_if.if_flags & IFF_BROADCAST )
+		rxcon |= RXCON_RECEIVE_BROADCAST_FRAMES;
+
+	if( sc->epic_if.if_flags & IFF_MULTICAST )
+		rxcon |= RXCON_RECEIVE_MULTICAST_FRAMES;
 
+	outl( sc->iobase + RXCON, rxcon );
+
+	return;
 }
 
+/*
+ * This function should set MII to mode specified by IFF_LINK* flags
+ */
 static void
-epic_update_if_media_flags(
+epic_set_media_speed(
     epic_softc_t * sc)
 {
 	struct ifnet *ifp = &sc->epic_if;
+	u_int16_t media;
+	u_int32_t i;
+
+	/* Set media speed */           
+	if( ifp->if_flags & IFF_LINK0 ){
+		/* Allow only manual fullduplex modes */
+		media = epic_read_phy_register( sc->iobase, DP83840_ANAR );
+		media |= ANAR_100|ANAR_10|ANAR_100_FD|ANAR_10_FD;
+		epic_write_phy_register( sc->iobase, DP83840_ANAR, media );
 
-	/* Read media control */
-	sc->media = epic_read_phy_register(sc->iobase, 0);
+		/* Set mode */
+		media = (ifp->if_flags&IFF_LINK2)?BMCR_100MBPS:0;
+		media |= (ifp->if_flags&IFF_LINK1)?BMCR_FULL_DUPLEX:0;
+		epic_write_phy_register( sc->iobase, DP83840_BMCR, media );
 
-	/* AutoNegotiation */
-	if( sc->media & 0x1000 ) ifp->if_flags &= ~IFF_NOAUTONEG;
-	else ifp->if_flags |= IFF_NOAUTONEG;
+		ifp->if_baudrate =
+			(ifp->if_flags&IFF_LINK2)?100000000:10000000;
 
-	/* fullduplex */
-	if( sc->media & 0x0100 ) {
-		ifp->if_flags |= IFF_FULLDUPLEX;
-		sc->txcon |= TXCON_LOOPBACK_MODE_FULL_DUPLEX;
+		outl( sc->iobase + TXCON,(ifp->if_flags&IFF_LINK1)?TXCON_LOOPBACK_MODE_FULL_DUPLEX|TXCON_DEFAULT:TXCON_DEFAULT );
+
+#if defined(EPIC_DEBUG)
+		printf("tx%d: %dMbps %s\n",sc->unit,
+			(ifp->if_flags&IFF_LINK2)?100:10,
+			(ifp->if_flags&IFF_LINK1)?"full-duplex":"half-duplex" );
+#endif
 	} else {
-		ifp->if_flags &= ~IFF_FULLDUPLEX;
-		sc->txcon &= ~TXCON_LOOPBACK_MODE_FULL_DUPLEX;
+		/* If autoneg is set, IFF_LINK flags are meaningless */
+		ifp->if_flags &= ~(IFF_LINK0|IFF_LINK1|IFF_LINK2);
+		ifp->if_baudrate = 100000000;
+
+		outl( sc->iobase + TXCON, TXCON_DEFAULT );
+
+		/* Does not allow to autoneg fullduplex modes */
+		media = epic_read_phy_register( sc->iobase, DP83840_ANAR );
+		media &= ~(ANAR_100|ANAR_100_FD|ANAR_10_FD|ANAR_10);
+		media |= ANAR_100|ANAR_10;
+		epic_write_phy_register( sc->iobase, DP83840_ANAR, media );
+
+		/* Set and restart autoneg */
+		epic_write_phy_register( sc->iobase, DP83840_BMCR,
+			BMCR_AUTONEGOTIATION | BMCR_RESTART_AUTONEG );
+
+#if defined(EPIC_DEBUG)
+		printf("tx%d: Autonegotiation\n",sc->unit);
+#endif
 	}
-	outl( sc->iobase + TXCON, sc->txcon );
 
-	/* 10/100 MBit */
-	if( sc->media & 0x2000 ) {
-		ifp->if_flags |= IFF_100MB;
-		ifp->if_baudrate = 100000000;
-	} else {
-		ifp->if_flags &= ~IFF_100MB;
-		ifp->if_baudrate = 10000000;
+	return;
+}
+
+/*
+ * This function sets EPIC multicast table
+ */
+static void
+epic_set_mc_table(
+    epic_softc_t * sc)
+{
+	struct ifnet *ifp = &sc->epic_if;
+
+	if( ifp->if_flags & IFF_MULTICAST ){
+#if defined(EPIC_DEBUG)
+		if( !(ifp->if_flags & IFF_ALLMULTI) )
+			printf("tx%d: WARNING! only receive all multicasts mode supported\n",sc->unit);
+#endif
+		outl( sc->iobase + MC0, 0xFFFF );
+		outl( sc->iobase + MC1, 0xFFFF );
+		outl( sc->iobase + MC2, 0xFFFF );
+		outl( sc->iobase + MC3, 0xFFFF );
 	}
 
 	return;
 }
 
 /*
+ *  This function should completely stop rx and tx processes
+ */
+static void
+epic_stop(
+    epic_softc_t * sc)
+{
+	int iobase = sc->iobase;
+
+	outl( iobase + INTMASK, 0 );
+	outl( iobase + GENCTL, 0 );
+	outl( iobase + COMMAND,
+		COMMAND_STOP_RX | COMMAND_STOP_TDMA | COMMAND_STOP_TDMA );
+
+	sc->epic_if.if_timer = 0;
+
+}
+
+/*
  * Initialize Rx ad Tx rings and give them to EPIC
  *
  * If RX_TO_MBUF option is enabled, mbuf cluster is allocated instead of
@@ -903,7 +959,7 @@ epic_init_rings(epic_softc_t * sc){
 			printf("tx%d: malloc failed\n",sc->unit);
 			continue;
 		}
-		buf->data = (caddr_t)((u_int32_t)(buf->pool + 3) & (~0x3));
+		buf->data = (caddr_t)buf->pool;
 #else
 		if( buf->mbuf ){
 			m_freem( buf->mbuf );
@@ -946,8 +1002,7 @@ epic_init_rings(epic_softc_t * sc){
 			continue;
 		}
 
-		/* align on 4 bytes */
-		buf->data = (caddr_t)((u_int32_t)(buf->pool + 3) & (~0x3));
+		buf->data = (caddr_t)buf->pool;
 
 		buf->desc.bufaddr = vtophys( buf->data );
 		buf->desc.buflength = ETHER_MAX_FRAME_LEN;