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 2007 Sun Microsystems, Inc. All rights reserved. 23 * Use is subject to license terms. 24 */ 25 26 #pragma ident "%Z%%M% %I% %E% SMI" 27 28 /* 29 * Ethernet MAC plugin for the Nemo mac module 30 */ 31 32 #include <sys/types.h> 33 #include <sys/modctl.h> 34 #include <sys/dlpi.h> 35 #include <sys/mac.h> 36 #include <sys/mac_ether.h> 37 #include <sys/dls.h> 38 #include <sys/ethernet.h> 39 #include <sys/byteorder.h> 40 #include <sys/strsun.h> 41 #include <inet/common.h> 42 43 static uint8_t ether_brdcst[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 44 45 static mac_stat_info_t ether_stats[] = { 46 /* RFC1643 stats */ 47 { ETHER_STAT_ALIGN_ERRORS, "align_errors", KSTAT_DATA_UINT32, 0 }, 48 { ETHER_STAT_FCS_ERRORS, "fcs_errors", KSTAT_DATA_UINT32, 0 }, 49 { ETHER_STAT_FIRST_COLLISIONS, "first_collisions", KSTAT_DATA_UINT32, 50 0 }, 51 { ETHER_STAT_MULTI_COLLISIONS, "multi_collisions", KSTAT_DATA_UINT32, 52 0 }, 53 { ETHER_STAT_SQE_ERRORS, "sqe_errors", KSTAT_DATA_UINT32, 0}, 54 { ETHER_STAT_DEFER_XMTS, "defer_xmts", KSTAT_DATA_UINT32, 0}, 55 { ETHER_STAT_TX_LATE_COLLISIONS, "tx_late_collisions", 56 KSTAT_DATA_UINT32, 0 }, 57 { ETHER_STAT_EX_COLLISIONS, "ex_collisions", KSTAT_DATA_UINT32, 0 }, 58 { ETHER_STAT_MACXMT_ERRORS, "macxmt_errors", KSTAT_DATA_UINT32, 0 }, 59 { ETHER_STAT_CARRIER_ERRORS, "carrier_errors", KSTAT_DATA_UINT32, 0 }, 60 { ETHER_STAT_TOOLONG_ERRORS, "toolong_errors", KSTAT_DATA_UINT32, 0 }, 61 { ETHER_STAT_MACRCV_ERRORS, "macrcv_errors", KSTAT_DATA_UINT32, 0 }, 62 63 /* Statistics described in the ieee802.3(5) man page */ 64 { ETHER_STAT_XCVR_ADDR, "xcvr_addr", KSTAT_DATA_UINT32, 0 }, 65 { ETHER_STAT_XCVR_ID, "xcvr_id", KSTAT_DATA_UINT32, 0 }, 66 { ETHER_STAT_XCVR_INUSE, "xcvr_inuse", KSTAT_DATA_UINT32, 0 }, 67 { ETHER_STAT_CAP_1000FDX, "cap_1000fdx", KSTAT_DATA_UINT32, 0 }, 68 { ETHER_STAT_CAP_1000HDX, "cap_1000hdx", KSTAT_DATA_UINT32, 0 }, 69 { ETHER_STAT_CAP_100FDX, "cap_100fdx", KSTAT_DATA_UINT32, 0 }, 70 { ETHER_STAT_CAP_100HDX, "cap_100hdx", KSTAT_DATA_UINT32, 0 }, 71 { ETHER_STAT_CAP_10FDX, "cap_10fdx", KSTAT_DATA_UINT32, 0 }, 72 { ETHER_STAT_CAP_10HDX, "cap_10hdx", KSTAT_DATA_UINT32, 0 }, 73 { ETHER_STAT_CAP_ASMPAUSE, "cap_asmpause", KSTAT_DATA_UINT32, 0 }, 74 { ETHER_STAT_CAP_PAUSE, "cap_pause", KSTAT_DATA_UINT32, 0 }, 75 { ETHER_STAT_CAP_AUTONEG, "cap_autoneg", KSTAT_DATA_UINT32, 0 }, 76 { ETHER_STAT_ADV_CAP_1000FDX, "adv_cap_1000fdx", KSTAT_DATA_UINT32, 0 }, 77 { ETHER_STAT_ADV_CAP_1000HDX, "adv_cap_1000hdx", KSTAT_DATA_UINT32, 0 }, 78 { ETHER_STAT_ADV_CAP_100FDX, "adv_cap_100fdx", KSTAT_DATA_UINT32, 0}, 79 { ETHER_STAT_ADV_CAP_100HDX, "adv_cap_100hdx", KSTAT_DATA_UINT32, 0}, 80 { ETHER_STAT_ADV_CAP_10FDX, "adv_cap_10fdx", KSTAT_DATA_UINT32, 0 }, 81 { ETHER_STAT_ADV_CAP_10HDX, "adv_cap_10hdx", KSTAT_DATA_UINT32, 0 }, 82 { ETHER_STAT_ADV_CAP_ASMPAUSE, "adv_cap_asmpause", KSTAT_DATA_UINT32, 83 0 }, 84 { ETHER_STAT_ADV_CAP_PAUSE, "adv_cap_pause", KSTAT_DATA_UINT32, 0 }, 85 { ETHER_STAT_ADV_CAP_AUTONEG, "adv_cap_autoneg", KSTAT_DATA_UINT32, 0 }, 86 { ETHER_STAT_LP_CAP_1000FDX, "lp_cap_1000fdx", KSTAT_DATA_UINT32, 0 }, 87 { ETHER_STAT_LP_CAP_1000HDX, "lp_cap_1000hdx", KSTAT_DATA_UINT32, 0 }, 88 { ETHER_STAT_LP_CAP_100FDX, "lp_cap_100fdx", KSTAT_DATA_UINT32, 0 }, 89 { ETHER_STAT_LP_CAP_100HDX, "lp_cap_100hdx", KSTAT_DATA_UINT32, 0 }, 90 { ETHER_STAT_LP_CAP_10FDX, "lp_cap_10fdx", KSTAT_DATA_UINT32, 0 }, 91 { ETHER_STAT_LP_CAP_10HDX, "lp_cap_10hdx", KSTAT_DATA_UINT32, 0 }, 92 { ETHER_STAT_LP_CAP_ASMPAUSE, "lp_cap_asmpause", KSTAT_DATA_UINT32, 0 }, 93 { ETHER_STAT_LP_CAP_PAUSE, "lp_cap_pause", KSTAT_DATA_UINT32, 0 }, 94 { ETHER_STAT_LP_CAP_AUTONEG, "lp_cap_autoneg", KSTAT_DATA_UINT32, 0 }, 95 { ETHER_STAT_LINK_ASMPAUSE, "link_asmpause", KSTAT_DATA_UINT32, 0 }, 96 { ETHER_STAT_LINK_PAUSE, "link_pause", KSTAT_DATA_UINT32, 0 }, 97 { ETHER_STAT_LINK_AUTONEG, "link_autoneg", KSTAT_DATA_UINT32, 0 }, 98 { ETHER_STAT_LINK_DUPLEX, "link_duplex", KSTAT_DATA_UINT32, 0 } 99 }; 100 101 static struct modlmisc mac_ether_modlmisc = { 102 &mod_miscops, 103 "Ethernet MAC plugin %I%" 104 }; 105 106 static struct modlinkage mac_ether_modlinkage = { 107 MODREV_1, 108 &mac_ether_modlmisc, 109 NULL 110 }; 111 112 static mactype_ops_t mac_ether_type_ops; 113 114 int 115 _init(void) 116 { 117 mactype_register_t *mtrp; 118 int err; 119 120 if ((mtrp = mactype_alloc(MACTYPE_VERSION)) == NULL) 121 return (ENOTSUP); 122 mtrp->mtr_ident = MAC_PLUGIN_IDENT_ETHER; 123 mtrp->mtr_ops = &mac_ether_type_ops; 124 mtrp->mtr_mactype = DL_ETHER; 125 mtrp->mtr_nativetype = DL_ETHER; 126 mtrp->mtr_addrlen = ETHERADDRL; 127 mtrp->mtr_brdcst_addr = ether_brdcst; 128 mtrp->mtr_stats = ether_stats; 129 mtrp->mtr_statcount = A_CNT(ether_stats); 130 if ((err = mactype_register(mtrp)) == 0) { 131 if ((err = mod_install(&mac_ether_modlinkage)) != 0) 132 (void) mactype_unregister(MAC_PLUGIN_IDENT_ETHER); 133 } 134 mactype_free(mtrp); 135 return (err); 136 } 137 138 int 139 _fini(void) 140 { 141 int err; 142 143 if ((err = mactype_unregister(MAC_PLUGIN_IDENT_ETHER)) != 0) 144 return (err); 145 return (mod_remove(&mac_ether_modlinkage)); 146 } 147 148 int 149 _info(struct modinfo *modinfop) 150 { 151 return (mod_info(&mac_ether_modlinkage, modinfop)); 152 } 153 154 /* 155 * MAC Type plugin operations 156 */ 157 158 /* ARGSUSED */ 159 int 160 mac_ether_unicst_verify(const void *addr, void *mac_pdata) 161 { 162 /* If it's not a group address, then it's a valid unicast address. */ 163 return (((((uint8_t *)addr)[0] & 0x01) != 0) ? EINVAL : 0); 164 } 165 166 /* ARGSUSED */ 167 int 168 mac_ether_multicst_verify(const void *addr, void *mac_pdata) 169 { 170 /* The address must be a group address. */ 171 if ((((uint8_t *)addr)[0] & 0x01) == 0) 172 return (EINVAL); 173 /* The address must not be the media broadcast address. */ 174 if (bcmp(addr, ether_brdcst, ETHERADDRL) == 0) 175 return (EINVAL); 176 return (0); 177 } 178 179 /* 180 * Check the legality of an Ethernet SAP value. The following values are 181 * allowed, as specified by PSARC 2003/150: 182 * 183 * 0..ETHERMTU (1500) 802 semantics 184 * ETHERTYPE_802_MIN (1536)..ETHERTYPE_MAX (65535) ethertype semantics 185 * 186 * Note that SAP values less than or equal to ETHERMTU (1500) represent LLC 187 * channels. (See PSARC 2003/150). We strictly use SAP 0 to represent LLC 188 * channels. 189 */ 190 /* ARGSUSED */ 191 boolean_t 192 mac_ether_sap_verify(uint32_t sap, uint32_t *bind_sap, void *mac_pdata) 193 { 194 if (sap >= ETHERTYPE_802_MIN && sap <= ETHERTYPE_MAX) { 195 if (bind_sap != NULL) 196 *bind_sap = sap; 197 return (B_TRUE); 198 } 199 200 if (sap <= ETHERMTU) { 201 if (bind_sap != NULL) 202 *bind_sap = DLS_SAP_LLC; 203 return (B_TRUE); 204 } 205 return (B_FALSE); 206 } 207 208 /* ARGSUSED */ 209 mblk_t * 210 mac_ether_header(const void *saddr, const void *daddr, uint32_t sap, 211 void *mac_pdata, mblk_t *payload, size_t extra_len) 212 { 213 struct ether_header *ehp; 214 mblk_t *mp; 215 uint32_t bind_sap; 216 217 if (!mac_ether_sap_verify(sap, &bind_sap, NULL)) 218 return (NULL); 219 220 mp = allocb(sizeof (struct ether_header) + extra_len, BPRI_HI); 221 if (mp == NULL) 222 return (NULL); 223 224 ehp = (struct ether_header *)mp->b_rptr; 225 bcopy(daddr, &(ehp->ether_dhost), ETHERADDRL); 226 bcopy(saddr, &(ehp->ether_shost), ETHERADDRL); 227 228 /* 229 * sap <= ETHERMTU indicates that LLC is being used. If that's the 230 * case, then the ether_type needs to be set to the payload length. 231 */ 232 if ((bind_sap == DLS_SAP_LLC) && (payload != NULL)) 233 sap = msgdsize(payload); 234 ehp->ether_type = htons(sap); 235 236 mp->b_wptr += sizeof (struct ether_header); 237 return (mp); 238 } 239 240 /* ARGSUSED */ 241 int 242 mac_ether_header_info(mblk_t *mp, void *mac_pdata, mac_header_info_t *hdr_info) 243 { 244 struct ether_header *ehp; 245 uint16_t ether_type; 246 247 if (MBLKL(mp) < sizeof (struct ether_header)) 248 return (EINVAL); 249 250 ehp = (struct ether_header *)mp->b_rptr; 251 ether_type = ntohs(ehp->ether_type); 252 253 hdr_info->mhi_hdrsize = sizeof (struct ether_header); 254 hdr_info->mhi_daddr = (const uint8_t *)&(ehp->ether_dhost); 255 hdr_info->mhi_saddr = (const uint8_t *)&(ehp->ether_shost); 256 hdr_info->mhi_origsap = ether_type; 257 hdr_info->mhi_bindsap = (ether_type > ETHERMTU) ? 258 ether_type : DLS_SAP_LLC; 259 hdr_info->mhi_pktsize = (hdr_info->mhi_bindsap == DLS_SAP_LLC) ? 260 hdr_info->mhi_hdrsize + ether_type : 0; 261 262 if (mac_ether_unicst_verify(hdr_info->mhi_daddr, NULL) == 0) 263 hdr_info->mhi_dsttype = MAC_ADDRTYPE_UNICAST; 264 else if (mac_ether_multicst_verify(hdr_info->mhi_daddr, NULL) == 0) 265 hdr_info->mhi_dsttype = MAC_ADDRTYPE_MULTICAST; 266 else 267 hdr_info->mhi_dsttype = MAC_ADDRTYPE_BROADCAST; 268 269 return (0); 270 } 271 272 static mactype_ops_t mac_ether_type_ops = { 273 0, 274 mac_ether_unicst_verify, 275 mac_ether_multicst_verify, 276 mac_ether_sap_verify, 277 mac_ether_header, 278 mac_ether_header_info 279 }; 280