Annotation of embedaddon/quagga/ospf6d/ospf6_network.c, revision 1.1.1.2

1.1       misho       1: /*
                      2:  * Copyright (C) 2003 Yasuhiro Ohara
                      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>
                     23: 
                     24: #include "log.h"
                     25: #include "memory.h"
                     26: #include "sockunion.h"
                     27: #include "sockopt.h"
                     28: #include "privs.h"
                     29: 
                     30: #include "ospf6_proto.h"
                     31: #include "ospf6_network.h"
                     32: 
                     33: extern struct zebra_privs_t ospf6d_privs;
                     34: 
                     35: int  ospf6_sock;
                     36: struct in6_addr allspfrouters6;
                     37: struct in6_addr alldrouters6;
                     38: 
                     39: /* setsockopt ReUseAddr to on */
                     40: void
                     41: ospf6_set_reuseaddr (void)
                     42: {
                     43:   u_int on = 0;
                     44:   if (setsockopt (ospf6_sock, SOL_SOCKET, SO_REUSEADDR, &on,
                     45:                   sizeof (u_int)) < 0)
                     46:     zlog_warn ("Network: set SO_REUSEADDR failed: %s", safe_strerror (errno));
                     47: }
                     48: 
                     49: /* setsockopt MulticastLoop to off */
                     50: void
                     51: ospf6_reset_mcastloop (void)
                     52: {
                     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",
                     57:                safe_strerror (errno));
                     58: }
                     59: 
                     60: void
                     61: ospf6_set_pktinfo (void)
                     62: {
                     63:   setsockopt_ipv6_pktinfo (ospf6_sock, 1);
                     64: }
                     65: 
                     66: void
1.1.1.2 ! misho      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: 
        !            74: void
1.1       misho      75: ospf6_set_checksum (void)
                     76: {
                     77:   int offset = 12;
                     78: #ifndef DISABLE_IPV6_CHECKSUM
                     79:   if (setsockopt (ospf6_sock, IPPROTO_IPV6, IPV6_CHECKSUM,
                     80:                   &offset, sizeof (offset)) < 0)
                     81:     zlog_warn ("Network: set IPV6_CHECKSUM failed: %s", safe_strerror (errno));
                     82: #else
                     83:   zlog_warn ("Network: Don't set IPV6_CHECKSUM");
                     84: #endif /* DISABLE_IPV6_CHECKSUM */
                     85: }
                     86: 
                     87: /* Make ospf6d's server socket. */
                     88: int
                     89: ospf6_serv_sock (void)
                     90: {
                     91:   if (ospf6d_privs.change (ZPRIVS_RAISE))
                     92:     zlog_err ("ospf6_serv_sock: could not raise privs");
                     93: 
                     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.");
                     98:       if (ospf6d_privs.change (ZPRIVS_LOWER))
                     99:         zlog_err ("ospf_sock_init: could not lower privs");
                    100:       return -1;
                    101:     }
                    102:   if (ospf6d_privs.change (ZPRIVS_LOWER))
                    103:       zlog_err ("ospf_sock_init: could not lower privs");
                    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 ();
1.1.1.2 ! misho     113:   ospf6_set_transport_class ();
1.1       misho     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);
                    119: 
                    120:   return 0;
                    121: }
                    122: 
