link_proto.c revision 1.3.2.2
1 1.3.2.2 yamt /* $NetBSD: link_proto.c,v 1.3.2.2 2007/09/03 14:42:22 yamt Exp $ */ 2 1.3.2.2 yamt 3 1.3.2.2 yamt /*- 4 1.3.2.2 yamt * Copyright (c) 1982, 1986, 1993 5 1.3.2.2 yamt * The Regents of the University of California. All rights reserved. 6 1.3.2.2 yamt * 7 1.3.2.2 yamt * Redistribution and use in source and binary forms, with or without 8 1.3.2.2 yamt * modification, are permitted provided that the following conditions 9 1.3.2.2 yamt * are met: 10 1.3.2.2 yamt * 1. Redistributions of source code must retain the above copyright 11 1.3.2.2 yamt * notice, this list of conditions and the following disclaimer. 12 1.3.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 13 1.3.2.2 yamt * notice, this list of conditions and the following disclaimer in the 14 1.3.2.2 yamt * documentation and/or other materials provided with the distribution. 15 1.3.2.2 yamt * 3. Neither the name of the University nor the names of its contributors 16 1.3.2.2 yamt * may be used to endorse or promote products derived from this software 17 1.3.2.2 yamt * without specific prior written permission. 18 1.3.2.2 yamt * 19 1.3.2.2 yamt * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 20 1.3.2.2 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21 1.3.2.2 yamt * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22 1.3.2.2 yamt * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 23 1.3.2.2 yamt * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24 1.3.2.2 yamt * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25 1.3.2.2 yamt * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26 1.3.2.2 yamt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27 1.3.2.2 yamt * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28 1.3.2.2 yamt * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29 1.3.2.2 yamt * SUCH DAMAGE. 30 1.3.2.2 yamt * 31 1.3.2.2 yamt * @(#)uipc_proto.c 8.2 (Berkeley) 2/14/95 32 1.3.2.2 yamt */ 33 1.3.2.2 yamt 34 1.3.2.2 yamt #include <sys/cdefs.h> 35 1.3.2.2 yamt __KERNEL_RCSID(0, "$NetBSD: link_proto.c,v 1.3.2.2 2007/09/03 14:42:22 yamt Exp $"); 36 1.3.2.2 yamt 37 1.3.2.2 yamt #include <sys/param.h> 38 1.3.2.2 yamt #include <sys/socket.h> 39 1.3.2.2 yamt #include <sys/protosw.h> 40 1.3.2.2 yamt #include <sys/domain.h> 41 1.3.2.2 yamt #include <sys/mbuf.h> 42 1.3.2.2 yamt #include <sys/un.h> 43 1.3.2.2 yamt #include <sys/socketvar.h> 44 1.3.2.2 yamt 45 1.3.2.2 yamt #include <net/if.h> 46 1.3.2.2 yamt #include <net/if_dl.h> 47 1.3.2.2 yamt #include <net/raw_cb.h> 48 1.3.2.2 yamt 49 1.3.2.2 yamt static int sockaddr_dl_cmp(const struct sockaddr *, const struct sockaddr *); 50 1.3.2.2 yamt 51 1.3.2.2 yamt /* 52 1.3.2.2 yamt * Definitions of protocols supported in the link-layer domain. 53 1.3.2.2 yamt */ 54 1.3.2.2 yamt 55 1.3.2.2 yamt DOMAIN_DEFINE(linkdomain); /* forward define and add to link set */ 56 1.3.2.2 yamt 57 1.3.2.2 yamt struct domain linkdomain = { 58 1.3.2.2 yamt .dom_family = AF_LINK, 59 1.3.2.2 yamt .dom_name = "link", 60 1.3.2.2 yamt .dom_externalize = NULL, 61 1.3.2.2 yamt .dom_dispose = NULL, 62 1.3.2.2 yamt .dom_protosw = NULL, 63 1.3.2.2 yamt .dom_protoswNPROTOSW = NULL, 64 1.3.2.2 yamt .dom_sockaddr_cmp = sockaddr_dl_cmp 65 1.3.2.2 yamt }; 66 1.3.2.2 yamt 67 1.3.2.2 yamt /* Compare the field at byte offsets [fieldstart, fieldend) in 68 1.3.2.2 yamt * two memory regions, [l, l + llen) and [r, r + llen). 69 1.3.2.2 yamt */ 70 1.3.2.2 yamt static inline int 71 1.3.2.2 yamt submemcmp(const void *l, const void *r, 72 1.3.2.2 yamt const uint_fast8_t llen, const uint_fast8_t rlen, 73 1.3.2.2 yamt const uint_fast8_t fieldstart, const uint_fast8_t fieldend) 74 1.3.2.2 yamt { 75 1.3.2.2 yamt uint_fast8_t cmpend, minlen; 76 1.3.2.2 yamt const uint8_t *lb = l, *rb = r; 77 1.3.2.2 yamt int rc; 78 1.3.2.2 yamt 79 1.3.2.2 yamt minlen = MIN(llen, rlen); 80 1.3.2.2 yamt 81 1.3.2.2 yamt /* The field is missing from one region. The shorter region is the 82 1.3.2.2 yamt * lesser region. 83 1.3.2.2 yamt */ 84 1.3.2.2 yamt if (fieldstart >= minlen) 85 1.3.2.2 yamt return llen - rlen; 86 1.3.2.2 yamt 87 1.3.2.2 yamt /* Two empty, present fields are always equal. */ 88 1.3.2.2 yamt if (fieldstart > fieldend) 89 1.3.2.2 yamt return 0; 90 1.3.2.2 yamt 91 1.3.2.2 yamt cmpend = MIN(fieldend, minlen); 92 1.3.2.2 yamt 93 1.3.2.2 yamt rc = memcmp(&lb[fieldstart], &rb[fieldstart], cmpend - fieldstart); 94 1.3.2.2 yamt 95 1.3.2.2 yamt if (rc != 0) 96 1.3.2.2 yamt return rc; 97 1.3.2.2 yamt /* If one or both fields are truncated, then the shorter is the lesser 98 1.3.2.2 yamt * field. 99 1.3.2.2 yamt */ 100 1.3.2.2 yamt if (minlen < fieldend) 101 1.3.2.2 yamt return llen - rlen; 102 1.3.2.2 yamt /* Fields are full-length and equal. The fields are equal. */ 103 1.3.2.2 yamt return 0; 104 1.3.2.2 yamt } 105 1.3.2.2 yamt 106 1.3.2.2 yamt uint8_t 107 1.3.2.2 yamt sockaddr_dl_measure(uint8_t namelen, uint8_t addrlen) 108 1.3.2.2 yamt { 109 1.3.2.2 yamt return offsetof(struct sockaddr_dl, sdl_data[namelen + addrlen]); 110 1.3.2.2 yamt } 111 1.3.2.2 yamt 112 1.3.2.2 yamt struct sockaddr * 113 1.3.2.2 yamt sockaddr_dl_alloc(uint16_t ifindex, uint8_t type, 114 1.3.2.2 yamt const void *name, uint8_t namelen, const void *addr, uint8_t addrlen, 115 1.3.2.2 yamt int flags) 116 1.3.2.2 yamt { 117 1.3.2.2 yamt struct sockaddr *sa; 118 1.3.2.2 yamt socklen_t len; 119 1.3.2.2 yamt 120 1.3.2.2 yamt len = sockaddr_dl_measure(namelen, addrlen); 121 1.3.2.2 yamt sa = sockaddr_alloc(AF_LINK, len, flags); 122 1.3.2.2 yamt 123 1.3.2.2 yamt if (sa == NULL) 124 1.3.2.2 yamt return NULL; 125 1.3.2.2 yamt 126 1.3.2.2 yamt if (sockaddr_dl_init(satosdl(sa), len, ifindex, type, name, namelen, 127 1.3.2.2 yamt addr, addrlen) == NULL) { 128 1.3.2.2 yamt sockaddr_free(sa); 129 1.3.2.2 yamt return NULL; 130 1.3.2.2 yamt } 131 1.3.2.2 yamt 132 1.3.2.2 yamt return sa; 133 1.3.2.2 yamt } 134 1.3.2.2 yamt 135 1.3.2.2 yamt struct sockaddr_dl * 136 1.3.2.2 yamt sockaddr_dl_init(struct sockaddr_dl *sdl, socklen_t socklen, uint16_t ifindex, 137 1.3.2.2 yamt uint8_t type, const void *name, uint8_t namelen, const void *addr, 138 1.3.2.2 yamt uint8_t addrlen) 139 1.3.2.2 yamt { 140 1.3.2.2 yamt socklen_t len; 141 1.3.2.2 yamt 142 1.3.2.2 yamt sdl->sdl_family = AF_LINK; 143 1.3.2.2 yamt sdl->sdl_slen = 0; 144 1.3.2.2 yamt len = sockaddr_dl_measure(namelen, addrlen); 145 1.3.2.2 yamt if (len > socklen) { 146 1.3.2.2 yamt sdl->sdl_len = socklen; 147 1.3.2.2 yamt #ifdef DIAGNOSTIC 148 1.3.2.2 yamt printf("%s: too long: %" PRIu8 " > %" PRIu8 "\n", __func__, len, 149 1.3.2.2 yamt socklen); 150 1.3.2.2 yamt #endif 151 1.3.2.2 yamt return NULL; 152 1.3.2.2 yamt } 153 1.3.2.2 yamt sdl->sdl_len = len; 154 1.3.2.2 yamt sdl->sdl_index = ifindex; 155 1.3.2.2 yamt sdl->sdl_type = type; 156 1.3.2.2 yamt memset(&sdl->sdl_data[0], 0, namelen + addrlen); 157 1.3.2.2 yamt if (name != NULL) { 158 1.3.2.2 yamt memcpy(&sdl->sdl_data[0], name, namelen); 159 1.3.2.2 yamt sdl->sdl_nlen = namelen; 160 1.3.2.2 yamt } else 161 1.3.2.2 yamt sdl->sdl_nlen = 0; 162 1.3.2.2 yamt if (addr != NULL) { 163 1.3.2.2 yamt memcpy(&sdl->sdl_data[sdl->sdl_nlen], addr, addrlen); 164 1.3.2.2 yamt sdl->sdl_alen = addrlen; 165 1.3.2.2 yamt } else 166 1.3.2.2 yamt sdl->sdl_alen = 0; 167 1.3.2.2 yamt return sdl; 168 1.3.2.2 yamt } 169 1.3.2.2 yamt 170 1.3.2.2 yamt static int 171 1.3.2.2 yamt sockaddr_dl_cmp(const struct sockaddr *sa1, const struct sockaddr *sa2) 172 1.3.2.2 yamt { 173 1.3.2.2 yamt int rc; 174 1.3.2.2 yamt const uint_fast8_t indexofs = offsetof(struct sockaddr_dl, sdl_index); 175 1.3.2.2 yamt const uint_fast8_t nlenofs = offsetof(struct sockaddr_dl, sdl_nlen); 176 1.3.2.2 yamt uint_fast8_t dataofs = offsetof(struct sockaddr_dl, sdl_data[0]); 177 1.3.2.2 yamt const struct sockaddr_dl *sdl1, *sdl2; 178 1.3.2.2 yamt 179 1.3.2.2 yamt sdl1 = satocsdl(sa1); 180 1.3.2.2 yamt sdl2 = satocsdl(sa2); 181 1.3.2.2 yamt 182 1.3.2.2 yamt rc = submemcmp(sdl1, sdl2, sdl1->sdl_len, sdl2->sdl_len, 183 1.3.2.2 yamt indexofs, nlenofs); 184 1.3.2.2 yamt 185 1.3.2.2 yamt if (rc != 0) 186 1.3.2.2 yamt return rc; 187 1.3.2.2 yamt 188 1.3.2.2 yamt rc = submemcmp(sdl1, sdl2, sdl1->sdl_len, sdl2->sdl_len, 189 1.3.2.2 yamt dataofs, dataofs + MIN(sdl1->sdl_nlen, sdl2->sdl_nlen)); 190 1.3.2.2 yamt 191 1.3.2.2 yamt if (rc != 0) 192 1.3.2.2 yamt return rc; 193 1.3.2.2 yamt 194 1.3.2.2 yamt if (sdl1->sdl_nlen != sdl2->sdl_nlen) 195 1.3.2.2 yamt return sdl1->sdl_nlen - sdl2->sdl_nlen; 196 1.3.2.2 yamt 197 1.3.2.2 yamt dataofs += sdl1->sdl_nlen; 198 1.3.2.2 yamt 199 1.3.2.2 yamt rc = submemcmp(sdl1, sdl2, sdl1->sdl_len, sdl2->sdl_len, 200 1.3.2.2 yamt dataofs, dataofs + MIN(sdl1->sdl_alen, sdl2->sdl_alen)); 201 1.3.2.2 yamt 202 1.3.2.2 yamt if (rc != 0) 203 1.3.2.2 yamt return rc; 204 1.3.2.2 yamt 205 1.3.2.2 yamt if (sdl1->sdl_alen != sdl2->sdl_alen) 206 1.3.2.2 yamt return sdl1->sdl_alen - sdl2->sdl_alen; 207 1.3.2.2 yamt 208 1.3.2.2 yamt dataofs += sdl1->sdl_alen; 209 1.3.2.2 yamt 210 1.3.2.2 yamt rc = submemcmp(sdl1, sdl2, sdl1->sdl_len, sdl2->sdl_len, 211 1.3.2.2 yamt dataofs, dataofs + MIN(sdl1->sdl_slen, sdl2->sdl_slen)); 212 1.3.2.2 yamt 213 1.3.2.2 yamt if (sdl1->sdl_slen != sdl2->sdl_slen) 214 1.3.2.2 yamt return sdl1->sdl_slen - sdl2->sdl_slen; 215 1.3.2.2 yamt 216 1.3.2.2 yamt return sdl1->sdl_len - sdl2->sdl_len; 217 1.3.2.2 yamt } 218 1.3.2.2 yamt 219 1.3.2.2 yamt struct sockaddr_dl * 220 1.3.2.2 yamt sockaddr_dl_setaddr(struct sockaddr_dl *sdl, socklen_t socklen, 221 1.3.2.2 yamt const void *addr, uint8_t addrlen) 222 1.3.2.2 yamt { 223 1.3.2.2 yamt socklen_t len; 224 1.3.2.2 yamt 225 1.3.2.2 yamt len = sockaddr_dl_measure(sdl->sdl_nlen, addrlen); 226 1.3.2.2 yamt if (len > socklen) { 227 1.3.2.2 yamt #ifdef DIAGNOSTIC 228 1.3.2.2 yamt printf("%s: too long: %" PRIu8 " > %" PRIu8 "\n", __func__, len, 229 1.3.2.2 yamt socklen); 230 1.3.2.2 yamt #endif 231 1.3.2.2 yamt return NULL; 232 1.3.2.2 yamt } 233 1.3.2.2 yamt memcpy(&sdl->sdl_data[sdl->sdl_nlen], addr, addrlen); 234 1.3.2.2 yamt sdl->sdl_alen = addrlen; 235 1.3.2.2 yamt sdl->sdl_len = len; 236 1.3.2.2 yamt return sdl; 237 1.3.2.2 yamt } 238
Indexes created Sat Oct 11 19:10:01 GMT 2025