2 * Copyright (C) 2003 Yasuhiro Ohara
4 * This file is part of GNU Zebra.
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
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.
16 * You should have received a copy of the GNU General Public License along
17 * with this program; see the file COPYING; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
25 #include "sockunion.h"
30 #include "ospf6_proto.h"
31 #include "ospf6_network.h"
33 extern struct zebra_privs_t ospf6d_privs
;
36 struct in6_addr allspfrouters6
;
37 struct in6_addr alldrouters6
;
39 /* setsockopt MulticastLoop to off */
41 ospf6_reset_mcastloop (void)
44 if (setsockopt (ospf6_sock
, IPPROTO_IPV6
, IPV6_MULTICAST_LOOP
,
45 &off
, sizeof (u_int
)) < 0)
46 zlog_warn ("Network: reset IPV6_MULTICAST_LOOP failed: %s",
47 safe_strerror (errno
));
51 ospf6_set_pktinfo (void)
53 setsockopt_ipv6_pktinfo (ospf6_sock
, 1);
57 ospf6_set_transport_class (void)
59 #ifdef IPTOS_PREC_INTERNETCONTROL
60 setsockopt_ipv6_tclass (ospf6_sock
, IPTOS_PREC_INTERNETCONTROL
);
65 ospf6_set_checksum (void)
68 #ifndef DISABLE_IPV6_CHECKSUM
69 if (setsockopt (ospf6_sock
, IPPROTO_IPV6
, IPV6_CHECKSUM
,
70 &offset
, sizeof (offset
)) < 0)
71 zlog_warn ("Network: set IPV6_CHECKSUM failed: %s", safe_strerror (errno
));
73 zlog_warn ("Network: Don't set IPV6_CHECKSUM");
74 #endif /* DISABLE_IPV6_CHECKSUM */
77 /* Make ospf6d's server socket. */
79 ospf6_serv_sock (void)
81 if (ospf6d_privs
.change (ZPRIVS_RAISE
))
82 zlog_err ("ospf6_serv_sock: could not raise privs");
84 ospf6_sock
= socket (AF_INET6
, SOCK_RAW
, IPPROTO_OSPFIGP
);
87 zlog_warn ("Network: can't create OSPF6 socket.");
88 if (ospf6d_privs
.change (ZPRIVS_LOWER
))
89 zlog_err ("ospf_sock_init: could not lower privs");
92 if (ospf6d_privs
.change (ZPRIVS_LOWER
))
93 zlog_err ("ospf_sock_init: could not lower privs");
95 /* set socket options */
97 sockopt_reuseaddr (ospf6_sock
);
99 ospf6_set_reuseaddr ();
101 ospf6_reset_mcastloop ();
102 ospf6_set_pktinfo ();
103 ospf6_set_transport_class ();
104 ospf6_set_checksum ();
106 /* setup global in6_addr, allspf6 and alldr6 for later use */
107 inet_pton (AF_INET6
, ALLSPFROUTERS6
, &allspfrouters6
);
108 inet_pton (AF_INET6
, ALLDROUTERS6
, &alldrouters6
);
113 /* ospf6 set socket option */
115 ospf6_sso (ifindex_t ifindex
, struct in6_addr
*group
, int option
)
117 struct ipv6_mreq mreq6
;
119 int bufsize
= (8 * 1024 * 1024);
122 mreq6
.ipv6mr_interface
= ifindex
;
123 memcpy (&mreq6
.ipv6mr_multiaddr
, group
, sizeof (struct in6_addr
));
125 ret
= setsockopt (ospf6_sock
, IPPROTO_IPV6
, option
,
126 &mreq6
, sizeof (mreq6
));
129 zlog_err ("Network: setsockopt (%d) on ifindex %d failed: %s",
130 option
, ifindex
, safe_strerror (errno
));
134 setsockopt_so_sendbuf (ospf6_sock
, bufsize
);
135 setsockopt_so_recvbuf (ospf6_sock
, bufsize
);
141 iov_count (struct iovec
*iov
)
144 for (i
= 0; iov
[i
].iov_base
; i
++)
150 iov_totallen (struct iovec
*iov
)
154 for (i
= 0; iov
[i
].iov_base
; i
++)
155 totallen
+= iov
[i
].iov_len
;
160 ospf6_sendmsg (struct in6_addr
*src
, struct in6_addr
*dst
,
161 ifindex_t
*ifindex
, struct iovec
*message
)
164 struct msghdr smsghdr
;
165 struct cmsghdr
*scmsgp
;
169 u_char buf
[CMSG_SPACE (sizeof (struct in6_pktinfo
))];
171 struct in6_pktinfo
*pktinfo
;
172 struct sockaddr_in6 dst_sin6
;
177 scmsgp
= (struct cmsghdr
*)&cmsgbuf
;
178 pktinfo
= (struct in6_pktinfo
*)(CMSG_DATA(scmsgp
));
179 memset (&dst_sin6
, 0, sizeof (struct sockaddr_in6
));
182 pktinfo
->ipi6_ifindex
= *ifindex
;
184 memcpy (&pktinfo
->ipi6_addr
, src
, sizeof (struct in6_addr
));
186 memset (&pktinfo
->ipi6_addr
, 0, sizeof (struct in6_addr
));
188 /* destination address */
189 dst_sin6
.sin6_family
= AF_INET6
;
191 dst_sin6
.sin6_len
= sizeof (struct sockaddr_in6
);
193 memcpy (&dst_sin6
.sin6_addr
, dst
, sizeof (struct in6_addr
));
194 dst_sin6
.sin6_scope_id
= *ifindex
;
196 /* send control msg */
197 scmsgp
->cmsg_level
= IPPROTO_IPV6
;
198 scmsgp
->cmsg_type
= IPV6_PKTINFO
;
199 scmsgp
->cmsg_len
= CMSG_LEN (sizeof (struct in6_pktinfo
));
200 /* scmsgp = CMSG_NXTHDR (&smsghdr, scmsgp); */
203 memset (&smsghdr
, 0, sizeof (smsghdr
));
204 smsghdr
.msg_iov
= message
;
205 smsghdr
.msg_iovlen
= iov_count (message
);
206 smsghdr
.msg_name
= (caddr_t
) &dst_sin6
;
207 smsghdr
.msg_namelen
= sizeof (struct sockaddr_in6
);
208 smsghdr
.msg_control
= (caddr_t
) &cmsgbuf
.buf
;
209 smsghdr
.msg_controllen
= sizeof(cmsgbuf
.buf
);
211 retval
= sendmsg (ospf6_sock
, &smsghdr
, 0);
212 if (retval
!= iov_totallen (message
))
213 zlog_warn ("sendmsg failed: ifindex: %d: %s (%d)",
214 *ifindex
, safe_strerror (errno
), errno
);
220 ospf6_recvmsg (struct in6_addr
*src
, struct in6_addr
*dst
,
221 ifindex_t
*ifindex
, struct iovec
*message
)
224 struct msghdr rmsghdr
;
225 struct cmsghdr
*rcmsgp
;
226 u_char cmsgbuf
[CMSG_SPACE(sizeof (struct in6_pktinfo
))];
227 struct in6_pktinfo
*pktinfo
;
228 struct sockaddr_in6 src_sin6
;
230 rcmsgp
= (struct cmsghdr
*)cmsgbuf
;
231 pktinfo
= (struct in6_pktinfo
*)(CMSG_DATA(rcmsgp
));
232 memset (&src_sin6
, 0, sizeof (struct sockaddr_in6
));
234 /* receive control msg */
235 rcmsgp
->cmsg_level
= IPPROTO_IPV6
;
236 rcmsgp
->cmsg_type
= IPV6_PKTINFO
;
237 rcmsgp
->cmsg_len
= CMSG_LEN (sizeof (struct in6_pktinfo
));
238 /* rcmsgp = CMSG_NXTHDR (&rmsghdr, rcmsgp); */
240 /* receive msg hdr */
241 memset (&rmsghdr
, 0, sizeof (rmsghdr
));
242 rmsghdr
.msg_iov
= message
;
243 rmsghdr
.msg_iovlen
= iov_count (message
);
244 rmsghdr
.msg_name
= (caddr_t
) &src_sin6
;
245 rmsghdr
.msg_namelen
= sizeof (struct sockaddr_in6
);
246 rmsghdr
.msg_control
= (caddr_t
) cmsgbuf
;
247 rmsghdr
.msg_controllen
= sizeof (cmsgbuf
);
249 retval
= recvmsg (ospf6_sock
, &rmsghdr
, 0);
251 zlog_warn ("recvmsg failed: %s", safe_strerror (errno
));
252 else if (retval
== iov_totallen (message
))
253 zlog_warn ("recvmsg read full buffer size: %d", retval
);
257 memcpy (src
, &src_sin6
.sin6_addr
, sizeof (struct in6_addr
));
259 /* destination address */
261 *ifindex
= pktinfo
->ipi6_ifindex
;
263 memcpy (dst
, &pktinfo
->ipi6_addr
, sizeof (struct in6_addr
));