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 2009 Sun Microsystems, Inc. All rights reserved. 23 * Use is subject to license terms. 24 */ 25 26 #include <sys/types.h> 27 #include <sys/stream.h> 28 #include <sys/dlpi.h> 29 #include <sys/strsun.h> 30 #include <netinet/in.h> 31 #include <netinet/ip6.h> 32 #include <inet/common.h> 33 #include <inet/ip.h> 34 #include <inet/ip6.h> 35 #include <inet/ip_if.h> 36 #include <ipp/dlcosmk/dlcosmk_impl.h> 37 38 /* Module to mark the 802.1d user priority field for a given packet */ 39 40 /* Debug level */ 41 int dlcosmk_debug = 0; 42 43 /* 44 * Given a packet, this module marks the mblk with the appropriate b_band or 45 * dl_max value so that the VLAN driver marks the outgoing frame with the 46 * configured 802.1D user_priority value. For non-VLAN devices or for inbound 47 * packets, this module does not do anything (i.e. the packet is processed by 48 * the next action in the list, if present). 49 * This module does not free any mblks or packets in case or errors. 50 */ 51 52 int 53 dlcosmk_process(mblk_t **mpp, dlcosmk_data_t *dlcosmk_data, uint32_t ill_index, 54 ip_proc_t proc) 55 { 56 ill_t *ill = NULL; 57 mblk_t *mp; 58 59 ASSERT((mpp != NULL) && (*mpp != NULL)); 60 mp = *mpp; 61 62 /* 63 * The action module will receive an M_DATA or an M_CTL followed 64 * by an M_DATA. In the latter case skip the M_CTL. 65 */ 66 if (mp->b_datap->db_type != M_DATA) { 67 if ((mp->b_cont == NULL) || 68 (mp->b_cont->b_datap->db_type != M_DATA)) { 69 atomic_add_64(&dlcosmk_data->epackets, 1); 70 dlcosmk0dbg(("dlcosmk_process: no data\n")); 71 return (EINVAL); 72 } 73 } 74 75 /* Update global stats */ 76 atomic_add_64(&dlcosmk_data->npackets, 1); 77 78 /* 79 * This should only be called for outgoing packets. For inbound, just 80 * send it along. 81 */ 82 if ((proc == IPP_LOCAL_IN) || (proc == IPP_FWD_IN)) { 83 dlcosmk2dbg(("dlcosmk_process:cannot mark incoming packets\n")); 84 atomic_add_64(&dlcosmk_data->ipackets, 1); 85 return (0); 86 } 87 88 if ((ill_index == 0) || 89 ((ill = ill_lookup_on_ifindex_global_instance(ill_index, 90 B_FALSE)) == NULL)) { 91 dlcosmk2dbg(("dlcosmk_process:invalid ill index %u\n", 92 ill_index)); 93 atomic_add_64(&dlcosmk_data->ipackets, 1); 94 return (0); 95 } 96 97 /* 98 * Check if the interface supports CoS marking. If not send it to the 99 * next action in the chain 100 */ 101 if (!(ill->ill_flags & ILLF_COS_ENABLED)) { 102 dlcosmk2dbg(("dlcosmk_process:ill %u does not support CoS\n", 103 ill_index)); 104 atomic_add_64(&dlcosmk_data->ipackets, 1); 105 ill_refrele(ill); 106 return (0); 107 } 108 ill_refrele(ill); 109 110 111 /* 112 * Mark the b_band for fastpath messages or dl_priority.dl_max for 113 * DL_UNITDATA_REQ messages. For, others just pass it along. 114 */ 115 switch (DB_TYPE(mp)) { 116 case M_PROTO: 117 case M_PCPROTO: 118 { /* DL_UNITDATA */ 119 dl_unitdata_req_t *dlur; 120 dlur = (dl_unitdata_req_t *)mp->b_rptr; 121 122 /* DL_UNITDATA message?? */ 123 if (dlur->dl_primitive == DL_UNITDATA_REQ) { 124 dlur->dl_priority.dl_max = 125 dlcosmk_data->dl_max; 126 } else { 127 atomic_add_64(&dlcosmk_data->ipackets, 128 1); 129 } 130 break; 131 } 132 case M_DATA: 133 /* fastpath message */ 134 mp->b_band = dlcosmk_data->b_band; 135 break; 136 default: 137 atomic_add_64(&dlcosmk_data->ipackets, 1); 138 break; 139 } 140 141 return (0); 142 } 143