diff options
Diffstat (limited to 'src')
| -rw-r--r-- | src/lib/libc/net/rthdr.c | 374 |
1 files changed, 154 insertions, 220 deletions
diff --git a/src/lib/libc/net/rthdr.c b/src/lib/libc/net/rthdr.c index 7a87b322d1..e390eb654d 100644 --- a/src/lib/libc/net/rthdr.c +++ b/src/lib/libc/net/rthdr.c | |||
| @@ -1,4 +1,4 @@ | |||
| 1 | /* $OpenBSD: rthdr.c,v 1.3 2002/06/27 10:14:02 itojun Exp $ */ | 1 | /* $OpenBSD: rthdr.c,v 1.4 2003/06/06 07:02:58 itojun Exp $ */ |
| 2 | 2 | ||
| 3 | /* | 3 | /* |
| 4 | * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. | 4 | * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. |
| @@ -41,270 +41,204 @@ | |||
| 41 | 41 | ||
| 42 | size_t | 42 | size_t |
| 43 | inet6_rthdr_space(type, seg) | 43 | inet6_rthdr_space(type, seg) |
| 44 | int type, seg; | 44 | int type, seg; |
| 45 | { | 45 | { |
| 46 | switch(type) { | 46 | switch (type) { |
| 47 | case IPV6_RTHDR_TYPE_0: | 47 | case IPV6_RTHDR_TYPE_0: |
| 48 | if (seg < 1 || seg > 23) | 48 | if (seg < 1 || seg > 23) |
| 49 | return(0); | 49 | return (0); |
| 50 | return(CMSG_SPACE(sizeof(struct in6_addr) * (seg - 1) | 50 | return (CMSG_SPACE(sizeof(struct in6_addr) * (seg - 1) + |
| 51 | + sizeof(struct ip6_rthdr0))); | 51 | sizeof(struct ip6_rthdr0))); |
| 52 | default: | 52 | default: |
| 53 | #ifdef DEBUG | 53 | return (0); |
| 54 | fprintf(stderr, "inet6_rthdr_space: unknown type(%d)\n", type); | 54 | } |
| 55 | #endif | ||
| 56 | return(0); | ||
| 57 | } | ||
| 58 | } | 55 | } |
| 59 | 56 | ||
| 60 | struct cmsghdr * | 57 | struct cmsghdr * |
| 61 | inet6_rthdr_init(bp, type) | 58 | inet6_rthdr_init(bp, type) |
| 62 | void *bp; | 59 | void *bp; |
| 63 | int type; | 60 | int type; |
| 64 | { | 61 | { |
| 65 | register struct cmsghdr *ch = (struct cmsghdr *)bp; | 62 | struct cmsghdr *ch = (struct cmsghdr *)bp; |
| 66 | register struct ip6_rthdr *rthdr; | 63 | struct ip6_rthdr *rthdr; |
| 67 | 64 | ||
| 68 | rthdr = (struct ip6_rthdr *)CMSG_DATA(ch); | 65 | rthdr = (struct ip6_rthdr *)CMSG_DATA(ch); |
| 69 | 66 | ||
| 70 | ch->cmsg_level = IPPROTO_IPV6; | 67 | ch->cmsg_level = IPPROTO_IPV6; |
| 71 | ch->cmsg_type = IPV6_RTHDR; | 68 | ch->cmsg_type = IPV6_RTHDR; |
| 72 | 69 | ||
| 73 | switch(type) { | 70 | switch (type) { |
| 74 | case IPV6_RTHDR_TYPE_0: | 71 | case IPV6_RTHDR_TYPE_0: |
| 75 | ch->cmsg_len = CMSG_LEN(sizeof(struct ip6_rthdr0) - sizeof(struct in6_addr)); | 72 | ch->cmsg_len = CMSG_LEN(sizeof(struct ip6_rthdr0) - |
| 76 | bzero(rthdr, sizeof(struct ip6_rthdr0)); | 73 | sizeof(struct in6_addr)); |
| 77 | rthdr->ip6r_type = IPV6_RTHDR_TYPE_0; | 74 | bzero(rthdr, sizeof(struct ip6_rthdr0)); |
| 78 | return(ch); | 75 | rthdr->ip6r_type = IPV6_RTHDR_TYPE_0; |
| 79 | default: | 76 | return (ch); |
| 80 | #ifdef DEBUG | 77 | default: |
| 81 | fprintf(stderr, "inet6_rthdr_init: unknown type(%d)\n", type); | 78 | return (NULL); |
| 82 | #endif | 79 | } |
| 83 | return(NULL); | ||
| 84 | } | ||
| 85 | } | 80 | } |
| 86 | 81 | ||
| 87 | int | 82 | int |
| 88 | inet6_rthdr_add(cmsg, addr, flags) | 83 | inet6_rthdr_add(cmsg, addr, flags) |
| 89 | struct cmsghdr *cmsg; | 84 | struct cmsghdr *cmsg; |
| 90 | const struct in6_addr *addr; | 85 | const struct in6_addr *addr; |
| 91 | u_int flags; | 86 | u_int flags; |
| 92 | { | 87 | { |
| 93 | register struct ip6_rthdr *rthdr; | 88 | struct ip6_rthdr *rthdr; |
| 94 | 89 | ||
| 95 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); | 90 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); |
| 96 | 91 | ||
| 97 | switch(rthdr->ip6r_type) { | 92 | switch (rthdr->ip6r_type) { |
| 98 | case IPV6_RTHDR_TYPE_0: | 93 | case IPV6_RTHDR_TYPE_0: |
| 99 | { | 94 | { |
| 100 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; | 95 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; |
| 101 | if (flags != IPV6_RTHDR_LOOSE && flags != IPV6_RTHDR_STRICT) { | 96 | if (flags != IPV6_RTHDR_LOOSE && flags != IPV6_RTHDR_STRICT) |
| 102 | #ifdef DEBUG | 97 | return (-1); |
| 103 | fprintf(stderr, "inet6_rthdr_add: unsupported flag(%u)\n", flags); | 98 | if (rt0->ip6r0_segleft == 23) |
| 104 | #endif | 99 | return (-1); |
| 105 | return(-1); | 100 | if (flags == IPV6_RTHDR_STRICT) { |
| 106 | } | 101 | int c, b; |
| 107 | if (rt0->ip6r0_segleft == 23) { | 102 | c = rt0->ip6r0_segleft / 8; |
| 108 | #ifdef DEBUG | 103 | b = rt0->ip6r0_segleft % 8; |
| 109 | fprintf(stderr, "inet6_rthdr_add: segment overflow\n"); | 104 | rt0->ip6r0_slmap[c] |= (1 << (7 - b)); |
| 110 | #endif | 105 | } |
| 111 | return(-1); | 106 | rt0->ip6r0_segleft++; |
| 112 | } | 107 | bcopy(addr, (caddr_t)rt0 + ((rt0->ip6r0_len + 1) << 3), |
| 113 | if (flags == IPV6_RTHDR_STRICT) { | 108 | sizeof(struct in6_addr)); |
| 114 | int c, b; | 109 | rt0->ip6r0_len += sizeof(struct in6_addr) >> 3; |
| 115 | c = rt0->ip6r0_segleft / 8; | 110 | cmsg->cmsg_len = CMSG_LEN((rt0->ip6r0_len + 1) << 3); |
| 116 | b = rt0->ip6r0_segleft % 8; | 111 | break; |
| 117 | rt0->ip6r0_slmap[c] |= (1 << (7 - b)); | 112 | } |
| 118 | } | 113 | default: |
| 119 | rt0->ip6r0_segleft++; | 114 | return (-1); |
| 120 | bcopy(addr, (caddr_t)rt0 + ((rt0->ip6r0_len + 1) << 3), | 115 | } |
| 121 | sizeof(struct in6_addr)); | 116 | |
| 122 | rt0->ip6r0_len += sizeof(struct in6_addr) >> 3; | 117 | return (0); |
| 123 | cmsg->cmsg_len = CMSG_LEN((rt0->ip6r0_len + 1) << 3); | ||
| 124 | break; | ||
| 125 | } | ||
| 126 | default: | ||
| 127 | #ifdef DEBUG | ||
| 128 | fprintf(stderr, "inet6_rthdr_add: unknown type(%u)\n", | ||
| 129 | rthdr->ip6r_type); | ||
| 130 | #endif | ||
| 131 | return(-1); | ||
| 132 | } | ||
| 133 | |||
| 134 | return(0); | ||
| 135 | } | 118 | } |
| 136 | 119 | ||
| 137 | int | 120 | int |
| 138 | inet6_rthdr_lasthop(cmsg, flags) | 121 | inet6_rthdr_lasthop(cmsg, flags) |
| 139 | struct cmsghdr *cmsg; | 122 | struct cmsghdr *cmsg; |
| 140 | unsigned int flags; | 123 | unsigned int flags; |
| 141 | { | 124 | { |
| 142 | register struct ip6_rthdr *rthdr; | 125 | struct ip6_rthdr *rthdr; |
| 143 | 126 | ||
| 144 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); | 127 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); |
| 145 | 128 | ||
| 146 | switch(rthdr->ip6r_type) { | 129 | switch (rthdr->ip6r_type) { |
| 147 | case IPV6_RTHDR_TYPE_0: | 130 | case IPV6_RTHDR_TYPE_0: |
| 148 | { | 131 | { |
| 149 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; | 132 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; |
| 150 | if (flags != IPV6_RTHDR_LOOSE && flags != IPV6_RTHDR_STRICT) { | 133 | if (flags != IPV6_RTHDR_LOOSE && flags != IPV6_RTHDR_STRICT) |
| 151 | #ifdef DEBUG | 134 | return (-1); |
| 152 | fprintf(stderr, "inet6_rthdr_lasthop: unsupported flag(%u)\n", flags); | 135 | if (rt0->ip6r0_segleft > 23) |
| 153 | #endif | 136 | return (-1); |
| 154 | return(-1); | 137 | if (flags == IPV6_RTHDR_STRICT) { |
| 155 | } | 138 | int c, b; |
| 156 | if (rt0->ip6r0_segleft > 23) { | 139 | c = rt0->ip6r0_segleft / 8; |
| 157 | #ifdef DEBUG | 140 | b = rt0->ip6r0_segleft % 8; |
| 158 | fprintf(stderr, "inet6_rthdr_add: segment overflow\n"); | 141 | rt0->ip6r0_slmap[c] |= (1 << (7 - b)); |
| 159 | #endif | 142 | } |
| 160 | return(-1); | 143 | break; |
| 161 | } | 144 | } |
| 162 | if (flags == IPV6_RTHDR_STRICT) { | 145 | default: |
| 163 | int c, b; | 146 | return (-1); |
| 164 | c = rt0->ip6r0_segleft / 8; | 147 | } |
| 165 | b = rt0->ip6r0_segleft % 8; | 148 | |
| 166 | rt0->ip6r0_slmap[c] |= (1 << (7 - b)); | 149 | return (0); |
| 167 | } | ||
| 168 | break; | ||
| 169 | } | ||
| 170 | default: | ||
| 171 | #ifdef DEBUG | ||
| 172 | fprintf(stderr, "inet6_rthdr_lasthop: unknown type(%u)\n", | ||
| 173 | rthdr->ip6r_type); | ||
| 174 | #endif | ||
| 175 | return(-1); | ||
| 176 | } | ||
| 177 | |||
| 178 | return(0); | ||
| 179 | } | 150 | } |
| 180 | 151 | ||
| 181 | #if 0 | 152 | #if 0 |
| 182 | int | 153 | int |
| 183 | inet6_rthdr_reverse(in, out) | 154 | inet6_rthdr_reverse(in, out) |
| 184 | const struct cmsghdr *in; | 155 | const struct cmsghdr *in; |
| 185 | struct cmsghdr *out; | 156 | struct cmsghdr *out; |
| 186 | { | 157 | { |
| 187 | #ifdef DEBUG | 158 | |
| 188 | fprintf(stderr, "inet6_rthdr_reverse: not implemented yet\n"); | 159 | return (-1); |
| 189 | #endif | ||
| 190 | return -1; | ||
| 191 | } | 160 | } |
| 192 | #endif | 161 | #endif |
| 193 | 162 | ||
| 194 | int | 163 | int |
| 195 | inet6_rthdr_segments(cmsg) | 164 | inet6_rthdr_segments(cmsg) |
| 196 | const struct cmsghdr *cmsg; | 165 | const struct cmsghdr *cmsg; |
| 197 | { | 166 | { |
| 198 | register struct ip6_rthdr *rthdr; | 167 | struct ip6_rthdr *rthdr; |
| 199 | 168 | ||
| 200 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); | 169 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); |
| 201 | 170 | ||
| 202 | switch(rthdr->ip6r_type) { | 171 | switch (rthdr->ip6r_type) { |
| 203 | case IPV6_RTHDR_TYPE_0: | 172 | case IPV6_RTHDR_TYPE_0: |
| 204 | { | 173 | { |
| 205 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; | 174 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; |
| 206 | 175 | ||
| 207 | if (rt0->ip6r0_len % 2 || 46 < rt0->ip6r0_len) { | 176 | if (rt0->ip6r0_len % 2 || 46 < rt0->ip6r0_len) |
| 208 | #ifdef DEBUG | 177 | return (-1); |
| 209 | fprintf(stderr, "inet6_rthdr_segments: invalid size(%u)\n", | ||
| 210 | rt0->ip6r0_len); | ||
| 211 | #endif | ||
| 212 | return -1; | ||
| 213 | } | ||
| 214 | 178 | ||
| 215 | return (rt0->ip6r0_len * 8) / sizeof(struct in6_addr); | 179 | return (rt0->ip6r0_len * 8) / sizeof(struct in6_addr); |
| 216 | } | 180 | } |
| 217 | 181 | ||
| 218 | default: | 182 | default: |
| 219 | #ifdef DEBUG | 183 | return (-1); |
| 220 | fprintf(stderr, "inet6_rthdr_segments: unknown type(%u)\n", | 184 | } |
| 221 | rthdr->ip6r_type); | ||
| 222 | #endif | ||
| 223 | return -1; | ||
| 224 | } | ||
| 225 | } | 185 | } |
| 226 | 186 | ||
| 227 | struct in6_addr * | 187 | struct in6_addr * |
| 228 | inet6_rthdr_getaddr(cmsg, index) | 188 | inet6_rthdr_getaddr(cmsg, index) |
| 229 | struct cmsghdr *cmsg; | 189 | struct cmsghdr *cmsg; |
| 230 | int index; | 190 | int index; |
| 231 | { | 191 | { |
| 232 | register struct ip6_rthdr *rthdr; | 192 | struct ip6_rthdr *rthdr; |
| 233 | 193 | ||
| 234 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); | 194 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); |
| 235 | 195 | ||
| 236 | switch(rthdr->ip6r_type) { | 196 | switch (rthdr->ip6r_type) { |
| 237 | case IPV6_RTHDR_TYPE_0: | 197 | case IPV6_RTHDR_TYPE_0: |
| 238 | { | 198 | { |
| 239 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; | 199 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; |
| 240 | int naddr; | 200 | int naddr; |
| 241 | 201 | ||
| 242 | if (rt0->ip6r0_len % 2 || 46 < rt0->ip6r0_len) { | 202 | if (rt0->ip6r0_len % 2 || 46 < rt0->ip6r0_len) |
| 243 | #ifdef DEBUG | 203 | return NULL; |
| 244 | fprintf(stderr, "inet6_rthdr_getaddr: invalid size(%u)\n", | 204 | naddr = (rt0->ip6r0_len * 8) / sizeof(struct in6_addr); |
| 245 | rt0->ip6r0_len); | 205 | if (index <= 0 || naddr < index) |
| 246 | #endif | 206 | return NULL; |
| 247 | return NULL; | 207 | return &rt0->ip6r0_addr[index - 1]; |
| 248 | } | 208 | } |
| 249 | naddr = (rt0->ip6r0_len * 8) / sizeof(struct in6_addr); | 209 | |
| 250 | if (index <= 0 || naddr < index) { | 210 | default: |
| 251 | #ifdef DEBUG | 211 | return NULL; |
| 252 | fprintf(stderr, "inet6_rthdr_getaddr: invalid index(%d)\n", index); | ||
| 253 | #endif | ||
| 254 | return NULL; | ||
| 255 | } | 212 | } |
| 256 | return &rt0->ip6r0_addr[index - 1]; | ||
| 257 | } | ||
| 258 | |||
| 259 | default: | ||
| 260 | #ifdef DEBUG | ||
| 261 | fprintf(stderr, "inet6_rthdr_getaddr: unknown type(%u)\n", | ||
| 262 | rthdr->ip6r_type); | ||
| 263 | #endif | ||
| 264 | return NULL; | ||
| 265 | } | ||
| 266 | } | 213 | } |
| 267 | 214 | ||
| 268 | int | 215 | int |
| 269 | inet6_rthdr_getflags(cmsg, index) | 216 | inet6_rthdr_getflags(cmsg, index) |
| 270 | const struct cmsghdr *cmsg; | 217 | const struct cmsghdr *cmsg; |
| 271 | int index; | 218 | int index; |
| 272 | { | 219 | { |
| 273 | register struct ip6_rthdr *rthdr; | 220 | struct ip6_rthdr *rthdr; |
| 274 | 221 | ||
| 275 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); | 222 | rthdr = (struct ip6_rthdr *)CMSG_DATA(cmsg); |
| 276 | 223 | ||
| 277 | switch(rthdr->ip6r_type) { | 224 | switch (rthdr->ip6r_type) { |
| 278 | case IPV6_RTHDR_TYPE_0: | 225 | case IPV6_RTHDR_TYPE_0: |
| 279 | { | 226 | { |
| 280 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; | 227 | struct ip6_rthdr0 *rt0 = (struct ip6_rthdr0 *)rthdr; |
| 281 | int naddr; | 228 | int naddr; |
| 282 | 229 | ||
| 283 | if (rt0->ip6r0_len % 2 || 46 < rt0->ip6r0_len) { | 230 | if (rt0->ip6r0_len % 2 || 46 < rt0->ip6r0_len) |
| 284 | #ifdef DEBUG | 231 | return (-1); |
| 285 | fprintf(stderr, "inet6_rthdr_getflags: invalid size(%u)\n", | 232 | naddr = (rt0->ip6r0_len * 8) / sizeof(struct in6_addr); |
| 286 | rt0->ip6r0_len); | 233 | if (index < 0 || naddr < index) |
| 287 | #endif | 234 | return (-1); |
| 288 | return -1; | 235 | if (rt0->ip6r0_slmap[index / 8] & (0x80 >> (index % 8))) |
| 236 | return IPV6_RTHDR_STRICT; | ||
| 237 | else | ||
| 238 | return IPV6_RTHDR_LOOSE; | ||
| 289 | } | 239 | } |
| 290 | naddr = (rt0->ip6r0_len * 8) / sizeof(struct in6_addr); | 240 | |
| 291 | if (index < 0 || naddr < index) { | 241 | default: |
| 292 | #ifdef DEBUG | 242 | return (-1); |
| 293 | fprintf(stderr, "inet6_rthdr_getflags: invalid index(%d)\n", index); | ||
| 294 | #endif | ||
| 295 | return -1; | ||
| 296 | } | 243 | } |
| 297 | if (rt0->ip6r0_slmap[index / 8] & (0x80 >> (index % 8))) | ||
| 298 | return IPV6_RTHDR_STRICT; | ||
| 299 | else | ||
| 300 | return IPV6_RTHDR_LOOSE; | ||
| 301 | } | ||
| 302 | |||
| 303 | default: | ||
| 304 | #ifdef DEBUG | ||
| 305 | fprintf(stderr, "inet6_rthdr_getflags: unknown type(%u)\n", | ||
| 306 | rthdr->ip6r_type); | ||
| 307 | #endif | ||
| 308 | return -1; | ||
| 309 | } | ||
| 310 | } | 244 | } |
