blob: cf1596cd4120570f589441c21fd90d8f1e2c8b59 [file] [log] [blame]
Glenn L McGrath9e598412003-01-09 10:06:01 +00001/*
2 * arping.c - Ping hosts by ARP requests/replies
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
8 *
9 * Author: Alexey Kuznetsov <kuznet@ms2.inr.ac.ru>
10 * Busybox port: Nick Fedchik <nick@fedchik.org.ua>
11 */
12
13#include <sys/ioctl.h>
14#include <sys/signal.h>
15#include <sys/time.h>
16
17#include <errno.h>
18#include <stdlib.h>
19#include <string.h>
20#include <unistd.h>
21
22#include <arpa/inet.h>
23#include <net/if.h>
24#include <netinet/ether.h>
25#include <netpacket/packet.h>
26
27#include "busybox.h"
28
29#define APPLET_NAME "arping"
30
31struct in_addr src;
32struct in_addr dst;
33struct sockaddr_ll me;
34struct sockaddr_ll he;
35struct timeval last;
36int dad;
37int unsolicited;
38int advert;
39int quiet;
40int quit_on_reply = 0;
41int count = -1;
42int timeout;
43int unicasting;
44int s;
45int broadcast_only;
46int sent;
47int brd_sent;
48int received;
49int brd_recv;
50int req_recv;
51
52#define MS_TDIFF(tv1,tv2) ( ((tv1).tv_sec-(tv2).tv_sec)*1000 + \
53 ((tv1).tv_usec-(tv2).tv_usec)/1000 )
54#if 0
55static void set_signal(int signo, void (*handler) (void))
56{
57 struct sigaction sa;
58
59 memset(&sa, 0, sizeof(sa));
60 sa.sa_handler = (void (*)(int)) handler;
61 sa.sa_flags = SA_RESTART;
62 sigaction(signo, &sa, NULL);
63}
64#endif
65
Glenn L McGrathe6ae6e32003-01-19 13:31:41 +000066static int send_pack(int sock, struct in_addr *src_addr,
67 struct in_addr *dst_addr, struct sockaddr_ll *ME,
68 struct sockaddr_ll *HE)
Glenn L McGrath9e598412003-01-09 10:06:01 +000069{
70 int err;
71 struct timeval now;
72 unsigned char buf[256];
73 struct arphdr *ah = (struct arphdr *) buf;
74 unsigned char *p = (unsigned char *) (ah + 1);
75
76 ah->ar_hrd = htons(ME->sll_hatype);
77 ah->ar_hrd = htons(ARPHRD_ETHER);
78 ah->ar_pro = htons(ETH_P_IP);
79 ah->ar_hln = ME->sll_halen;
80 ah->ar_pln = 4;
81 ah->ar_op = advert ? htons(ARPOP_REPLY) : htons(ARPOP_REQUEST);
82
83 memcpy(p, &ME->sll_addr, ah->ar_hln);
84 p += ME->sll_halen;
85
86 memcpy(p, src_addr, 4);
87 p += 4;
88
89 if (advert)
90 memcpy(p, &ME->sll_addr, ah->ar_hln);
91 else
92 memcpy(p, &HE->sll_addr, ah->ar_hln);
93 p += ah->ar_hln;
94
95 memcpy(p, dst_addr, 4);
96 p += 4;
97
98 gettimeofday(&now, NULL);
99 err = sendto(sock, buf, p - buf, 0, (struct sockaddr *) HE, sizeof(*HE));
100 if (err == p - buf) {
101 last = now;
102 sent++;
103 if (!unicasting)
104 brd_sent++;
105 }
106 return err;
107}
108
109void finish(void)
110{
111 if (!quiet) {
112 printf("Sent %d probes (%d broadcast(s))\n", sent, brd_sent);
113 printf("Received %d repl%s", received, (received > 1) ? "ies" : "y");
114 if (brd_recv || req_recv) {
115 printf(" (");
116 if (req_recv)
117 printf("%d request(s)", req_recv);
118 if (brd_recv)
119 printf("%s%d broadcast(s)", req_recv ? ", " : "", brd_recv);
120 putchar(')');
121 }
122 putchar('\n');
123 fflush(stdout);
124 }
125 if (dad)
126 exit(!!received);
127 if (unsolicited)
128 exit(0);
129 exit(!received);
130}
131
132void catcher(void)
133{
134 struct timeval tv;
Glenn L McGrath8b96b712003-08-28 19:54:16 +0000135 static struct timeval start;
Glenn L McGrath9e598412003-01-09 10:06:01 +0000136
137 gettimeofday(&tv, NULL);
138
139 if (start.tv_sec == 0)
140 start = tv;
141
142 if (count-- == 0
143 || (timeout && MS_TDIFF(tv, start) > timeout * 1000 + 500))
144 finish();
145
146 if (last.tv_sec == 0 || MS_TDIFF(tv, last) > 500) {
147 send_pack(s, &src, &dst, &me, &he);
148 if (count == 0 && unsolicited)
149 finish();
150 }
151 alarm(1);
152}
153
154int recv_pack(unsigned char *buf, int len, struct sockaddr_ll *FROM)
155{
156 struct timeval tv;
157 struct arphdr *ah = (struct arphdr *) buf;
158 unsigned char *p = (unsigned char *) (ah + 1);
159 struct in_addr src_ip, dst_ip;
160
161 gettimeofday(&tv, NULL);
162
163 /* Filter out wild packets */
164 if (FROM->sll_pkttype != PACKET_HOST &&
165 FROM->sll_pkttype != PACKET_BROADCAST &&
166 FROM->sll_pkttype != PACKET_MULTICAST)
167 return 0;
168
169 /* Only these types are recognised */
170 if (ah->ar_op != htons(ARPOP_REQUEST) && ah->ar_op != htons(ARPOP_REPLY))
171 return 0;
172
173 /* ARPHRD check and this darned FDDI hack here :-( */
174 if (ah->ar_hrd != htons(FROM->sll_hatype) &&
175 (FROM->sll_hatype != ARPHRD_FDDI
176 || ah->ar_hrd != htons(ARPHRD_ETHER)))
177 return 0;
178
179 /* Protocol must be IP. */
180 if (ah->ar_pro != htons(ETH_P_IP))
181 return 0;
182 if (ah->ar_pln != 4)
183 return 0;
184 if (ah->ar_hln != me.sll_halen)
185 return 0;
186 if (len < sizeof(*ah) + 2 * (4 + ah->ar_hln))
187 return 0;
188 memcpy(&src_ip, p + ah->ar_hln, 4);
189 memcpy(&dst_ip, p + ah->ar_hln + 4 + ah->ar_hln, 4);
190 if (!dad) {
191 if (src_ip.s_addr != dst.s_addr)
192 return 0;
193 if (src.s_addr != dst_ip.s_addr)
194 return 0;
195 if (memcmp(p + ah->ar_hln + 4, &me.sll_addr, ah->ar_hln))
196 return 0;
197 } else {
198 /* DAD packet was:
199 src_ip = 0 (or some src)
200 src_hw = ME
201 dst_ip = tested address
202 dst_hw = <unspec>
203
204 We fail, if receive request/reply with:
205 src_ip = tested_address
206 src_hw != ME
207 if src_ip in request was not zero, check
208 also that it matches to dst_ip, otherwise
209 dst_ip/dst_hw do not matter.
210 */
211 if (src_ip.s_addr != dst.s_addr)
212 return 0;
213 if (memcmp(p, &me.sll_addr, me.sll_halen) == 0)
214 return 0;
215 if (src.s_addr && src.s_addr != dst_ip.s_addr)
216 return 0;
217 }
218 if (!quiet) {
219 int s_printed = 0;
220
221 printf("%s ",
222 FROM->sll_pkttype == PACKET_HOST ? "Unicast" : "Broadcast");
223 printf("%s from ",
224 ah->ar_op == htons(ARPOP_REPLY) ? "reply" : "request");
225 printf("%s ", inet_ntoa(src_ip));
226 printf("[%s]", ether_ntoa((struct ether_addr *) p));
227 if (dst_ip.s_addr != src.s_addr) {
228 printf("for %s ", inet_ntoa(dst_ip));
229 s_printed = 1;
230 }
231 if (memcmp(p + ah->ar_hln + 4, me.sll_addr, ah->ar_hln)) {
232 if (!s_printed)
233 printf("for ");
234 printf("[%s]",
235 ether_ntoa((struct ether_addr *) p + ah->ar_hln + 4));
236 }
237 if (last.tv_sec) {
238 long usecs = (tv.tv_sec - last.tv_sec) * 1000000 +
239 tv.tv_usec - last.tv_usec;
240 long msecs = (usecs + 500) / 1000;
241
242 usecs -= msecs * 1000 - 500;
243 printf(" %ld.%03ldms\n", msecs, usecs);
244 } else {
245 printf(" UNSOLICITED?\n");
246 }
247 fflush(stdout);
248 }
249 received++;
250 if (FROM->sll_pkttype != PACKET_HOST)
251 brd_recv++;
252 if (ah->ar_op == htons(ARPOP_REQUEST))
253 req_recv++;
254 if (quit_on_reply)
255 finish();
256 if (!broadcast_only) {
257 memcpy(he.sll_addr, p, me.sll_halen);
258 unicasting = 1;
259 }
260 return 1;
261}
262
263int arping_main(int argc, char **argv)
264{
265 int socket_errno;
266 int ch;
267 uid_t uid = getuid();
268 char *device = "eth0";
269 int ifindex = 0;
270 char *source = NULL;
271 char *target;
272
273 s = socket(PF_PACKET, SOCK_DGRAM, 0);
274 socket_errno = errno;
275
276 setuid(uid);
277
Glenn L McGrathe6ae6e32003-01-19 13:31:41 +0000278 while ((ch = getopt(argc, argv, "h?bfDUAqc:w:s:I:")) != EOF) {
Glenn L McGrath9e598412003-01-09 10:06:01 +0000279 switch (ch) {
280 case 'b':
281 broadcast_only = 1;
282 break;
283 case 'D':
284 dad++;
285 quit_on_reply = 1;
286 break;
287 case 'U':
288 unsolicited++;
289 break;
290 case 'A':
291 advert++;
292 unsolicited++;
293 break;
294 case 'q':
295 quiet++;
296 break;
297 case 'c':
298 count = atoi(optarg);
299 break;
300 case 'w':
301 timeout = atoi(optarg);
302 break;
303 case 'I':
Glenn L McGrathe6ae6e32003-01-19 13:31:41 +0000304 if (optarg == NULL)
Manuel Novoa III cad53642003-03-19 09:13:01 +0000305 bb_show_usage();
306 if (bb_strlen(optarg) > IF_NAMESIZE) {
307 bb_error_msg("Interface name `%s' must be less than %d", optarg,
Glenn L McGrathe6ae6e32003-01-19 13:31:41 +0000308 IF_NAMESIZE);
309 exit(2);
310 }
Glenn L McGrath9e598412003-01-09 10:06:01 +0000311 device = optarg;
312 break;
313 case 'f':
314 quit_on_reply = 1;
315 break;
316 case 's':
317 source = optarg;
318 break;
319 case 'h':
320 case '?':
321 default:
Manuel Novoa III cad53642003-03-19 09:13:01 +0000322 bb_show_usage();
Glenn L McGrath9e598412003-01-09 10:06:01 +0000323 }
324 }
325 argc -= optind;
326 argv += optind;
327
328 if (argc != 1)
Manuel Novoa III cad53642003-03-19 09:13:01 +0000329 bb_show_usage();
Glenn L McGrath9e598412003-01-09 10:06:01 +0000330
331 target = *argv;
332
Glenn L McGrath9e598412003-01-09 10:06:01 +0000333
334 if (s < 0) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000335 bb_error_msg("socket");
Glenn L McGrath9e598412003-01-09 10:06:01 +0000336 exit(socket_errno);
337 }
338
Glenn L McGratha837e2d2003-02-09 07:01:33 +0000339 {
Glenn L McGrath9e598412003-01-09 10:06:01 +0000340 struct ifreq ifr;
341
342 memset(&ifr, 0, sizeof(ifr));
343 strncpy(ifr.ifr_name, device, IFNAMSIZ - 1);
344 if (ioctl(s, SIOCGIFINDEX, &ifr) < 0) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000345 bb_error_msg("Interface %s not found", device);
Glenn L McGrath9e598412003-01-09 10:06:01 +0000346 exit(2);
347 }
348 ifindex = ifr.ifr_ifindex;
349
350 if (ioctl(s, SIOCGIFFLAGS, (char *) &ifr)) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000351 bb_error_msg("SIOCGIFFLAGS");
Glenn L McGrath9e598412003-01-09 10:06:01 +0000352 exit(2);
353 }
354 if (!(ifr.ifr_flags & IFF_UP)) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000355 bb_error_msg("Interface %s is down", device);
Glenn L McGrath9e598412003-01-09 10:06:01 +0000356 exit(2);
357 }
358 if (ifr.ifr_flags & (IFF_NOARP | IFF_LOOPBACK)) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000359 bb_error_msg("Interface %s is not ARPable", device);
Glenn L McGrath9e598412003-01-09 10:06:01 +0000360 exit(dad ? 0 : 2);
361 }
362 }
363
Glenn L McGratha837e2d2003-02-09 07:01:33 +0000364 if (!inet_aton(target, &dst)) {
Glenn L McGrath9e598412003-01-09 10:06:01 +0000365 struct hostent *hp;
366
367 hp = gethostbyname2(target, AF_INET);
368 if (!hp) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000369 bb_error_msg("invalid or unknown target %s", target);
Glenn L McGrath9e598412003-01-09 10:06:01 +0000370 exit(2);
371 }
372 memcpy(&dst, hp->h_addr, 4);
373 }
374
Glenn L McGratha837e2d2003-02-09 07:01:33 +0000375 if (source && !inet_aton(source, &src)) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000376 bb_error_msg("invalid source address %s", source);
Glenn L McGrath9e598412003-01-09 10:06:01 +0000377 exit(2);
378 }
379
380 if (!dad && unsolicited && src.s_addr == 0)
381 src = dst;
382
383 if (!dad || src.s_addr) {
384 struct sockaddr_in saddr;
385 int probe_fd = socket(AF_INET, SOCK_DGRAM, 0);
386
387 if (probe_fd < 0) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000388 bb_error_msg("socket");
Glenn L McGrath9e598412003-01-09 10:06:01 +0000389 exit(2);
390 }
391 if (device) {
392 if (setsockopt
393 (probe_fd, SOL_SOCKET, SO_BINDTODEVICE, device,
394 strlen(device) + 1) == -1)
Manuel Novoa III cad53642003-03-19 09:13:01 +0000395 bb_error_msg("WARNING: interface %s is ignored", device);
Glenn L McGrath9e598412003-01-09 10:06:01 +0000396 }
397 memset(&saddr, 0, sizeof(saddr));
398 saddr.sin_family = AF_INET;
399 if (src.s_addr) {
400 saddr.sin_addr = src;
401 if (bind(probe_fd, (struct sockaddr *) &saddr, sizeof(saddr)) == -1) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000402 bb_error_msg("bind");
Glenn L McGrath9e598412003-01-09 10:06:01 +0000403 exit(2);
404 }
405 } else if (!dad) {
406 int on = 1;
407 int alen = sizeof(saddr);
408
409 saddr.sin_port = htons(1025);
410 saddr.sin_addr = dst;
411
412 if (setsockopt
413 (probe_fd, SOL_SOCKET, SO_DONTROUTE, (char *) &on,
414 sizeof(on)) == -1)
415 perror("WARNING: setsockopt(SO_DONTROUTE)");
416 if (connect(probe_fd, (struct sockaddr *) &saddr, sizeof(saddr))
417 == -1) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000418 bb_error_msg("connect");
Glenn L McGrath9e598412003-01-09 10:06:01 +0000419 exit(2);
420 }
421 if (getsockname(probe_fd, (struct sockaddr *) &saddr, &alen) ==
422 -1) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000423 bb_error_msg("getsockname");
Glenn L McGrath9e598412003-01-09 10:06:01 +0000424 exit(2);
425 }
426 src = saddr.sin_addr;
427 }
428 close(probe_fd);
429 };
430
431 me.sll_family = AF_PACKET;
432 me.sll_ifindex = ifindex;
433 me.sll_protocol = htons(ETH_P_ARP);
434 if (bind(s, (struct sockaddr *) &me, sizeof(me)) == -1) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000435 bb_error_msg("bind");
Glenn L McGrath9e598412003-01-09 10:06:01 +0000436 exit(2);
437 }
438
Glenn L McGratha837e2d2003-02-09 07:01:33 +0000439 {
Glenn L McGrath9e598412003-01-09 10:06:01 +0000440 int alen = sizeof(me);
441
442 if (getsockname(s, (struct sockaddr *) &me, &alen) == -1) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000443 bb_error_msg("getsockname");
Glenn L McGrath9e598412003-01-09 10:06:01 +0000444 exit(2);
445 }
446 }
447 if (me.sll_halen == 0) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000448 bb_error_msg("Interface \"%s\" is not ARPable (no ll address)", device);
Glenn L McGrath9e598412003-01-09 10:06:01 +0000449 exit(dad ? 0 : 2);
450 }
451 he = me;
452 memset(he.sll_addr, -1, he.sll_halen);
453
Glenn L McGratha837e2d2003-02-09 07:01:33 +0000454 if (!quiet) {
455 printf("ARPING to %s", inet_ntoa(dst));
456 printf(" from %s via %s\n", inet_ntoa(src),
457 device ? device : "unknown");
458 }
Glenn L McGrath9e598412003-01-09 10:06:01 +0000459
460 if (!src.s_addr && !dad) {
Manuel Novoa III cad53642003-03-19 09:13:01 +0000461 bb_error_msg("no src address in the non-DAD mode");
Glenn L McGrath9e598412003-01-09 10:06:01 +0000462 exit(2);
463 }
464
465 {
466 struct sigaction sa;
Glenn L McGrathe6ae6e32003-01-19 13:31:41 +0000467
Glenn L McGrath9e598412003-01-09 10:06:01 +0000468 memset(&sa, 0, sizeof(sa));
469 sa.sa_flags = SA_RESTART;
470
471 sa.sa_handler = (void (*)(int)) finish;
472 sigaction(SIGINT, &sa, NULL);
473
474 sa.sa_handler = (void (*)(int)) catcher;
475 sigaction(SIGALRM, &sa, NULL);
476 }
477
478 catcher();
479
480 while (1) {
481 sigset_t sset, osset;
482 char packet[4096];
483 struct sockaddr_ll from;
484 int alen = sizeof(from);
485 int cc;
486
487 if ((cc = recvfrom(s, packet, sizeof(packet), 0,
488 (struct sockaddr *) &from, &alen)) < 0) {
489 perror("recvfrom");
490 continue;
491 }
492 sigemptyset(&sset);
493 sigaddset(&sset, SIGALRM);
494 sigaddset(&sset, SIGINT);
495 sigprocmask(SIG_BLOCK, &sset, &osset);
496 recv_pack(packet, cc, &from);
497 sigprocmask(SIG_SETMASK, &osset, NULL);
498 }
499}