1*b206500fSmmcc /* $OpenBSD: packet.c,v 1.5 2015/12/07 19:14:49 mmcc Exp $ */ 2978e5cffSnorby 3978e5cffSnorby /* 4978e5cffSnorby * Copyright (c) 2004, 2005, 2006 Esben Norby <norby@openbsd.org> 5978e5cffSnorby * 6978e5cffSnorby * Permission to use, copy, modify, and distribute this software for any 7978e5cffSnorby * purpose with or without fee is hereby granted, provided that the above 8978e5cffSnorby * copyright notice and this permission notice appear in all copies. 9978e5cffSnorby * 10978e5cffSnorby * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 11978e5cffSnorby * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 12978e5cffSnorby * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 13978e5cffSnorby * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 14978e5cffSnorby * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 15978e5cffSnorby * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 16978e5cffSnorby * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 17978e5cffSnorby */ 18978e5cffSnorby 19978e5cffSnorby #include <sys/types.h> 20978e5cffSnorby #include <sys/socket.h> 21978e5cffSnorby #include <sys/time.h> 22978e5cffSnorby 23978e5cffSnorby #include <netinet/in.h> 24978e5cffSnorby #include <netinet/ip.h> 25978e5cffSnorby #include <netinet/ip_mroute.h> 26978e5cffSnorby #include <arpa/inet.h> 27978e5cffSnorby 28978e5cffSnorby #include <errno.h> 29978e5cffSnorby #include <event.h> 30978e5cffSnorby #include <stdlib.h> 31b53a5054Smmcc #include <string.h> 32978e5cffSnorby 33978e5cffSnorby #include "igmp.h" 34978e5cffSnorby #include "dvmrpd.h" 35978e5cffSnorby #include "dvmrp.h" 36978e5cffSnorby #include "log.h" 37978e5cffSnorby #include "dvmrpe.h" 38978e5cffSnorby 39978e5cffSnorby int ip_hdr_sanity_check(const struct ip *, u_int16_t); 40978e5cffSnorby int dvmrp_hdr_sanity_check(const struct ip *, struct dvmrp_hdr *, 41978e5cffSnorby u_int16_t, const struct iface *); 42978e5cffSnorby struct iface *find_iface(struct dvmrpd_conf *, struct in_addr); 43978e5cffSnorby 44978e5cffSnorby extern struct dvmrpd_conf *deconf; 45978e5cffSnorby 46978e5cffSnorby int 47e39620e5Snicm gen_dvmrp_hdr(struct ibuf *buf, struct iface *iface, u_int8_t code) 48978e5cffSnorby { 49978e5cffSnorby struct dvmrp_hdr dvmrp_hdr; 50978e5cffSnorby 51*b206500fSmmcc memset(&dvmrp_hdr, 0, sizeof(dvmrp_hdr)); 52978e5cffSnorby dvmrp_hdr.type = PKT_TYPE_DVMRP; 53978e5cffSnorby dvmrp_hdr.code = code; 54978e5cffSnorby dvmrp_hdr.chksum = 0; /* updated later */ 55978e5cffSnorby dvmrp_hdr.capabilities = DVMRP_CAP_DEFAULT; /* XXX update */ 56978e5cffSnorby dvmrp_hdr.minor_version = DVMRP_MINOR_VERSION; 57978e5cffSnorby dvmrp_hdr.major_version = DVMRP_MAJOR_VERSION; 58978e5cffSnorby 59e39620e5Snicm return (ibuf_add(buf, &dvmrp_hdr, sizeof(dvmrp_hdr))); 60978e5cffSnorby } 61978e5cffSnorby 62978e5cffSnorby /* send and receive packets */ 63978e5cffSnorby int 64978e5cffSnorby send_packet(struct iface *iface, void *pkt, size_t len, struct sockaddr_in *dst) 65978e5cffSnorby { 66978e5cffSnorby if (iface->passive) { 67978e5cffSnorby log_warnx("send_packet: cannot send packet on passive " 68978e5cffSnorby "interface %s", iface->name); 69978e5cffSnorby return (-1); 70978e5cffSnorby } 71978e5cffSnorby 72978e5cffSnorby /* set outgoing interface for multicast traffic */ 73978e5cffSnorby if (IN_MULTICAST(ntohl(dst->sin_addr.s_addr))) 74978e5cffSnorby if (if_set_mcast(iface) == -1) { 75978e5cffSnorby log_warn("send_packet: error setting multicast " 76978e5cffSnorby "interface, %s", iface->name); 77978e5cffSnorby return (-1); 78978e5cffSnorby } 79978e5cffSnorby 80978e5cffSnorby if (sendto(iface->fd, pkt, len, 0, 81978e5cffSnorby (struct sockaddr *)dst, sizeof(*dst)) == -1 ) { 82978e5cffSnorby log_warn("send_packet: error sending packet on interface %s", 83978e5cffSnorby iface->name); 84978e5cffSnorby return (-1); 85978e5cffSnorby } 86978e5cffSnorby 87978e5cffSnorby return (0); 88978e5cffSnorby } 89978e5cffSnorby 90978e5cffSnorby void 91978e5cffSnorby recv_packet(int fd, short event, void *bula) 92978e5cffSnorby { 93978e5cffSnorby struct dvmrpd_conf *xconf = bula; 94978e5cffSnorby struct ip ip_hdr; 95978e5cffSnorby struct dvmrp_hdr *dvmrp_hdr; 96978e5cffSnorby struct iface *iface; 97978e5cffSnorby struct nbr *nbr = NULL; 98978e5cffSnorby struct in_addr addr; 99978e5cffSnorby char *buf; 100978e5cffSnorby ssize_t r; 101978e5cffSnorby u_int16_t len; 102978e5cffSnorby int l; 103978e5cffSnorby 104978e5cffSnorby if (event != EV_READ) 105978e5cffSnorby return; 106978e5cffSnorby 107978e5cffSnorby /* setup buffer */ 108978e5cffSnorby buf = pkt_ptr; 109978e5cffSnorby 110e39620e5Snicm if ((r = recvfrom(fd, buf, IBUF_READ_SIZE, 0, NULL, NULL)) == -1) { 111978e5cffSnorby if (errno != EAGAIN && errno != EINTR) 112978e5cffSnorby log_debug("recv_packet: error receiving packet"); 113978e5cffSnorby return; 114978e5cffSnorby } 115978e5cffSnorby 116978e5cffSnorby len = (u_int16_t)r; 117978e5cffSnorby 118978e5cffSnorby /* IP header sanity checks */ 119978e5cffSnorby if (len < sizeof(ip_hdr)) { 120978e5cffSnorby log_warnx("recv_packet: bad packet size"); 121978e5cffSnorby return; 122978e5cffSnorby } 123978e5cffSnorby 124978e5cffSnorby memcpy(&ip_hdr, buf, sizeof(ip_hdr)); 125978e5cffSnorby if ((l = ip_hdr_sanity_check(&ip_hdr, len)) == -1) 126978e5cffSnorby return; 127978e5cffSnorby buf += l; 128978e5cffSnorby len -= l; 129978e5cffSnorby 130978e5cffSnorby /* find a matching interface */ 131978e5cffSnorby if ((iface = find_iface(xconf, ip_hdr.ip_src)) == NULL) { 132978e5cffSnorby log_debug("recv_packet: cannot find valid interface, ip src %s", 133978e5cffSnorby inet_ntoa(ip_hdr.ip_src)); 134978e5cffSnorby return; 135978e5cffSnorby } 136978e5cffSnorby 137978e5cffSnorby /* header sanity checks */ 138978e5cffSnorby if (len < sizeof(*dvmrp_hdr)) { 139978e5cffSnorby log_warnx("recv_packet: bad packet size"); 140978e5cffSnorby return; 141978e5cffSnorby } 142978e5cffSnorby dvmrp_hdr = (struct dvmrp_hdr *)buf; 143978e5cffSnorby 144978e5cffSnorby switch (dvmrp_hdr->type) { 145978e5cffSnorby /* DVMRP */ 146978e5cffSnorby case PKT_TYPE_DVMRP: 147978e5cffSnorby if ((l = dvmrp_hdr_sanity_check(&ip_hdr, dvmrp_hdr, len, 148978e5cffSnorby iface)) == -1) 149978e5cffSnorby return; 150978e5cffSnorby 151978e5cffSnorby /* 152978e5cffSnorby * mrouted compat 153978e5cffSnorby * 154978e5cffSnorby * Old mrouted versions, send route reports before establishing 155978e5cffSnorby * 2-WAY neighbor relationships. 156978e5cffSnorby */ 157978e5cffSnorby if ((nbr_find_ip(iface, ip_hdr.ip_src.s_addr) == NULL) && 158978e5cffSnorby (dvmrp_hdr->code == DVMRP_CODE_REPORT)) { 159978e5cffSnorby log_debug("recv_packet: route report from neighbor" 160978e5cffSnorby " ID %s, compat", inet_ntoa(ip_hdr.ip_src)); 161978e5cffSnorby nbr = nbr_new(ip_hdr.ip_src.s_addr, iface, 0); 162978e5cffSnorby nbr_fsm(nbr, NBR_EVT_PROBE_RCVD); 163978e5cffSnorby nbr->compat = 1; 164978e5cffSnorby nbr->addr = ip_hdr.ip_src; 165978e5cffSnorby } 166978e5cffSnorby 167978e5cffSnorby if ((dvmrp_hdr->type == PKT_TYPE_DVMRP) && 168978e5cffSnorby (dvmrp_hdr->code != DVMRP_CODE_PROBE)) 169978e5cffSnorby /* find neighbor */ 170978e5cffSnorby if ((nbr = nbr_find_ip(iface, ip_hdr.ip_src.s_addr)) 171978e5cffSnorby == NULL) { 172978e5cffSnorby log_debug("recv_packet: unknown neighbor ID"); 173978e5cffSnorby return; 174978e5cffSnorby } 175978e5cffSnorby 176978e5cffSnorby buf += sizeof(*dvmrp_hdr); 177978e5cffSnorby len = l - sizeof(*dvmrp_hdr); 178978e5cffSnorby 179978e5cffSnorby inet_aton(AllDVMRPRouters, &addr); 180978e5cffSnorby if ((ip_hdr.ip_dst.s_addr != addr.s_addr) && 181978e5cffSnorby (ip_hdr.ip_dst.s_addr != iface->addr.s_addr)) { 182978e5cffSnorby log_debug("recv_packet: interface %s, invalid" 183978e5cffSnorby " destination IP address %s", iface->name, 184978e5cffSnorby inet_ntoa(ip_hdr.ip_dst)); 185978e5cffSnorby break; 186978e5cffSnorby } 187978e5cffSnorby 188978e5cffSnorby switch (dvmrp_hdr->code) { 189978e5cffSnorby case DVMRP_CODE_PROBE: 190978e5cffSnorby recv_probe(iface, ip_hdr.ip_src, ip_hdr.ip_src.s_addr, 191978e5cffSnorby dvmrp_hdr->capabilities, buf, len); 192978e5cffSnorby break; 193978e5cffSnorby case DVMRP_CODE_REPORT: 194978e5cffSnorby recv_report(nbr, buf, len); 195978e5cffSnorby break; 196978e5cffSnorby case DVMRP_CODE_ASK_NBRS2: 197978e5cffSnorby recv_ask_nbrs2(nbr, buf,len); 198978e5cffSnorby break; 199978e5cffSnorby case DVMRP_CODE_NBRS2: 200978e5cffSnorby recv_nbrs2(nbr, buf,len); 201978e5cffSnorby break; 202978e5cffSnorby case DVMRP_CODE_PRUNE: 203978e5cffSnorby recv_prune(nbr, buf, len); 204978e5cffSnorby break; 205978e5cffSnorby case DVMRP_CODE_GRAFT: 206978e5cffSnorby recv_graft(nbr, buf,len); 207978e5cffSnorby break; 208978e5cffSnorby case DVMRP_CODE_GRAFT_ACK: 209978e5cffSnorby recv_graft_ack(nbr, buf,len); 210978e5cffSnorby break; 211978e5cffSnorby default: 212978e5cffSnorby log_debug("recv_packet: unknown DVMRP packet type, " 213978e5cffSnorby "interface %s", iface->name); 214978e5cffSnorby } 215978e5cffSnorby break; 216978e5cffSnorby /* IGMP */ 217978e5cffSnorby case PKT_TYPE_MEMBER_QUERY: 218978e5cffSnorby recv_igmp_query(iface, ip_hdr.ip_src, buf, len); 219978e5cffSnorby break; 220978e5cffSnorby case PKT_TYPE_MEMBER_REPORTv1: 221978e5cffSnorby case PKT_TYPE_MEMBER_REPORTv2: 222978e5cffSnorby recv_igmp_report(iface, ip_hdr.ip_src, buf, len, 223978e5cffSnorby dvmrp_hdr->type); 224978e5cffSnorby break; 225978e5cffSnorby case PKT_TYPE_LEAVE_GROUPv2: 226978e5cffSnorby recv_igmp_leave(iface, ip_hdr.ip_src, buf, len); 227978e5cffSnorby break; 228978e5cffSnorby default: 229978e5cffSnorby log_debug("recv_packet: unknown IGMP packet type, interface %s", 230978e5cffSnorby iface->name); 231978e5cffSnorby } 232978e5cffSnorby } 233978e5cffSnorby 234978e5cffSnorby int 235978e5cffSnorby ip_hdr_sanity_check(const struct ip *ip_hdr, u_int16_t len) 236978e5cffSnorby { 237978e5cffSnorby if (ntohs(ip_hdr->ip_len) != len) { 238978e5cffSnorby log_debug("recv_packet: invalid IP packet length %u", 239978e5cffSnorby ntohs(ip_hdr->ip_len)); 240978e5cffSnorby return (-1); 241978e5cffSnorby } 242978e5cffSnorby 243978e5cffSnorby if (ip_hdr->ip_p != IPPROTO_IGMP) 244978e5cffSnorby /* this is enforced by the socket itself */ 245978e5cffSnorby fatalx("recv_packet: invalid IP proto"); 246978e5cffSnorby 247978e5cffSnorby return (ip_hdr->ip_hl << 2); 248978e5cffSnorby } 249978e5cffSnorby 250978e5cffSnorby int 251978e5cffSnorby dvmrp_hdr_sanity_check(const struct ip *ip_hdr, struct dvmrp_hdr *dvmrp_hdr, 252978e5cffSnorby u_int16_t len, const struct iface *iface) 253978e5cffSnorby { 254978e5cffSnorby /* we only support DVMRPv3 */ 255978e5cffSnorby if (dvmrp_hdr->major_version != DVMRP_MAJOR_VERSION) { 256978e5cffSnorby log_debug("recv_packet: invalid DVMRP version"); 257978e5cffSnorby return (-1); 258978e5cffSnorby } 259978e5cffSnorby 260978e5cffSnorby /* XXX enforce minor version as well, but not yet */ 261978e5cffSnorby 262978e5cffSnorby /* XXX chksum */ 263978e5cffSnorby 264978e5cffSnorby return (len); 265978e5cffSnorby } 266978e5cffSnorby 267978e5cffSnorby struct iface * 268978e5cffSnorby find_iface(struct dvmrpd_conf *xconf, struct in_addr src) 269978e5cffSnorby { 270978e5cffSnorby struct iface *iface = NULL; 271978e5cffSnorby 272978e5cffSnorby /* returned interface needs to be active */ 273978e5cffSnorby LIST_FOREACH(iface, &xconf->iface_list, entry) { 274978e5cffSnorby if (iface->fd > 0 && 275978e5cffSnorby (iface->type == IF_TYPE_POINTOPOINT) && 276978e5cffSnorby (iface->dst.s_addr == src.s_addr) && 277978e5cffSnorby !iface->passive) 278978e5cffSnorby return (iface); 279978e5cffSnorby 280978e5cffSnorby if (iface->fd > 0 && (iface->addr.s_addr & 281978e5cffSnorby iface->mask.s_addr) == (src.s_addr & 282978e5cffSnorby iface->mask.s_addr) && !iface->passive) 283978e5cffSnorby return (iface); 284978e5cffSnorby } 285978e5cffSnorby 286978e5cffSnorby return (NULL); 287978e5cffSnorby } 288