1 /*
   2  * CDDL HEADER START
   3  *
   4  * The contents of this file are subject to the terms of the
   5  * Common Development and Distribution License (the "License").
   6  * You may not use this file except in compliance with the License.
   7  *
   8  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
   9  * or http://www.opensolaris.org/os/licensing.
  10  * See the License for the specific language governing permissions
  11  * and limitations under the License.
  12  *
  13  * When distributing Covered Code, include this CDDL HEADER in each
  14  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
  15  * If applicable, add the following below this CDDL HEADER, with the
  16  * fields enclosed by brackets "[]" replaced with your own identifying
  17  * information: Portions Copyright [yyyy] [name of copyright owner]
  18  *
  19  * CDDL HEADER END
  20  */
  21 /*
  22  * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
  23  * Use is subject to license terms.
  24  * Copyright 2012 OmniTI Computer Consulting, Inc  All rights reserved.
  25  */
  26 
  27 /*
  28  * IEEE 802.3ad Link Aggregation - Receive
  29  *
  30  * Implements the collector function.
  31  * Manages the RX resources exposed by a link aggregation group.
  32  */
  33 
  34 #include <sys/sysmacros.h>
  35 #include <sys/ddi.h>
  36 #include <sys/sunddi.h>
  37 #include <sys/strsun.h>
  38 #include <sys/strsubr.h>
  39 #include <sys/byteorder.h>
  40 #include <sys/aggr.h>
  41 #include <sys/aggr_impl.h>
  42 
  43 static void
  44 aggr_mac_rx(mac_handle_t lg_mh, mac_resource_handle_t mrh, mblk_t *mp)
  45 {
  46         if (mrh == NULL) {
  47                 mac_rx(lg_mh, mrh, mp);
  48         } else {
  49                 aggr_pseudo_rx_ring_t   *ring = (aggr_pseudo_rx_ring_t *)mrh;
  50                 mac_rx_ring(lg_mh, ring->arr_rh, mp, ring->arr_gen);
  51         }
  52 }
  53 
  54 void
  55 aggr_recv_lacp(aggr_port_t *port, mac_resource_handle_t mrh, mblk_t *mp)
  56 {
  57         aggr_grp_t *grp = port->lp_grp;
  58 
  59         /* in promiscuous mode, send copy of packet up */
  60         if (grp->lg_promisc) {
  61                 mblk_t *nmp = copymsg(mp);
  62 
  63                 if (nmp != NULL)
  64                         aggr_mac_rx(grp->lg_mh, mrh, nmp);
  65         }
  66 
  67         aggr_lacp_rx_enqueue(port, mp);
  68 }
  69 
  70 /*
  71  * Callback function invoked by MAC service module when packets are
  72  * made available by a MAC port, both in promisc_on mode and not.
  73  */
  74 /* ARGSUSED */
  75 static void
  76 aggr_recv_path_cb(void *arg, mac_resource_handle_t mrh, mblk_t *mp,
  77     boolean_t loopback, boolean_t promisc_path)
  78 {
  79         aggr_port_t *port = (aggr_port_t *)arg;
  80         aggr_grp_t *grp = port->lp_grp;
  81 
  82         /*
  83          * In the case where lp_promisc_on has been turned on to
  84          * compensate for insufficient hardware MAC matching and
  85          * hardware rings are not in use we will fall back to
  86          * using flows for delivery which can result in duplicates
  87          * pushed up the stack. Only respect the chosen path.
  88          */
  89         if (port->lp_promisc_on != promisc_path) {
  90                 freemsgchain(mp);
  91                 return;
  92         }
  93 
  94         if (grp->lg_lacp_mode == AGGR_LACP_OFF) {
  95                 aggr_mac_rx(grp->lg_mh, mrh, mp);
  96         } else {
  97                 mblk_t *cmp, *last, *head;
  98                 struct ether_header *ehp;
  99                 uint16_t sap;
 100 
 101                 /* filter out slow protocol packets (LACP & Marker) */
 102                 last = NULL;
 103                 head = cmp = mp;
 104                 while (cmp != NULL) {
 105                         if (MBLKL(cmp) < sizeof (struct ether_header)) {
 106                                 /* packet too short */
 107                                 if (head == cmp) {
 108                                         /* no packets accumulated */
 109                                         head = cmp->b_next;
 110                                         cmp->b_next = NULL;
 111                                         freemsg(cmp);
 112                                         cmp = head;
 113                                 } else {
 114                                         /* send up accumulated packets */
 115                                         last->b_next = NULL;
 116                                         if (port->lp_collector_enabled) {
 117                                                 aggr_mac_rx(grp->lg_mh, mrh,
 118                                                     head);
 119                                         } else {
 120                                                 freemsgchain(head);
 121                                         }
 122                                         head = cmp->b_next;
 123                                         cmp->b_next = NULL;
 124                                         freemsg(cmp);
 125                                         cmp = head;
 126                                         last = NULL;
 127                                 }
 128                                 continue;
 129                         }
 130                         ehp = (struct ether_header *)cmp->b_rptr;
 131 
 132                         sap = ntohs(ehp->ether_type);
 133                         if (sap == ETHERTYPE_SLOW) {
 134                                 /*
 135                                  * LACP or Marker packet. Send up pending
 136                                  * chain, and send LACP/Marker packet
 137                                  * to LACP subsystem.
 138                                  */
 139                                 if (head == cmp) {
 140                                         /* first packet of chain */
 141                                         ASSERT(last == NULL);
 142                                         head = cmp->b_next;
 143                                         cmp->b_next = NULL;
 144                                         aggr_recv_lacp(port, mrh, cmp);
 145                                         cmp = head;
 146                                 } else {
 147                                         /* previously accumulated packets */
 148                                         ASSERT(last != NULL);
 149                                         /* send up non-LACP packets */
 150                                         last->b_next = NULL;
 151                                         if (port->lp_collector_enabled) {
 152                                                 aggr_mac_rx(grp->lg_mh, mrh,
 153                                                     head);
 154                                         } else {
 155                                                 freemsgchain(head);
 156                                         }
 157                                         /* unlink and pass up LACP packets */
 158                                         head = cmp->b_next;
 159                                         cmp->b_next = NULL;
 160                                         aggr_recv_lacp(port, mrh, cmp);
 161                                         cmp = head;
 162                                         last = NULL;
 163                                 }
 164                         } else {
 165                                 last = cmp;
 166                                 cmp = cmp->b_next;
 167                         }
 168                 }
 169                 if (head != NULL) {
 170                         if (port->lp_collector_enabled)
 171                                 aggr_mac_rx(grp->lg_mh, mrh, head);
 172                         else
 173                                 freemsgchain(head);
 174                 }
 175         }
 176 }
 177 
 178 /* ARGSUSED */
 179 void
 180 aggr_recv_cb(void *arg, mac_resource_handle_t mrh, mblk_t *mp,
 181     boolean_t loopback)
 182 {
 183         aggr_recv_path_cb(arg, mrh, mp, loopback, B_FALSE);
 184 }
 185 
 186 /* ARGSUSED */
 187 void
 188 aggr_recv_promisc_cb(void *arg, mac_resource_handle_t mrh, mblk_t *mp,
 189     boolean_t loopback)
 190 {
 191         aggr_recv_path_cb(arg, mrh, mp, loopback, B_TRUE);
 192 }