networking/udhcp/arpping.c

   1 /*
   2  * arpping.c
   3  *
   4  * Mostly stolen from: dhcpcd - DHCP client daemon
   5  * by Yoichi Hariguchi <yoichi@fore.com>
   6  */
   7
   8 #include <sys/time.h>
   9 #include <time.h>
  10 #include <sys/socket.h>
  11 #include <netinet/if_ether.h>
  12 #include <net/if_arp.h>
  13 #include <netinet/in.h>
  14 #include <string.h>
  15 #include <unistd.h>
  16 #include <errno.h>
  17
  18 #include "dhcpd.h"
  19 #include "arpping.h"
  20 #include "common.h"
  21
  22 /* args:        yiaddr - what IP to ping
  23  *              ip - our ip
  24  *              mac - our arp address
  25  *              interface - interface to use
  26  * retn:        1 addr free
  27  *              0 addr used
  28  *              -1 error
  29  */
  30
  31 /* FIXME: match response against chaddr */
  32 int arpping(u_int32_t yiaddr, u_int32_t ip, unsigned char *mac, char *interface)
  33 {
  34
  35         int     timeout = 2;
  36         int     optval = 1;
  37         int     s;                      /* socket */
  38         int     rv = 1;                 /* return value */
  39         struct sockaddr addr;           /* for interface name */
  40         struct arpMsg   arp;
  41         fd_set          fdset;
  42         struct timeval  tm;
  43         time_t          prevTime;
  44
  45
  46         if ((s = socket (PF_PACKET, SOCK_PACKET, htons(ETH_P_ARP))) == -1) {
  47                 LOG(LOG_ERR, bb_msg_can_not_create_raw_socket);
  48                 return -1;
  49         }
  50
  51         if (setsockopt(s, SOL_SOCKET, SO_BROADCAST, &optval, sizeof(optval)) == -1) {
  52                 LOG(LOG_ERR, "Could not setsocketopt on raw socket");
  53                 close(s);
  54                 return -1;
  55         }
  56
  57         /* send arp request */
  58         memset(&arp, 0, sizeof(arp));
  59         memcpy(arp.ethhdr.h_dest, MAC_BCAST_ADDR, 6);   /* MAC DA */
  60         memcpy(arp.ethhdr.h_source, mac, 6);            /* MAC SA */
  61         arp.ethhdr.h_proto = htons(ETH_P_ARP);          /* protocol type (Ethernet) */
  62         arp.htype = htons(ARPHRD_ETHER);                /* hardware type */
  63         arp.ptype = htons(ETH_P_IP);                    /* protocol type (ARP message) */
  64         arp.hlen = 6;                                   /* hardware address length */
  65         arp.plen = 4;                                   /* protocol address length */
  66         arp.operation = htons(ARPOP_REQUEST);           /* ARP op code */
  67         memcpy(arp.sInaddr, &ip, sizeof(ip));           /* source IP address */
  68         memcpy(arp.sHaddr, mac, 6);                     /* source hardware address */
  69         memcpy(arp.tInaddr, &yiaddr, sizeof(yiaddr));   /* target IP address */
  70
  71         memset(&addr, 0, sizeof(addr));
  72         strcpy(addr.sa_data, interface);
  73         if (sendto(s, &arp, sizeof(arp), 0, &addr, sizeof(addr)) < 0)
  74                 rv = 0;
  75
  76         /* wait arp reply, and check it */
  77         tm.tv_usec = 0;
  78         time(&prevTime);
  79         while (timeout > 0) {
  80                 FD_ZERO(&fdset);
  81                 FD_SET(s, &fdset);
  82                 tm.tv_sec = timeout;
  83                 if (select(s + 1, &fdset, (fd_set *) NULL, (fd_set *) NULL, &tm) < 0) {
  84                         DEBUG(LOG_ERR, "Error on ARPING request: %m");
  85                         if (errno != EINTR) rv = 0;
  86                 } else if (FD_ISSET(s, &fdset)) {
  87                         if (recv(s, &arp, sizeof(arp), 0) < 0 ) rv = 0;
  88                         if (arp.operation == htons(ARPOP_REPLY) &&
  89                             bcmp(arp.tHaddr, mac, 6) == 0 &&
  90                             *((u_int *) arp.sInaddr) == yiaddr) {
  91                                 DEBUG(LOG_INFO, "Valid arp reply receved for this address");
  92                                 rv = 0;
  93                                 break;
  94                         }
  95                 }
  96                 timeout -= time(NULL) - prevTime;
  97                 time(&prevTime);
  98         }
  99         close(s);
 100         DEBUG(LOG_INFO, "%salid arp replies for this address", rv ? "No v" : "V");
 101         return rv;
 102 }