Annotation of embedaddon/libnet/src/libnet_link_linux.c, revision 1.1
1.1 ! misho 1: /*
! 2: * $Id: libnet_link_linux.c,v 1.5 2004/01/03 20:31:02 mike Exp $
! 3: *
! 4: * libnet 1.1
! 5: * libnet_link_linux.c - linux packet socket and pack socket routines
! 6: *
! 7: * Copyright (c) 1998 - 2004 Mike D. Schiffman <mike@infonexus.com>
! 8: * All rights reserved.
! 9: *
! 10: * Redistribution and use in source and binary forms, with or without
! 11: * modification, are permitted provided that: (1) source code distributions
! 12: * retain the above copyright notice and this paragraph in its entirety, (2)
! 13: * distributions including binary code include the above copyright notice and
! 14: * this paragraph in its entirety in the documentation or other materials
! 15: * provided with the distribution, and (3) all advertising materials mentioning
! 16: * features or use of this software display the following acknowledgement:
! 17: * ``This product includes software developed by the University of California,
! 18: * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
! 19: * the University nor the names of its contributors may be used to endorse
! 20: * or promote products derived from this software without specific prior
! 21: * written permission.
! 22: * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
! 23: * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
! 24: * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
! 25: */
! 26:
! 27: #if (HAVE_CONFIG_H)
! 28: #include "../include/config.h"
! 29: #endif
! 30: #include <sys/time.h>
! 31:
! 32: #include <net/if.h>
! 33: #if (__GLIBC__)
! 34: #include <netinet/if_ether.h>
! 35: #include <net/if_arp.h>
! 36: #else
! 37: #include <linux/if_arp.h>
! 38: #include <linux/if_ether.h>
! 39: #endif
! 40:
! 41: #if (HAVE_PACKET_SOCKET)
! 42: #ifndef SOL_PACKET
! 43: #define SOL_PACKET 263
! 44: #endif /* SOL_PACKET */
! 45: #if __GLIBC__ >= 2 && __GLIBC_MINOR >= 1
! 46: #include <netpacket/packet.h>
! 47: #include <net/ethernet.h> /* the L2 protocols */
! 48: #else
! 49: #include <asm/types.h>
! 50: #include <linux/if_packet.h>
! 51: #include <linux/if_ether.h> /* The L2 protocols */
! 52: #endif
! 53: #endif /* HAVE_PACKET_SOCKET */
! 54:
! 55: #include "../include/bpf.h"
! 56: #include "../include/libnet.h"
! 57:
! 58: #include "../include/gnuc.h"
! 59: #ifdef HAVE_OS_PROTO_H
! 60: #include "../include/os-proto.h"
! 61: #endif
! 62:
! 63:
! 64: int
! 65: libnet_open_link(libnet_t *l)
! 66: {
! 67: struct ifreq ifr;
! 68: int n = 1;
! 69:
! 70: if (l == NULL)
! 71: {
! 72: return (-1);
! 73: }
! 74:
! 75: #if (HAVE_PACKET_SOCKET)
! 76: l->fd = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL));
! 77: #else
! 78: l->fd = socket(PF_INET, SOCK_PACKET, htons(ETH_P_ALL));
! 79: #endif
! 80: if (l->fd == -1)
! 81: {
! 82: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 83: "socket: %s", strerror(errno));
! 84: goto bad;
! 85: }
! 86:
! 87: memset(&ifr, 0, sizeof (ifr));
! 88: strncpy(ifr.ifr_name, l->device, sizeof (ifr.ifr_name) -1);
! 89: ifr.ifr_name[sizeof(ifr.ifr_name) - 1] = '\0';
! 90:
! 91: if (ioctl(l->fd, SIOCGIFHWADDR, &ifr) < 0 )
! 92: {
! 93: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 94: "SIOCGIFHWADDR: %s", strerror(errno));
! 95: goto bad;
! 96: }
! 97:
! 98: switch (ifr.ifr_hwaddr.sa_family)
! 99: {
! 100: case ARPHRD_ETHER:
! 101: case ARPHRD_METRICOM:
! 102: #ifdef ARPHRD_LOOPBACK
! 103: case ARPHRD_LOOPBACK:
! 104: #endif
! 105: l->link_type = DLT_EN10MB;
! 106: l->link_offset = 0xe;
! 107: break;
! 108: case ARPHRD_SLIP:
! 109: case ARPHRD_CSLIP:
! 110: case ARPHRD_SLIP6:
! 111: case ARPHRD_CSLIP6:
! 112: case ARPHRD_PPP:
! 113: l->link_type = DLT_RAW;
! 114: break;
! 115: case ARPHRD_FDDI:
! 116: l->link_type = DLT_FDDI;
! 117: l->link_offset = 0x15;
! 118: break;
! 119: /* Token Ring */
! 120: case ARPHRD_IEEE802:
! 121: case ARPHRD_IEEE802_TR:
! 122: case ARPHRD_PRONET:
! 123: l->link_type = DLT_PRONET;
! 124: l->link_offset = 0x16;
! 125: break;
! 126:
! 127: default:
! 128: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 129: "unknown physical layer type 0x%x\n",
! 130: ifr.ifr_hwaddr.sa_family);
! 131: goto bad;
! 132: }
! 133: #ifdef SO_BROADCAST
! 134: /*
! 135: * man 7 socket
! 136: *
! 137: * Set or get the broadcast flag. When enabled, datagram sockets
! 138: * receive packets sent to a broadcast address and they are allowed
! 139: * to send packets to a broadcast address. This option has no
! 140: * effect on stream-oriented sockets.
! 141: */
! 142: if (setsockopt(l->fd, SOL_SOCKET, SO_BROADCAST, &n, sizeof(n)) == -1)
! 143: {
! 144: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 145: "%s: set SO_BROADCAST failed: %s\n",
! 146: __func__, strerror(errno));
! 147: goto bad;
! 148: }
! 149: #endif /* SO_BROADCAST */
! 150:
! 151: return (1);
! 152:
! 153: bad:
! 154: if (l->fd >= 0)
! 155: {
! 156: close(l->fd);
! 157: }
! 158: return (-1);
! 159: }
! 160:
! 161:
! 162: int
! 163: libnet_close_link(libnet_t *l)
! 164: {
! 165: if (close(l->fd) == 0)
! 166: {
! 167: return (1);
! 168: }
! 169: else
! 170: {
! 171: return (-1);
! 172: }
! 173: }
! 174:
! 175:
! 176: #if (HAVE_PACKET_SOCKET)
! 177: static int
! 178: get_iface_index(int fd, const int8_t *device)
! 179: {
! 180: struct ifreq ifr;
! 181:
! 182: /* memset(&ifr, 0, sizeof(ifr)); */
! 183: strncpy (ifr.ifr_name, device, sizeof(ifr.ifr_name) - 1);
! 184: ifr.ifr_name[sizeof(ifr.ifr_name)-1] = '\0';
! 185:
! 186: if (ioctl(fd, SIOCGIFINDEX, &ifr) == -1)
! 187: {
! 188: return (-1);
! 189: }
! 190:
! 191: return ifr.ifr_ifindex;
! 192: }
! 193: #endif
! 194:
! 195:
! 196: int
! 197: libnet_write_link(libnet_t *l, u_int8_t *packet, u_int32_t size)
! 198: {
! 199: int c;
! 200: #if (HAVE_PACKET_SOCKET)
! 201: struct sockaddr_ll sa;
! 202: #else
! 203: struct sockaddr sa;
! 204: #endif
! 205:
! 206: if (l == NULL)
! 207: {
! 208: return (-1);
! 209: }
! 210:
! 211: memset(&sa, 0, sizeof (sa));
! 212: #if (HAVE_PACKET_SOCKET)
! 213: sa.sll_family = AF_PACKET;
! 214: sa.sll_ifindex = get_iface_index(l->fd, l->device);
! 215: if (sa.sll_ifindex == -1)
! 216: {
! 217: return (-1);
! 218: }
! 219: sa.sll_protocol = htons(ETH_P_ALL);
! 220: #else
! 221: strncpy(sa.sa_data, l->device, sizeof (sa.sa_data) - 1);
! 222: sa.sa_data[sizeof (sa.sa_data) - 1] = 0;
! 223: #endif
! 224:
! 225: c = sendto(l->fd, packet, size, 0,
! 226: (struct sockaddr *)&sa, sizeof (sa));
! 227: if (c != size)
! 228: {
! 229: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 230: "libnet_write_link(): only %d bytes written (%s)\n", c,
! 231: strerror(errno));
! 232: }
! 233: return (c);
! 234: }
! 235:
! 236:
! 237: struct libnet_ether_addr *
! 238: libnet_get_hwaddr(libnet_t *l)
! 239: {
! 240: int fd;
! 241: struct ifreq ifr;
! 242: struct libnet_ether_addr *eap;
! 243: /*
! 244: * XXX - non-re-entrant!
! 245: */
! 246: static struct libnet_ether_addr ea;
! 247:
! 248: if (l == NULL)
! 249: {
! 250: return (NULL);
! 251: }
! 252:
! 253: if (l->device == NULL)
! 254: {
! 255: if (libnet_select_device(l) == -1)
! 256: {
! 257: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 258: "libnet_get_hwaddr: can't figure out a device to use\n");
! 259: return (NULL);
! 260: }
! 261: }
! 262:
! 263: /*
! 264: * Create dummy socket to perform an ioctl upon.
! 265: */
! 266: fd = socket(AF_INET, SOCK_DGRAM, 0);
! 267: if (fd < 0)
! 268: {
! 269: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 270: "socket: %s", strerror(errno));
! 271: goto bad;
! 272: }
! 273:
! 274: memset(&ifr, 0, sizeof(ifr));
! 275: eap = &ea;
! 276: strncpy(ifr.ifr_name, l->device, sizeof(ifr.ifr_name) - 1);
! 277: ifr.ifr_name[sizeof(ifr.ifr_name) - 1] = '\0';
! 278:
! 279: if (ioctl(fd, SIOCGIFHWADDR, (int8_t *)&ifr) < 0)
! 280: {
! 281: close(fd);
! 282: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 283: "ioctl: %s", strerror(errno));
! 284: goto bad;
! 285: }
! 286: memcpy(eap, &ifr.ifr_hwaddr.sa_data, ETHER_ADDR_LEN);
! 287: close(fd);
! 288: return (eap);
! 289:
! 290: bad:
! 291: return (NULL);
! 292: }
! 293:
! 294:
! 295: /* EOF */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to libnet_link_linux.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / libnet / src