]>
Commit | Line | Data |
---|---|---|
718e3744 | 1 | /* |
508e53e2 | 2 | * Copyright (C) 2003 Yasuhiro Ohara |
718e3744 | 3 | * |
4 | * This file is part of GNU Zebra. | |
5 | * | |
6 | * GNU Zebra is free software; you can redistribute it and/or modify it | |
7 | * under the terms of the GNU General Public License as published by the | |
8 | * Free Software Foundation; either version 2, or (at your option) any | |
9 | * later version. | |
10 | * | |
11 | * GNU Zebra is distributed in the hope that it will be useful, but | |
12 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
14 | * General Public License for more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License | |
17 | * along with GNU Zebra; see the file COPYING. If not, write to the | |
18 | * Free Software Foundation, Inc., 59 Temple Place - Suite 330, | |
19 | * Boston, MA 02111-1307, USA. | |
20 | */ | |
21 | ||
22 | #include <zebra.h> | |
508e53e2 | 23 | |
718e3744 | 24 | #include "log.h" |
508e53e2 | 25 | #include "memory.h" |
718e3744 | 26 | #include "sockunion.h" |
03d52f8d | 27 | #include "sockopt.h" |
edd7c245 | 28 | #include "privs.h" |
718e3744 | 29 | |
718e3744 | 30 | #include "ospf6_proto.h" |
508e53e2 | 31 | #include "ospf6_network.h" |
718e3744 | 32 | |
edd7c245 | 33 | extern struct zebra_privs_t ospf6d_privs; |
718e3744 | 34 | |
508e53e2 | 35 | int ospf6_sock; |
36 | struct in6_addr allspfrouters6; | |
37 | struct in6_addr alldrouters6; | |
718e3744 | 38 | |
508e53e2 | 39 | /* setsockopt ReUseAddr to on */ |
40 | void | |
6ac29a51 | 41 | ospf6_set_reuseaddr (void) |
718e3744 | 42 | { |
508e53e2 | 43 | u_int on = 0; |
44 | if (setsockopt (ospf6_sock, SOL_SOCKET, SO_REUSEADDR, &on, | |
45 | sizeof (u_int)) < 0) | |
6099b3b5 | 46 | zlog_warn ("Network: set SO_REUSEADDR failed: %s", safe_strerror (errno)); |
718e3744 | 47 | } |
48 | ||
508e53e2 | 49 | /* setsockopt MulticastLoop to off */ |
718e3744 | 50 | void |
6ac29a51 | 51 | ospf6_reset_mcastloop (void) |
718e3744 | 52 | { |
508e53e2 | 53 | u_int off = 0; |
54 | if (setsockopt (ospf6_sock, IPPROTO_IPV6, IPV6_MULTICAST_LOOP, | |
55 | &off, sizeof (u_int)) < 0) | |
56 | zlog_warn ("Network: reset IPV6_MULTICAST_LOOP failed: %s", | |
6099b3b5 | 57 | safe_strerror (errno)); |
718e3744 | 58 | } |
59 | ||
60 | void | |
6ac29a51 | 61 | ospf6_set_pktinfo (void) |
718e3744 | 62 | { |
79dc373a | 63 | setsockopt_ipv6_pktinfo (ospf6_sock, 1); |
718e3744 | 64 | } |
65 | ||
6d0732c8 SH |
66 | void |
67 | ospf6_set_transport_class (void) | |
68 | { | |
69 | #ifdef IPTOS_PREC_INTERNETCONTROL | |
70 | setsockopt_ipv6_tclass (ospf6_sock, IPTOS_PREC_INTERNETCONTROL); | |
71 | #endif | |
72 | } | |
73 | ||
718e3744 | 74 | void |
6ac29a51 | 75 | ospf6_set_checksum (void) |
718e3744 | 76 | { |
508e53e2 | 77 | int offset = 12; |
78 | #ifndef DISABLE_IPV6_CHECKSUM | |
79 | if (setsockopt (ospf6_sock, IPPROTO_IPV6, IPV6_CHECKSUM, | |
80 | &offset, sizeof (offset)) < 0) | |
6099b3b5 | 81 | zlog_warn ("Network: set IPV6_CHECKSUM failed: %s", safe_strerror (errno)); |
508e53e2 | 82 | #else |
83 | zlog_warn ("Network: Don't set IPV6_CHECKSUM"); | |
84 | #endif /* DISABLE_IPV6_CHECKSUM */ | |
718e3744 | 85 | } |
86 | ||
718e3744 | 87 | /* Make ospf6d's server socket. */ |
88 | int | |
6ac29a51 | 89 | ospf6_serv_sock (void) |
718e3744 | 90 | { |
edd7c245 | 91 | if (ospf6d_privs.change (ZPRIVS_RAISE)) |
508e53e2 | 92 | zlog_err ("ospf6_serv_sock: could not raise privs"); |
93 | ||
718e3744 | 94 | ospf6_sock = socket (AF_INET6, SOCK_RAW, IPPROTO_OSPFIGP); |
95 | if (ospf6_sock < 0) | |
96 | { | |
97 | zlog_warn ("Network: can't create OSPF6 socket."); | |
508e53e2 | 98 | if (ospf6d_privs.change (ZPRIVS_LOWER)) |
99 | zlog_err ("ospf_sock_init: could not lower privs"); | |
718e3744 | 100 | return -1; |
101 | } | |
edd7c245 | 102 | if (ospf6d_privs.change (ZPRIVS_LOWER)) |
103 | zlog_err ("ospf_sock_init: could not lower privs"); | |
508e53e2 | 104 | |
105 | /* set socket options */ | |
106 | #if 1 | |
107 | sockopt_reuseaddr (ospf6_sock); | |
108 | #else | |
109 | ospf6_set_reuseaddr (); | |
110 | #endif /*1*/ | |
111 | ospf6_reset_mcastloop (); | |
112 | ospf6_set_pktinfo (); | |
6d0732c8 | 113 | ospf6_set_transport_class (); |
508e53e2 | 114 | ospf6_set_checksum (); |
115 | ||
116 | /* setup global in6_addr, allspf6 and alldr6 for later use */ | |
117 | inet_pton (AF_INET6, ALLSPFROUTERS6, &allspfrouters6); | |
118 | inet_pton (AF_INET6, ALLDROUTERS6, &alldrouters6); | |
718e3744 | 119 | |
120 | return 0; | |
121 | } | |
122 | ||
508e53e2 | 123 | void |
718e3744 | 124 | ospf6_join_allspfrouters (u_int ifindex) |
125 | { | |
126 | struct ipv6_mreq mreq6; | |
127 | int retval; | |
128 | ||
129 | assert (ifindex); | |
130 | mreq6.ipv6mr_interface = ifindex; | |
508e53e2 | 131 | memcpy (&mreq6.ipv6mr_multiaddr, &allspfrouters6, |
718e3744 | 132 | sizeof (struct in6_addr)); |
133 | ||
134 | retval = setsockopt (ospf6_sock, IPPROTO_IPV6, IPV6_JOIN_GROUP, | |
135 | &mreq6, sizeof (mreq6)); | |
136 | ||
137 | if (retval < 0) | |
138 | zlog_err ("Network: Join AllSPFRouters on ifindex %d failed: %s", | |
6099b3b5 | 139 | ifindex, safe_strerror (errno)); |
718e3744 | 140 | #if 0 |
141 | else | |
c6487d61 | 142 | zlog_debug ("Network: Join AllSPFRouters on ifindex %d", ifindex); |
718e3744 | 143 | #endif |
718e3744 | 144 | } |
145 | ||
146 | void | |
147 | ospf6_leave_allspfrouters (u_int ifindex) | |
148 | { | |
149 | struct ipv6_mreq mreq6; | |
150 | ||
151 | assert (ifindex); | |
152 | mreq6.ipv6mr_interface = ifindex; | |
508e53e2 | 153 | memcpy (&mreq6.ipv6mr_multiaddr, &allspfrouters6, |
718e3744 | 154 | sizeof (struct in6_addr)); |
155 | ||
156 | if (setsockopt (ospf6_sock, IPPROTO_IPV6, IPV6_LEAVE_GROUP, | |
157 | &mreq6, sizeof (mreq6)) < 0) | |
158 | zlog_warn ("Network: Leave AllSPFRouters on ifindex %d Failed: %s", | |
6099b3b5 | 159 | ifindex, safe_strerror (errno)); |
508e53e2 | 160 | #if 0 |
718e3744 | 161 | else |
c6487d61 | 162 | zlog_debug ("Network: Leave AllSPFRouters on ifindex %d", ifindex); |
508e53e2 | 163 | #endif |
718e3744 | 164 | } |
165 | ||
166 | void | |
167 | ospf6_join_alldrouters (u_int ifindex) | |
168 | { | |
169 | struct ipv6_mreq mreq6; | |
170 | ||
171 | assert (ifindex); | |
172 | mreq6.ipv6mr_interface = ifindex; | |
508e53e2 | 173 | memcpy (&mreq6.ipv6mr_multiaddr, &alldrouters6, |
718e3744 | 174 | sizeof (struct in6_addr)); |
175 | ||
176 | if (setsockopt (ospf6_sock, IPPROTO_IPV6, IPV6_JOIN_GROUP, | |
177 | &mreq6, sizeof (mreq6)) < 0) | |
178 | zlog_warn ("Network: Join AllDRouters on ifindex %d Failed: %s", | |
6099b3b5 | 179 | ifindex, safe_strerror (errno)); |
508e53e2 | 180 | #if 0 |
718e3744 | 181 | else |
c6487d61 | 182 | zlog_debug ("Network: Join AllDRouters on ifindex %d", ifindex); |
508e53e2 | 183 | #endif |
718e3744 | 184 | } |
185 | ||
186 | void | |
187 | ospf6_leave_alldrouters (u_int ifindex) | |
188 | { | |
189 | struct ipv6_mreq mreq6; | |
190 | ||
191 | assert (ifindex); | |
192 | mreq6.ipv6mr_interface = ifindex; | |
508e53e2 | 193 | memcpy (&mreq6.ipv6mr_multiaddr, &alldrouters6, |
718e3744 | 194 | sizeof (struct in6_addr)); |
195 | ||
196 | if (setsockopt (ospf6_sock, IPPROTO_IPV6, IPV6_LEAVE_GROUP, | |
197 | &mreq6, sizeof (mreq6)) < 0) | |
198 | zlog_warn ("Network: Leave AllDRouters on ifindex %d Failed", ifindex); | |
508e53e2 | 199 | #if 0 |
718e3744 | 200 | else |
c6487d61 | 201 | zlog_debug ("Network: Leave AllDRouters on ifindex %d", ifindex); |
508e53e2 | 202 | #endif |
718e3744 | 203 | } |
204 | ||
6ac29a51 | 205 | static int |
508e53e2 | 206 | iov_count (struct iovec *iov) |
718e3744 | 207 | { |
508e53e2 | 208 | int i; |
209 | for (i = 0; iov[i].iov_base; i++) | |
210 | ; | |
211 | return i; | |
718e3744 | 212 | } |
213 | ||
6ac29a51 | 214 | static int |
508e53e2 | 215 | iov_totallen (struct iovec *iov) |
718e3744 | 216 | { |
508e53e2 | 217 | int i; |
218 | int totallen = 0; | |
219 | for (i = 0; iov[i].iov_base; i++) | |
220 | totallen += iov[i].iov_len; | |
221 | return totallen; | |
718e3744 | 222 | } |
223 | ||
508e53e2 | 224 | int |
718e3744 | 225 | ospf6_sendmsg (struct in6_addr *src, struct in6_addr *dst, |
226 | unsigned int *ifindex, struct iovec *message) | |
227 | { | |
228 | int retval; | |
229 | struct msghdr smsghdr; | |
230 | struct cmsghdr *scmsgp; | |
231 | u_char cmsgbuf[CMSG_SPACE(sizeof (struct in6_pktinfo))]; | |
232 | struct in6_pktinfo *pktinfo; | |
233 | struct sockaddr_in6 dst_sin6; | |
234 | ||
235 | assert (dst); | |
236 | assert (*ifindex); | |
237 | ||
238 | scmsgp = (struct cmsghdr *)cmsgbuf; | |
239 | pktinfo = (struct in6_pktinfo *)(CMSG_DATA(scmsgp)); | |
240 | memset (&dst_sin6, 0, sizeof (struct sockaddr_in6)); | |
241 | ||
242 | /* source address */ | |
243 | pktinfo->ipi6_ifindex = *ifindex; | |
244 | if (src) | |
245 | memcpy (&pktinfo->ipi6_addr, src, sizeof (struct in6_addr)); | |
246 | else | |
247 | memset (&pktinfo->ipi6_addr, 0, sizeof (struct in6_addr)); | |
248 | ||
249 | /* destination address */ | |
250 | dst_sin6.sin6_family = AF_INET6; | |
251 | #ifdef SIN6_LEN | |
252 | dst_sin6.sin6_len = sizeof (struct sockaddr_in6); | |
253 | #endif /*SIN6_LEN*/ | |
254 | memcpy (&dst_sin6.sin6_addr, dst, sizeof (struct in6_addr)); | |
255 | #ifdef HAVE_SIN6_SCOPE_ID | |
256 | dst_sin6.sin6_scope_id = *ifindex; | |
257 | #endif | |
258 | ||
259 | /* send control msg */ | |
260 | scmsgp->cmsg_level = IPPROTO_IPV6; | |
261 | scmsgp->cmsg_type = IPV6_PKTINFO; | |
262 | scmsgp->cmsg_len = CMSG_LEN (sizeof (struct in6_pktinfo)); | |
263 | /* scmsgp = CMSG_NXTHDR (&smsghdr, scmsgp); */ | |
264 | ||
265 | /* send msg hdr */ | |
cf1ce250 | 266 | memset (&smsghdr, 0, sizeof (smsghdr)); |
718e3744 | 267 | smsghdr.msg_iov = message; |
268 | smsghdr.msg_iovlen = iov_count (message); | |
269 | smsghdr.msg_name = (caddr_t) &dst_sin6; | |
270 | smsghdr.msg_namelen = sizeof (struct sockaddr_in6); | |
271 | smsghdr.msg_control = (caddr_t) cmsgbuf; | |
272 | smsghdr.msg_controllen = sizeof (cmsgbuf); | |
273 | ||
274 | retval = sendmsg (ospf6_sock, &smsghdr, 0); | |
275 | if (retval != iov_totallen (message)) | |
508e53e2 | 276 | zlog_warn ("sendmsg failed: ifindex: %d: %s (%d)", |
6099b3b5 | 277 | *ifindex, safe_strerror (errno), errno); |
508e53e2 | 278 | |
279 | return retval; | |
718e3744 | 280 | } |
281 | ||
508e53e2 | 282 | int |
718e3744 | 283 | ospf6_recvmsg (struct in6_addr *src, struct in6_addr *dst, |
284 | unsigned int *ifindex, struct iovec *message) | |
285 | { | |
286 | int retval; | |
287 | struct msghdr rmsghdr; | |
288 | struct cmsghdr *rcmsgp; | |
289 | u_char cmsgbuf[CMSG_SPACE(sizeof (struct in6_pktinfo))]; | |
290 | struct in6_pktinfo *pktinfo; | |
291 | struct sockaddr_in6 src_sin6; | |
292 | ||
293 | rcmsgp = (struct cmsghdr *)cmsgbuf; | |
294 | pktinfo = (struct in6_pktinfo *)(CMSG_DATA(rcmsgp)); | |
295 | memset (&src_sin6, 0, sizeof (struct sockaddr_in6)); | |
296 | ||
297 | /* receive control msg */ | |
298 | rcmsgp->cmsg_level = IPPROTO_IPV6; | |
299 | rcmsgp->cmsg_type = IPV6_PKTINFO; | |
300 | rcmsgp->cmsg_len = CMSG_LEN (sizeof (struct in6_pktinfo)); | |
301 | /* rcmsgp = CMSG_NXTHDR (&rmsghdr, rcmsgp); */ | |
302 | ||
303 | /* receive msg hdr */ | |
cf1ce250 | 304 | memset (&rmsghdr, 0, sizeof (rmsghdr)); |
718e3744 | 305 | rmsghdr.msg_iov = message; |
306 | rmsghdr.msg_iovlen = iov_count (message); | |
307 | rmsghdr.msg_name = (caddr_t) &src_sin6; | |
308 | rmsghdr.msg_namelen = sizeof (struct sockaddr_in6); | |
309 | rmsghdr.msg_control = (caddr_t) cmsgbuf; | |
310 | rmsghdr.msg_controllen = sizeof (cmsgbuf); | |
311 | ||
312 | retval = recvmsg (ospf6_sock, &rmsghdr, 0); | |
313 | if (retval < 0) | |
6099b3b5 | 314 | zlog_warn ("recvmsg failed: %s", safe_strerror (errno)); |
718e3744 | 315 | else if (retval == iov_totallen (message)) |
508e53e2 | 316 | zlog_warn ("recvmsg read full buffer size: %d", retval); |
718e3744 | 317 | |
318 | /* source address */ | |
319 | assert (src); | |
320 | memcpy (src, &src_sin6.sin6_addr, sizeof (struct in6_addr)); | |
321 | ||
322 | /* destination address */ | |
323 | if (ifindex) | |
324 | *ifindex = pktinfo->ipi6_ifindex; | |
325 | if (dst) | |
326 | memcpy (dst, &pktinfo->ipi6_addr, sizeof (struct in6_addr)); | |
718e3744 | 327 | |
508e53e2 | 328 | return retval; |
718e3744 | 329 | } |
330 | ||
508e53e2 | 331 |