[PATCH] pc386/ne2000 multicast support

[Keith Robertson <kjrobert at alumni dot uwaterloo dot ca>]

Adds multicast support in the ne2k driver on pc386.

This has been tested extensively on qemu.

Cheers,

Keith

Index: c/src/lib/libbsp/i386/pc386/ne2000/ne2000.c
===================================================================
--- c/src/lib/libbsp/i386/pc386/ne2000/ne2000.c	(.../rtems/rtems-4.6.5)	(revision 1692)
+++ c/src/lib/libbsp/i386/pc386/ne2000/ne2000.c	(.../volkano/rtems/rtems-src)	(revision 1692)
@@ -502,6 +502,9 @@
   /* accept broadcast */
   outport_byte (port + RCR, (sc->accept_broadcasts ? MSK_AB : 0));
 
+  /* accept multicast */
+  outport_byte (port + RCR, MSK_AM);
+
   /* Start interface */
   outport_byte (port + CMDR, MSK_PG0 | MSK_RD2 | MSK_STA);
 
@@ -1069,6 +1072,28 @@
   printf ("          Interrupts: %-8lu\n", sc->stats.interrupts);
 }
 
+static int ne_set_multicast_filter(struct ne_softc* sc)
+{
+  int i=0;
+  unsigned int port = sc->port;
+  unsigned char cmd = 0;
+  	
+  /* Save CMDR settings */
+  inport_byte(port + CMDR, cmd);
+  /* Change to page 1 */
+  outport_byte(port + CMDR, cmd | MSK_PG1);
+
+  /* Set MAR to accept _all_ multicast packets */
+  for (i = 0; i < MARsize; ++i) {
+    outport_byte (port + MAR + i, 0xFF);
+  }
+
+  /* Revert to original CMDR settings */
+  outport_byte(port + CMDR, cmd); 
+
+  return 0;
+}
+
 /* NE2000 driver ioctl handler.  */
 
 static int
@@ -1102,13 +1127,25 @@
       break;
     }
     break;
+  
+  case SIOCADDMULTI:
+  case SIOCDELMULTI:
+  {
+    struct ifreq* ifr = (struct ifreq*) data;
+    error = (command == SIOCADDMULTI ? 
+      ether_addmulti(ifr, &(sc->arpcom)) :
+      ether_delmulti(ifr, &(sc->arpcom)) );
+    /* ENETRESET indicates that driver should update its multicast filters */
+    if(error == ENETRESET) {
+      error = ne_set_multicast_filter(sc);
+    }
+    break;
+  }
 
   case SIO_RTEMS_SHOW_STATS:
     ne_stats (sc);
     break;
 
-    /* FIXME: Multicast commands must be added here.  */
-
   default:
     error = EINVAL;
     break;
@@ -1244,7 +1281,7 @@
   ifp->if_watchdog = ne_watchdog;
   ifp->if_start = ne_start;
   ifp->if_output = ether_output;
-  ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX;
+  ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
   if (ifp->if_snd.ifq_maxlen == 0)
     ifp->if_snd.ifq_maxlen = ifqmaxlen;