1.1.1.2 ! misho     123: /* ospf6 set socket option */
1.1       misho     124: void
1.1.1.2 ! misho     125: ospf6_sso (u_int ifindex, struct in6_addr *group, int option)
1.1       misho     126: {
                    127:   struct ipv6_mreq mreq6;
1.1.1.2 ! misho     128:   int ret;
1.1       misho     129: 
                    130:   assert (ifindex);
                    131:   mreq6.ipv6mr_interface = ifindex;
1.1.1.2 ! misho     132:   memcpy (&mreq6.ipv6mr_multiaddr, group, sizeof (struct in6_addr));
1.1       misho     133: 
1.1.1.2 ! misho     134:   ret = setsockopt (ospf6_sock, IPPROTO_IPV6, option,
        !           135:                     &mreq6, sizeof (mreq6));
        !           136:   if (ret < 0)
        !           137:     zlog_err ("Network: setsockopt (%d) on ifindex %d failed: %s",
        !           138:               option, ifindex, safe_strerror (errno));
1.1       misho     139: }
                    140: 
                    141: static int
                    142: iov_count (struct iovec *iov)
                    143: {
                    144:   int i;
                    145:   for (i = 0; iov[i].iov_base; i++)
                    146:     ;
                    147:   return i;
                    148: }
                    149: 
                    150: static int
                    151: iov_totallen (struct iovec *iov)
                    152: {
                    153:   int i;
                    154:   int totallen = 0;
                    155:   for (i = 0; iov[i].iov_base; i++)
                    156:     totallen += iov[i].iov_len;
                    157:   return totallen;
                    158: }
                    159: 
                    160: int
                    161: ospf6_sendmsg (struct in6_addr *src, struct in6_addr *dst,
                    162:                unsigned int *ifindex, struct iovec *message)
                    163: {
                    164:   int retval;
                    165:   struct msghdr smsghdr;
                    166:   struct cmsghdr *scmsgp;
                    167:   u_char cmsgbuf[CMSG_SPACE(sizeof (struct in6_pktinfo))];
                    168:   struct in6_pktinfo *pktinfo;
                    169:   struct sockaddr_in6 dst_sin6;
                    170: 
                    171:   assert (dst);
                    172:   assert (*ifindex);
                    173: 
                    174:   scmsgp = (struct cmsghdr *)cmsgbuf;
                    175:   pktinfo = (struct in6_pktinfo *)(CMSG_DATA(scmsgp));
                    176:   memset (&dst_sin6, 0, sizeof (struct sockaddr_in6));
                    177: 
                    178:   /* source address */
                    179:   pktinfo->ipi6_ifindex = *ifindex;
                    180:   if (src)
                    181:     memcpy (&pktinfo->ipi6_addr, src, sizeof (struct in6_addr));
                    182:   else
                    183:     memset (&pktinfo->ipi6_addr, 0, sizeof (struct in6_addr));
                    184: 
                    185:   /* destination address */
                    186:   dst_sin6.sin6_family = AF_INET6;
                    187: #ifdef SIN6_LEN
                    188:   dst_sin6.sin6_len = sizeof (struct sockaddr_in6);
                    189: #endif /*SIN6_LEN*/
                    190:   memcpy (&dst_sin6.sin6_addr, dst, sizeof (struct in6_addr));
                    191: #ifdef HAVE_SIN6_SCOPE_ID
                    192:   dst_sin6.sin6_scope_id = *ifindex;
                    193: #endif
                    194: 
                    195:   /* send control msg */
                    196:   scmsgp->cmsg_level = IPPROTO_IPV6;
                    197:   scmsgp->cmsg_type = IPV6_PKTINFO;
                    198:   scmsgp->cmsg_len = CMSG_LEN (sizeof (struct in6_pktinfo));
                    199:   /* scmsgp = CMSG_NXTHDR (&smsghdr, scmsgp); */
                    200: 
                    201:   /* send msg hdr */
                    202:   memset (&smsghdr, 0, sizeof (smsghdr));
                    203:   smsghdr.msg_iov = message;
                    204:   smsghdr.msg_iovlen = iov_count (message);
                    205:   smsghdr.msg_name = (caddr_t) &dst_sin6;
                    206:   smsghdr.msg_namelen = sizeof (struct sockaddr_in6);
                    207:   smsghdr.msg_control = (caddr_t) cmsgbuf;
                    208:   smsghdr.msg_controllen = sizeof (cmsgbuf);
                    209: 
                    210:   retval = sendmsg (ospf6_sock, &smsghdr, 0);
                    211:   if (retval != iov_totallen (message))
                    212:     zlog_warn ("sendmsg failed: ifindex: %d: %s (%d)",
                    213:                *ifindex, safe_strerror (errno), errno);
                    214: 
                    215:   return retval;
                    216: }
                    217: 
                    218: int
                    219: ospf6_recvmsg (struct in6_addr *src, struct in6_addr *dst,
                    220:                unsigned int *ifindex, struct iovec *message)
                    221: {
                    222:   int retval;
                    223:   struct msghdr rmsghdr;
                    224:   struct cmsghdr *rcmsgp;
                    225:   u_char cmsgbuf[CMSG_SPACE(sizeof (struct in6_pktinfo))];
                    226:   struct in6_pktinfo *pktinfo;
                    227:   struct sockaddr_in6 src_sin6;
                    228: 
                    229:   rcmsgp = (struct cmsghdr *)cmsgbuf;
                    230:   pktinfo = (struct in6_pktinfo *)(CMSG_DATA(rcmsgp));
                    231:   memset (&src_sin6, 0, sizeof (struct sockaddr_in6));
                    232: 
                    233:   /* receive control msg */
                    234:   rcmsgp->cmsg_level = IPPROTO_IPV6;
                    235:   rcmsgp->cmsg_type = IPV6_PKTINFO;
                    236:   rcmsgp->cmsg_len = CMSG_LEN (sizeof (struct in6_pktinfo));
                    237:   /* rcmsgp = CMSG_NXTHDR (&rmsghdr, rcmsgp); */
                    238: 
                    239:   /* receive msg hdr */
                    240:   memset (&rmsghdr, 0, sizeof (rmsghdr));
                    241:   rmsghdr.msg_iov = message;
                    242:   rmsghdr.msg_iovlen = iov_count (message);
                    243:   rmsghdr.msg_name = (caddr_t) &src_sin6;
                    244:   rmsghdr.msg_namelen = sizeof (struct sockaddr_in6);
                    245:   rmsghdr.msg_control = (caddr_t) cmsgbuf;
                    246:   rmsghdr.msg_controllen = sizeof (cmsgbuf);
                    247: 
                    248:   retval = recvmsg (ospf6_sock, &rmsghdr, 0);
                    249:   if (retval < 0)
                    250:     zlog_warn ("recvmsg failed: %s", safe_strerror (errno));
                    251:   else if (retval == iov_totallen (message))
                    252:     zlog_warn ("recvmsg read full buffer size: %d", retval);
                    253: 
                    254:   /* source address */
                    255:   assert (src);
                    256:   memcpy (src, &src_sin6.sin6_addr, sizeof (struct in6_addr));
                    257: 
                    258:   /* destination address */
                    259:   if (ifindex)
                    260:     *ifindex = pktinfo->ipi6_ifindex;
                    261:   if (dst)
                    262:     memcpy (dst, &pktinfo->ipi6_addr, sizeof (struct in6_addr));
                    263: 
                    264:   return retval;
                    265: }
                    266: 
                    267: 

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>