1 /* sonar.c --- Simulate a sonar screen.
3 * This is an implementation of a general purpose reporting tool in the
4 * format of a Sonar display. It is designed such that a sensor is read
5 * on every movement of a sweep arm and the results of that sensor are
6 * displayed on the screen. The location of the display points (targets) on the
7 * screen are determined by the current localtion of the sweep and a distance
8 * value associated with the target.
10 * Currently the only two sensors that are implemented are the simulator
11 * (the default) and the ping sensor. The simulator randomly creates a set
12 * of bogies that move around on the scope while the ping sensor can be
13 * used to display hosts on your network.
15 * The ping code is only compiled in if you define HAVE_ICMP or HAVE_ICMPHDR,
16 * because, unfortunately, different systems have different ways of creating
17 * these sorts of packets.
19 * Also: creating an ICMP socket is a privileged operation, so the program
20 * needs to be installed SUID root if you want to use the ping mode. If you
21 * check the code you will see that this privilige is given up immediately
22 * after the socket is created.
24 * It should be easy to extend this code to support other sorts of sensors.
26 * - search the output of "netstat" for the list of hosts to ping;
27 * - plot the contents of /proc/interrupts;
28 * - plot the process table, by process size, cpu usage, or total time;
29 * - plot the logged on users by idle time or cpu usage.
31 * Copyright (C) 1998, 2001
32 * by Stephen Martin (smartin@vanderfleet-martin.net).
33 * Permission to use, copy, modify, distribute, and sell this software and its
34 * documentation for any purpose is hereby granted without fee, provided that
35 * the above copyright notice appear in all copies and that both that
36 * copyright notice and this permission notice appear in supporting
37 * documentation. No representations are made about the suitability of this
38 * software for any purpose. It is provided "as is" without express or
43 * Version 1.0 April 27, 1998.
45 * - Submitted to RedHat Screensaver Contest
47 * Version 1.1 November 3, 1998.
48 * - Added simulation mode.
49 * - Added enhancements by Thomas Bahls <thommy@cs.tu-berlin.de>
50 * - Fixed huge memory leak.
51 * - Submitted to xscreensavers
54 * - All ping code is now ifdef-ed by the compile time symbol HAVE_PING;
55 * use -DHAVE_PING to include it when you compile.
56 * - Sweep now uses gradients.
57 * - Fixed portability problems with icmphdr on some systems.
58 * - removed lowColor option/resource.
59 * - changed copyright notice so that it could be included in the xscreensavers
62 * Version 1.3 November 16, 1998.
63 * - All ping code is now ifdef-ed by the compile time symbol PING use -DPING
64 * to include it when you compile.
65 * - Sweep now uses gradients.
66 * - Fixed portability problems with icmphdr on some systems.
67 * - removed lowcolour option/resource.
68 * - changed copyright notice so that it could be included in the xscreensavers
71 * Version 1.4 November 18, 1998.
72 * - More ping portability fixes.
74 * Version 1.5 November 19, 1998.
75 * - Synced up with jwz's changes.
76 * - Now need to define HAVE_PING to compile in the ping stuff.
79 /* These are computed by configure now:
92 #include "screenhack.h"
96 #if defined(HAVE_ICMP) || defined(HAVE_ICMPHDR)
101 # include <sys/types.h>
102 # include <sys/time.h>
103 # include <sys/ipc.h>
104 # include <sys/shm.h>
105 # include <sys/socket.h>
106 # include <netinet/in_systm.h>
107 # include <netinet/in.h>
108 # include <netinet/ip.h>
109 # include <netinet/ip_icmp.h>
110 # include <netinet/udp.h>
111 # include <arpa/inet.h>
113 #endif /* HAVE_ICMP || HAVE_ICMPHDR */
119 #define MY_MIN(a,b) ((a)<(b)?(a - 50):(b - 10))
122 # define LINE_MAX 2048
127 #if defined(HAVE_ICMP)
130 # define ICMP_TYPE(p) (p)->icmp_type
131 # define ICMP_CODE(p) (p)->icmp_code
132 # define ICMP_CHECKSUM(p) (p)->icmp_cksum
133 # define ICMP_ID(p) (p)->icmp_id
134 # define ICMP_SEQ(p) (p)->icmp_seq
135 #elif defined(HAVE_ICMPHDR)
137 # define ICMP icmphdr
138 # define ICMP_TYPE(p) (p)->type
139 # define ICMP_CODE(p) (p)->code
140 # define ICMP_CHECKSUM(p) (p)->checksum
141 # define ICMP_ID(p) (p)->un.echo.id
142 # define ICMP_SEQ(p) (p)->un.echo.sequence
149 # if defined(__DECC) || defined(_IP_VHL)
150 /* This is how you do it on DEC C, and possibly some BSD systems. */
151 # define IP_HDRLEN(ip) ((ip)->ip_vhl & 0x0F)
153 /* This is how you do it on everything else. */
154 # define IP_HDRLEN(ip) ((ip)->ip_hl)
156 #endif /* HAVE_PING */
159 /* Forward References */
162 static u_short checksum(u_short *, int);
164 static long delta(struct timeval *, struct timeval *);
167 /* Data Structures */
172 * This represents an object that is visable on the scope.
175 typedef struct Bogie {
176 char *name; /* The name of the thing being displayed */
177 int distance; /* The distance to this thing (0 - 100) */
178 int tick; /* The tick that it was found on */
179 int ttl; /* The time to live */
180 int age; /* How long it's been around */
181 struct Bogie *next; /* The next one in the list */
187 * This contains all of the runtime information about the sonar scope.
191 Display *dpy; /* The X display */
192 Window win; /* The window */
193 GC hi, /* The leading edge of the sweep */
194 lo, /* The trailing part of the sweep */
195 erase, /* Used to erase things */
196 grid, /* Used to draw the grid */
197 text; /* Used to draw text */
198 Colormap cmap; /* The colormap */
199 XFontStruct *font; /* The font to use for the labels */
200 int text_steps; /* How many steps to fade text. */
201 XColor *text_colors; /* Pixel values used to fade text */
202 int sweep_degrees; /* How much of the circle the sweep uses */
203 int sweep_segs; /* How many gradients in the sweep. */
204 XColor *sweep_colors; /* The sweep pixel values */
205 int width, height; /* Window dimensions */
206 int minx, miny, maxx, maxy, /* Bounds of the scope */
207 centrex, centrey, radius; /* Parts of the scope circle */
208 Bogie *visable; /* List of visable objects */
209 int current; /* Current position of sweep */
210 int sweepnum; /* The current id of the sweep */
211 int delay; /* how long between each frame of the anim */
213 int TTL; /* The number of ticks that bogies are visible
214 on the screen before they fade away. */
217 static Bool debug_p = False;
221 * Variables to support the differnt Sonar modes.
224 Bogie *(*sensor)(sonar_info *, void *); /* The current sensor */
225 void *sensor_info; /* Information about the sensor */
228 * A list of targets to ping.
231 typedef struct ping_target {
232 char *name; /* The name of the target */
234 struct sockaddr address; /* The address of the target */
235 #endif /* HAVE_PING */
236 struct ping_target *next; /* The next one in the list */
244 * This contains the information for the ping sensor.
248 int icmpsock; /* Socket for sending pings */
249 int pid; /* Our process ID */
250 int seq; /* Packet sequence number */
251 int timeout; /* Timeout value for pings */
252 ping_target *targets; /* List of targets to ping */
253 int numtargets; /* The number of targets to ping */
256 /* Flag to indicate that the timer has expired on us */
258 static int timer_expired;
260 #endif /* HAVE_PING */
263 * A list of targets for the simulator
266 typedef struct sim_target {
267 char *name; /* The name of the target */
268 int nexttick; /* The next tick that this will be seen */
269 int nextdist; /* The distance on that tick */
270 int movedonsweep; /* The number of the sweep this last moved */
274 * Simulator Information.
276 * This contains the information for the simulator mode.
280 sim_target *teamA; /* The bogies for the A team */
281 int numA; /* The number of bogies in team A */
282 char *teamAID; /* The identifier for bogies in team A */
283 sim_target *teamB; /* The bogies for the B team */
284 int numB; /* The number of bogies in team B */
285 char *teamBID; /* The identifier for bogies in team B */
288 /* Name of the Screensaver hack */
290 char *progclass="sonar";
292 /* Application Defaults */
294 char *defaults [] = {
295 ".background: #000000",
296 ".sweepColor: #00FF00",
298 "*scopeColor: #003300",
299 "*gridColor: #00AA00",
300 "*textColor: #FFFF00",
306 "*textSteps: 80", /* npixels */
307 "*sweepSegments: 80", /* npixels */
309 "*pingTimeout: 3000",
321 /* Options passed to this program */
323 XrmOptionDescRec options [] = {
324 {"-background", ".background", XrmoptionSepArg, 0 },
325 {"-sweep-color", ".sweepColor", XrmoptionSepArg, 0 },
326 {"-scope-color", ".scopeColor", XrmoptionSepArg, 0 },
327 {"-grid-color", ".gridColor", XrmoptionSepArg, 0 },
328 {"-text-color", ".textColor", XrmoptionSepArg, 0 },
329 {"-ttl", ".ttl", XrmoptionSepArg, 0 },
330 {"-font", ".font", XrmoptionSepArg, 0 },
332 {"-ping-timeout", ".pingTimeout", XrmoptionSepArg, 0 },
333 #endif /* HAVE_PING */
334 {"-team-a-name", ".teamAName", XrmoptionSepArg, 0 },
335 {"-team-b-name", ".teamBName", XrmoptionSepArg, 0 },
336 {"-team-a-count", ".teamACount", XrmoptionSepArg, 0 },
337 {"-team-b-count", ".teamBCount", XrmoptionSepArg, 0 },
339 {"-ping", ".ping", XrmoptionSepArg, 0 },
340 {"-debug", ".debug", XrmoptionNoArg, "True" },
345 * Create a new Bogie and set some initial values.
348 * name - The name of the bogie.
349 * distance - The distance value.
350 * tick - The tick value.
351 * ttl - The time to live value.
354 * The newly allocated bogie or null if a memory problem occured.
358 newBogie(char *name, int distance, int tick, int ttl)
361 /* Local Variables */
365 /* Allocate a bogie and initialize it */
367 if ((new = (Bogie *) calloc(1, sizeof(Bogie))) == NULL) {
368 fprintf(stderr, "%s: Out of Memory\n", progname);
372 new->distance = distance;
376 new->next = (Bogie *) 0;
384 * b - The bogie to free.
391 if (b->name != (char *) 0)
397 * Find a bogie by name in a list.
399 * This does a simple linear search of the list for a given name.
402 * bl - The Bogie list to search.
403 * name - The name to look for.
406 * The requested Bogie or null if it wasn't found.
410 findNode(Bogie *bl, char *name)
413 /* Local Variables */
417 /* Abort if the list is empty or no name is given */
419 if ((name == NULL) || (bl == NULL))
422 /* Search the list for the desired name */
426 if (strcmp(p->name, name) == 0)
439 * Lookup the address for a ping target;
442 * target - The ping_target fill in the address for.
445 * 1 if the host was successfully resolved, 0 otherwise.
449 lookupHost(ping_target *target)
451 struct hostent *hent;
452 struct sockaddr_in *iaddr;
457 iaddr = (struct sockaddr_in *) &(target->address);
458 iaddr->sin_family = AF_INET;
460 if (4 == sscanf(target->name, "%d.%d.%d.%d%c",
461 &iip[0], &iip[1], &iip[2], &iip[3], &c))
463 /* It's an IP address.
475 fprintf (stderr, "%s: ignoring bogus IP %s\n",
476 progname, target->name);
480 iaddr->sin_addr.s_addr = ((ip[3] << 24) |
484 hent = gethostbyaddr (ip, 4, AF_INET);
487 fprintf (stderr, "%s: %s => %s\n",
488 progname, target->name,
489 ((hent && hent->h_name && *hent->h_name)
490 ? hent->h_name : "<unknown>"));
492 if (hent && hent->h_name && *hent->h_name)
493 target->name = strdup (hent->h_name);
499 hent = gethostbyname (target->name);
502 fprintf (stderr, "%s: could not resolve host: %s\n",
503 progname, target->name);
507 memcpy (&iaddr->sin_addr, hent->h_addr_list[0],
508 sizeof(iaddr->sin_addr));
511 fprintf (stderr, "%s: %s => %d.%d.%d.%d\n",
512 progname, target->name,
513 iaddr->sin_addr.s_addr & 255,
514 iaddr->sin_addr.s_addr >> 8 & 255,
515 iaddr->sin_addr.s_addr >> 16 & 255,
516 iaddr->sin_addr.s_addr >> 24 & 255);
523 print_host (FILE *out, unsigned long ip, const char *name)
526 sprintf (ips, "%d.%d.%d.%d",
531 if (!name || !*name) name = "<unknown>";
532 fprintf (out, "%-16s %s\n", ips, name);
537 * Create a target for a host.
540 * name - The name of the host.
543 * A newly allocated target or null if the host could not be resolved.
550 /* Local Variables */
552 ping_target *target = NULL;
554 /* Create the target */
556 if ((target = calloc(1, sizeof(ping_target))) == NULL) {
557 fprintf(stderr, "%s: Out of Memory\n", progname);
558 goto target_init_error;
560 if ((target->name = strdup(name)) == NULL) {
561 fprintf(stderr, "%s: Out of Memory\n", progname);
562 goto target_init_error;
565 /* Lookup the host */
567 if (! lookupHost(target))
568 goto target_init_error;
570 /* Don't ever use loopback (127.0.0) hosts */
572 struct sockaddr_in *iaddr = (struct sockaddr_in *) &(target->address);
573 unsigned long ip = iaddr->sin_addr.s_addr;
574 if ((ip & 255) == 127 &&
575 ((ip >> 8) & 255) == 0 &&
576 ((ip >> 16) & 255) == 0)
579 fprintf (stderr, "%s: ignoring loopback host %s\n",
580 progname, target->name);
581 goto target_init_error;
589 struct sockaddr_in *iaddr = (struct sockaddr_in *) &(target->address);
590 unsigned long ip = iaddr->sin_addr.s_addr;
591 fprintf (stderr, "%s: added ", progname);
592 print_host (stderr, ip, target->name);
597 /* Handle errors here */
606 * Generate a list of ping targets from the entries in a file.
609 * fname - The name of the file. This file is expected to be in the same
610 * format as /etc/hosts.
613 * A list of targets to ping or null if an error occured.
617 readPingHostsFile(char *fname)
619 /* Local Variables */
624 ping_target *list = NULL;
628 /* Make sure we in fact have a file to process */
630 if ((fname == NULL) || (fname[0] == '\0')) {
631 fprintf(stderr, "%s: invalid ping host file name\n", progname);
637 if ((fp = fopen(fname, "r")) == NULL) {
639 sprintf(msg, "%s: unable to open host file %s", progname, fname);
645 fprintf (stderr, "%s: reading file %s\n", progname, fname);
647 /* Read the file line by line */
649 while ((p = fgets(buf, LINE_MAX, fp)) != NULL) {
652 * Parse the line skipping those that start with '#'.
653 * The rest of the lines in the file should be in the same
654 * format as a /etc/hosts file. We are only concerned with
655 * the first two field, the IP address and the name
658 while ((*p == ' ') || (*p == '\t'))
663 /* Get the name and address */
666 if ((addr = strtok(buf, " ,;\t\n")) != NULL)
667 name = strtok(NULL, " ,;\t\n");
671 /* Check to see if the addr looks like an addr. If not, assume
672 the addr is a name and there is no addr. This way, we can
673 handle files whose lines have "xx.xx.xx.xx hostname" as their
674 first two tokens, and also files that have a hostname as their
675 first token (like .ssh/known_hosts and .rhosts.)
679 if (4 != sscanf(addr, "%d.%d.%d.%d%c", &i, &i, &i, &i, &c))
686 /* If the name is all digits, it's not a name. */
690 for (s = name; *s; s++)
691 if (*s < '0' || *s > '9')
696 fprintf (stderr, "%s: skipping bogus name \"%s\" (%s)\n",
697 progname, name, addr);
702 /* Create a new target using first the name then the address */
707 if (new == NULL && addr != NULL)
710 /* Add it to the list if we got one */
718 /* Close the file and return the list */
726 delete_duplicate_hosts (ping_target *list)
728 ping_target *head = list;
731 for (rest = head; rest; rest = rest->next)
733 struct sockaddr_in *i1 = (struct sockaddr_in *) &(rest->address);
734 unsigned long ip1 = i1->sin_addr.s_addr;
736 static ping_target *rest2;
737 for (rest2 = rest; rest2; rest2 = rest2->next)
739 if (rest2 && rest2->next)
741 struct sockaddr_in *i2 = (struct sockaddr_in *)
742 &(rest2->next->address);
743 unsigned long ip2 = i2->sin_addr.s_addr;
749 fprintf (stderr, "%s: deleted duplicate: ", progname);
750 print_host (stderr, ip2, rest2->next->name);
752 rest2->next = rest2->next->next;
765 * Generate a list ping targets consisting of all of the entries on
769 * A list of all of the hosts on this net.
773 subnetHostsList(int base, int subnet_width)
777 /* Local Variables */
779 char hostname[BUFSIZ];
780 char address[BUFSIZ];
781 struct hostent *hent;
785 ping_target *list = NULL;
787 if (subnet_width < 24)
790 "%s: pinging %u hosts is a bad idea; please use a subnet mask of 24 bits\n"
791 " or more (255 hosts max.)\n",
792 progname, (1L << (32 - subnet_width)) - 1);
795 else if (subnet_width > 30)
797 fprintf (stderr, "%s: a subnet of %d bits doesn't make sense:"
798 " try \"subnet/24\" or \"subnet/29\".\n",
799 progname, subnet_width);
805 fprintf (stderr, "%s: adding %d-bit subnet\n", progname, subnet_width);
807 /* Get our hostname */
809 if (gethostname(hostname, BUFSIZ)) {
810 fprintf(stderr, "%s: unable to get local hostname\n", progname);
814 /* Get our IP address and convert it to a string */
816 if ((hent = gethostbyname(hostname)) == NULL) {
817 fprintf(stderr, "%s: unable to lookup our IP address\n", progname);
820 strcpy(address, inet_ntoa(*((struct in_addr *)hent->h_addr_list[0])));
822 /* Construct targets for all addresses in this subnet */
825 for (i = 0; i < subnet_width; i++)
826 mask |= (1L << (31-i));
828 /* If no base IP specified, assume localhost. */
830 base = ((((unsigned char) hent->h_addr_list[0][0]) << 24) |
831 (((unsigned char) hent->h_addr_list[0][1]) << 16) |
832 (((unsigned char) hent->h_addr_list[0][2]) << 8) |
833 (((unsigned char) hent->h_addr_list[0][3])));
835 if (base == ((127 << 24) | 1))
838 "%s: unable to determine local subnet address: \"%s\"\n"
839 " resolves to loopback address %d.%d.%d.%d.\n",
841 (base >> 24) & 255, (base >> 16) & 255,
842 (base >> 8) & 255, (base ) & 255);
846 for (i = 255; i >= 0; i--) {
847 int ip = (base & 0xFFFFFF00) | i;
849 if ((ip & mask) != (base & mask)) /* not in the mask range at all */
851 if ((ip & ~mask) == 0) /* broadcast address */
853 if ((ip & ~mask) == ~mask) /* broadcast address */
856 sprintf (address, "%d.%d.%d.%d",
857 (ip>>24)&255, (ip>>16)&255, (ip>>8)&255, (ip)&255);
860 fprintf(stderr, "%s: subnet: %s (%d.%d.%d.%d & %d.%d.%d.%d / %d)\n",
863 (base>>24)&255, (base>>16)&255, (base>>8)&255, base&mask&255,
864 (mask>>24)&255, (mask>>16)&255, (mask>>8)&255, mask&255,
867 p = address + strlen(address) + 1;
870 new = newHost(address);
883 * Initialize the ping sensor.
886 * A newly allocated ping_info structure or null if an error occured.
889 static ping_target *parse_mode (Bool ping_works_p);
895 Bool socket_initted_p = False;
897 /* Local Variables */
899 ping_info *pi = NULL; /* The new ping_info struct */
900 ping_target *pt; /* Used to count the targets */
902 /* Create the ping info structure */
904 if ((pi = (ping_info *) calloc(1, sizeof(ping_info))) == NULL) {
905 fprintf(stderr, "%s: Out of memory\n", progname);
906 goto ping_init_error;
909 /* Create the ICMP socket */
911 if ((pi->icmpsock = socket(AF_INET, SOCK_RAW, IPPROTO_ICMP)) >= 0) {
912 socket_initted_p = True;
920 pi->pid = getpid() & 0xFFFF;
922 pi->timeout = get_integer_resource("pingTimeout", "PingTimeout");
924 /* Generate a list of targets */
926 pi->targets = parse_mode (socket_initted_p);
927 pi->targets = delete_duplicate_hosts (pi->targets);
933 fprintf (stderr, "%s: Target list:\n", progname);
934 for (t = pi->targets; t; t = t->next)
936 struct sockaddr_in *iaddr = (struct sockaddr_in *) &(t->address);
937 unsigned long ip = iaddr->sin_addr.s_addr;
938 fprintf (stderr, "%s: ", progname);
939 print_host (stderr, ip, t->name);
943 /* Make sure there is something to ping */
945 if (pi->targets == NULL) {
946 goto ping_init_error;
949 /* Count the targets */
962 /* Handle initialization errors here */
975 * pi - The ping information strcuture.
976 * host - The name or IP address of the host to ping (in ascii).
980 sendping(ping_info *pi, ping_target *pt)
983 /* Local Variables */
990 * Note, we will send the character name of the host that we are
991 * pinging in the packet so that we don't have to keep track of the
992 * name or do an address lookup when it comes back.
995 int pcktsiz = sizeof(struct ICMP) + sizeof(struct timeval) +
996 strlen(pt->name) + 1;
998 /* Create the ICMP packet */
1000 if ((packet = (u_char *) malloc(pcktsiz)) == (void *) 0)
1001 return; /* Out of memory */
1002 icmph = (struct ICMP *) packet;
1003 ICMP_TYPE(icmph) = ICMP_ECHO;
1004 ICMP_CODE(icmph) = 0;
1005 ICMP_CHECKSUM(icmph) = 0;
1006 ICMP_ID(icmph) = pi->pid;
1007 ICMP_SEQ(icmph) = pi->seq++;
1008 gettimeofday((struct timeval *) &packet[sizeof(struct ICMP)],
1009 (struct timezone *) 0);
1010 strcpy((char *) &packet[sizeof(struct ICMP) + sizeof(struct timeval)],
1012 ICMP_CHECKSUM(icmph) = checksum((u_short *)packet, pcktsiz);
1016 if ((result = sendto(pi->icmpsock, packet, pcktsiz, 0,
1017 &pt->address, sizeof(pt->address))) != pcktsiz) {
1019 char errbuf[BUFSIZ];
1020 sprintf(errbuf, "%s: error sending ping to %s", progname, pt->name);
1027 * Catch a signal and do nothing.
1030 * sig - The signal that was caught.
1040 * Compute the checksum on a ping packet.
1043 * packet - A pointer to the packet to compute the checksum for.
1044 * size - The size of the packet.
1047 * The computed checksum
1052 checksum(u_short *packet, int size)
1055 /* Local Variables */
1057 register int nleft = size;
1058 register u_short *w = packet;
1059 register int sum = 0;
1063 * Our algorithm is simple, using a 32 bit accumulator (sum), we add
1064 * sequential 16 bit words to it, and at the end, fold back all the
1065 * carry bits from the top 16 bits into the lower 16 bits.
1073 /* mop up an odd byte, if necessary */
1076 *(u_char *)(&answer) = *(u_char *)w ;
1077 *(1 + (u_char *)(&answer)) = 0;
1081 /* add back carry outs from top 16 bits to low 16 bits */
1083 sum = (sum >> 16) + (sum & 0xffff); /* add hi 16 to low 16 */
1084 sum += (sum >> 16); /* add carry */
1085 answer = ~sum; /* truncate to 16 bits */
1093 * Look for ping replies.
1095 * Retrieve all outstanding ping replies.
1098 * si - Information about the sonar.
1099 * pi - Ping information.
1100 * ttl - The time each bogie is to live on the screen
1103 * A Bogie list of all the machines that replied.
1107 getping(sonar_info *si, ping_info *pi)
1110 /* Local Variables */
1112 struct sockaddr from;
1115 u_char packet[1024];
1117 struct timeval *then;
1124 struct sigaction sa;
1125 struct itimerval it;
1129 /* Set up a signal to interupt our wait for a packet */
1131 sigemptyset(&sa.sa_mask);
1133 sa.sa_handler = sigcatcher;
1134 if (sigaction(SIGALRM, &sa, 0) == -1) {
1136 sprintf(msg, "%s: unable to trap SIGALRM", progname);
1141 /* Set up a timer to interupt us if we don't get a packet */
1143 it.it_interval.tv_sec = 0;
1144 it.it_interval.tv_usec = 0;
1145 it.it_value.tv_sec = 0;
1146 it.it_value.tv_usec = pi->timeout;
1148 setitimer(ITIMER_REAL, &it, NULL);
1150 /* Wait for a result packet */
1152 fromlen = sizeof(from);
1153 while (! timer_expired) {
1154 tv.tv_usec=pi->timeout;
1157 /* This breaks on BSD, which uses bzero() in the definition of FD_ZERO */
1160 memset (&rfds, 0, sizeof(rfds));
1162 FD_SET(pi->icmpsock,&rfds);
1163 /* only wait a little while, in case we raced with the timer expiration.
1164 From Valentijn Sessink <valentyn@openoffice.nl> */
1165 if (select(pi->icmpsock+1, &rfds, NULL, NULL, &tv) >0) {
1166 result = recvfrom(pi->icmpsock, packet, sizeof(packet),
1167 0, &from, &fromlen);
1169 /* Check the packet */
1171 gettimeofday(&now, (struct timezone *) 0);
1172 ip = (struct ip *) packet;
1173 iphdrlen = IP_HDRLEN(ip) << 2;
1174 icmph = (struct ICMP *) &packet[iphdrlen];
1176 /* Was the packet a reply?? */
1178 if (ICMP_TYPE(icmph) != ICMP_ECHOREPLY) {
1179 /* Ignore anything but ICMP Replies */
1180 continue; /* Nope */
1183 /* Was it for us? */
1185 if (ICMP_ID(icmph) != pi->pid) {
1186 /* Ignore packets not set from us */
1187 continue; /* Nope */
1190 /* Copy the name of the bogie */
1193 strdup((char *) &packet[iphdrlen +
1194 + sizeof(struct ICMP)
1195 + sizeof(struct timeval)])) == NULL) {
1196 fprintf(stderr, "%s: Out of memory\n", progname);
1200 /* If the name is an IP addr, try to resolve it. */
1204 if (4 == sscanf(name, " %d.%d.%d.%d %c",
1205 &iip[0], &iip[1], &iip[2], &iip[3], &c))
1207 unsigned char ip[4];
1209 ip[0] = iip[0]; ip[1] = iip[1]; ip[2] = iip[2]; ip[3] = iip[3];
1210 h = gethostbyaddr ((char *) ip, 4, AF_INET);
1211 if (h && h->h_name && *h->h_name)
1214 name = strdup (h->h_name);
1219 /* Create the new Bogie and add it to the list we are building */
1221 if ((new = newBogie(name, 0, si->current, si->TTL)) == NULL)
1226 /* Compute the round trip time */
1228 then = (struct timeval *) &packet[iphdrlen +
1229 sizeof(struct ICMP)];
1230 new->distance = delta(then, &now) / 100;
1231 if (new->distance == 0)
1232 new->distance = 2; /* HACK */
1245 * si - Sonar Information.
1246 * pi - Ping Information.
1249 * A list of hosts that replied to pings or null if there were none.
1253 ping(sonar_info *si, void *vpi)
1257 * This tries to distribute the targets evely around the field of the
1261 ping_info *pi = (ping_info *) vpi;
1262 static ping_target *ptr = NULL;
1264 int tick = si->current * -1 + 1;
1265 if ((ptr == NULL) && (tick == 1))
1268 if (pi->numtargets <= 90) {
1269 int xdrant = 90 / pi->numtargets;
1270 if ((tick % xdrant) == 0) {
1271 if (ptr != (ping_target *) 0) {
1277 } else if (pi->numtargets > 90) {
1278 if (ptr != (ping_target *) 0) {
1284 /* Get the results */
1286 return getping(si, pi);
1289 #endif /* HAVE_PING */
1292 * Calculate the difference between two timevals in microseconds.
1295 * then - The older timeval.
1296 * now - The newer timeval.
1299 * The difference between the two in microseconds.
1303 delta(struct timeval *then, struct timeval *now)
1305 return (((now->tv_sec - then->tv_sec) * 1000000) +
1306 (now->tv_usec - then->tv_usec));
1310 * Initialize the simulation mode.
1317 /* Local Variables */
1322 /* Create the simulation info structure */
1324 if ((si = (sim_info *) calloc(1, sizeof(sim_info))) == NULL) {
1325 fprintf(stderr, "%s: Out of memory\n", progname);
1331 si->numA = get_integer_resource("teamACount", "TeamACount");
1332 if ((si->teamA = (sim_target *)calloc(si->numA, sizeof(sim_target)))
1335 fprintf(stderr, "%s: Out of Memory\n", progname);
1338 si->teamAID = get_string_resource("teamAName", "TeamAName");
1339 for (i = 0; i < si->numA; i++) {
1340 if ((si->teamA[i].name = (char *) malloc(strlen(si->teamAID) + 4))
1343 fprintf(stderr, "%s: Out of Memory\n", progname);
1346 sprintf(si->teamA[i].name, "%s%03d", si->teamAID, i+1);
1347 si->teamA[i].nexttick = (int) (90.0 * random() / RAND_MAX);
1348 si->teamA[i].nextdist = (int) (100.0 * random() / RAND_MAX);
1349 si->teamA[i].movedonsweep = -1;
1354 si->numB = get_integer_resource("teamBCount", "TeamBCount");
1355 if ((si->teamB = (sim_target *)calloc(si->numB, sizeof(sim_target)))
1358 fprintf(stderr, "%s: Out of Memory\n", progname);
1361 si->teamBID = get_string_resource("teamBName", "TeamBName");
1362 for (i = 0; i < si->numB; i++) {
1363 if ((si->teamB[i].name = (char *) malloc(strlen(si->teamBID) + 4))
1366 fprintf(stderr, "%s: Out of Memory\n", progname);
1369 sprintf(si->teamB[i].name, "%s%03d", si->teamBID, i+1);
1370 si->teamB[i].nexttick = (int) (90.0 * random() / RAND_MAX);
1371 si->teamB[i].nextdist = (int) (100.0 * random() / RAND_MAX);
1372 si->teamB[i].movedonsweep = -1;
1381 * Initialize the Sonar.
1384 * dpy - The X display.
1385 * win - The X window;
1388 * A sonar_info strcuture or null if memory allocation problems occur.
1392 init_sonar(Display *dpy, Window win)
1395 /* Local Variables */
1398 XWindowAttributes xwa;
1402 double s1, s2, v1, v2;
1404 /* Create the Sonar information structure */
1406 if ((si = (sonar_info *) calloc(1, sizeof(sonar_info))) == NULL) {
1407 fprintf(stderr, "%s: Out of memory\n", progname);
1411 /* Initialize the structure for the current environment */
1416 XGetWindowAttributes(dpy, win, &xwa);
1417 si->cmap = xwa.colormap;
1418 si->width = xwa.width;
1419 si->height = xwa.height;
1420 si->centrex = si->width / 2;
1421 si->centrey = si->height / 2;
1422 si->maxx = si->centrex + MY_MIN(si->centrex, si->centrey) - 10;
1423 si->minx = si->centrex - MY_MIN(si->centrex, si->centrey) + 10;
1424 si->maxy = si->centrey + MY_MIN(si->centrex, si->centrey) - 10;
1425 si->miny = si->centrey - MY_MIN(si->centrex, si->centrey) + 10;
1426 si->radius = si->maxx - si->centrex;
1432 if (((si->font = XLoadQueryFont(dpy, get_string_resource ("font", "Font")))
1434 ((si->font = XLoadQueryFont(dpy, "fixed")) == NULL)) {
1435 fprintf(stderr, "%s: can't load an appropriate font\n", progname);
1439 /* Get the delay between animation frames */
1441 si->delay = get_integer_resource ("delay", "Integer");
1443 if (si->delay < 0) si->delay = 0;
1444 si->TTL = get_integer_resource("ttl", "TTL");
1446 /* Create the Graphics Contexts that will be used to draw things */
1449 get_pixel_resource ("sweepColor", "SweepColor", dpy, si->cmap);
1450 si->hi = XCreateGC(dpy, win, GCForeground, &gcv);
1451 gcv.font = si->font->fid;
1452 si->text = XCreateGC(dpy, win, GCForeground|GCFont, &gcv);
1453 gcv.foreground = get_pixel_resource("scopeColor", "ScopeColor",
1455 si->erase = XCreateGC (dpy, win, GCForeground, &gcv);
1456 gcv.foreground = get_pixel_resource("gridColor", "GridColor",
1458 si->grid = XCreateGC (dpy, win, GCForeground, &gcv);
1460 /* Compute pixel values for fading text on the display */
1462 XParseColor(dpy, si->cmap,
1463 get_string_resource("textColor", "TextColor"), &start);
1464 XParseColor(dpy, si->cmap,
1465 get_string_resource("scopeColor", "ScopeColor"), &end);
1467 rgb_to_hsv (start.red, start.green, start.blue, &h1, &s1, &v1);
1468 rgb_to_hsv (end.red, end.green, end.blue, &h2, &s2, &v2);
1470 si->text_steps = get_integer_resource("textSteps", "TextSteps");
1471 if (si->text_steps < 0 || si->text_steps > 255)
1472 si->text_steps = 10;
1474 si->text_colors = (XColor *) calloc(si->text_steps, sizeof(XColor));
1475 make_color_ramp (dpy, si->cmap,
1478 si->text_colors, &si->text_steps,
1479 False, True, False);
1481 /* Compute the pixel values for the fading sweep */
1483 XParseColor(dpy, si->cmap,
1484 get_string_resource("sweepColor", "SweepColor"), &start);
1486 rgb_to_hsv (start.red, start.green, start.blue, &h1, &s1, &v1);
1488 si->sweep_degrees = get_integer_resource("sweepDegrees", "Degrees");
1489 if (si->sweep_degrees <= 0) si->sweep_degrees = 20;
1490 if (si->sweep_degrees > 350) si->sweep_degrees = 350;
1492 si->sweep_segs = get_integer_resource("sweepSegments", "SweepSegments");
1493 if (si->sweep_segs < 1 || si->sweep_segs > 255)
1494 si->sweep_segs = 255;
1496 si->sweep_colors = (XColor *) calloc(si->sweep_segs, sizeof(XColor));
1497 make_color_ramp (dpy, si->cmap,
1500 si->sweep_colors, &si->sweep_segs,
1501 False, True, False);
1503 if (si->sweep_segs <= 0)
1512 * Update the location of a simulated bogie.
1516 updateLocation(sim_target *t)
1521 xtick = (int) (3.0 * random() / RAND_MAX) - 1;
1522 xdist = (int) (11.0 * random() / RAND_MAX) - 5;
1523 if (((t->nexttick + xtick) < 90) && ((t->nexttick + xtick) >= 0))
1524 t->nexttick += xtick;
1526 t->nexttick -= xtick;
1527 if (((t->nextdist + xdist) < 100) && ((t->nextdist+xdist) >= 0))
1528 t->nextdist += xdist;
1530 t->nextdist -= xdist;
1534 * The simulator. This uses information in the sim_info to simulate a bunch
1535 * of bogies flying around on the screen.
1539 * TODO: It would be cool to have the two teams chase each other around and
1544 simulator(sonar_info *si, void *vinfo)
1547 /* Local Variables */
1553 sim_info *info = (sim_info *) vinfo;
1557 for (i = 0; i < info->numA; i++) {
1558 t = &info->teamA[i];
1559 if ((t->movedonsweep != si->sweepnum) &&
1560 (t->nexttick == (si->current * -1))) {
1561 new = newBogie(strdup(t->name), t->nextdist, si->current, si->TTL);
1566 t->movedonsweep = si->sweepnum;
1572 for (i = 0; i < info->numB; i++) {
1573 t = &info->teamB[i];
1574 if ((t->movedonsweep != si->sweepnum) &&
1575 (t->nexttick == (si->current * -1))) {
1576 new = newBogie(strdup(t->name), t->nextdist, si->current, si->TTL);
1581 t->movedonsweep = si->sweepnum;
1591 * Compute the X coordinate of the label.
1594 * si - The sonar info block.
1595 * label - The label that will be drawn.
1596 * x - The x coordinate of the bogie.
1599 * The x coordinate of the start of the label.
1603 computeStringX(sonar_info *si, char *label, int x)
1606 int width = XTextWidth(si->font, label, strlen(label));
1607 return x - (width / 2);
1611 * Compute the Y coordinate of the label.
1614 * si - The sonar information.
1615 * y - The y coordinate of the bogie.
1618 * The y coordinate of the start of the label.
1621 /* TODO: Add smarts to keep label in sonar screen */
1624 computeStringY(sonar_info *si, int y)
1627 int fheight = si->font->ascent + si->font->descent;
1628 return y + 5 + fheight;
1632 * Draw a Bogie on the radar screen.
1635 * si - Sonar Information.
1636 * draw - A flag to indicate if the bogie should be drawn or erased.
1637 * name - The name of the bogie.
1638 * degrees - The number of degrees that it should apprear at.
1639 * distance - The distance the object is from the centre.
1640 * ttl - The time this bogie has to live.
1641 * age - The time this bogie has been around.
1645 DrawBogie(sonar_info *si, int draw, char *name, int degrees,
1646 int distance, int ttl, int age)
1649 /* Local Variables */
1653 int ox = si->centrex;
1654 int oy = si->centrey;
1657 /* Compute the coordinates of the object */
1660 distance = (log((double) distance) / 10.0) * si->radius;
1661 x = ox + ((double) distance * cos(4.0 * ((double) degrees)/57.29578));
1662 y = oy - ((double) distance * sin(4.0 * ((double) degrees)/57.29578));
1664 /* Set up the graphics context */
1668 /* Here we attempt to compute the distance into the total life of
1669 * object that we currently are. This distance is used against
1670 * the total lifetime to compute a fraction which is the index of
1671 * the color to draw the bogie.
1674 if (si->current <= degrees)
1675 delta = (si->current - degrees) * -1;
1677 delta = 90 + (degrees - si->current);
1678 delta += (age * 90);
1679 index = (si->text_steps - 1) * ((float) delta / (90.0 * (float) ttl));
1681 XSetForeground(si->dpy, gc, si->text_colors[index].pixel);
1686 /* Draw (or erase) the Bogie */
1688 XFillArc(si->dpy, si->win, gc, x, y, 5, 5, 0, 360 * 64);
1689 XDrawString(si->dpy, si->win, gc,
1690 computeStringX(si, name, x),
1691 computeStringY(si, y), name, strlen(name));
1696 * Draw the sonar grid.
1699 * si - Sonar information block.
1703 drawGrid(sonar_info *si)
1706 /* Local Variables */
1709 int width = si->maxx - si->minx;
1710 int height = si->maxy - si->miny;
1712 /* Draw the circles */
1714 XDrawArc(si->dpy, si->win, si->grid, si->minx - 10, si->miny - 10,
1715 width + 20, height + 20, 0, (360 * 64));
1717 XDrawArc(si->dpy, si->win, si->grid, si->minx, si->miny,
1718 width, height, 0, (360 * 64));
1720 XDrawArc(si->dpy, si->win, si->grid,
1721 (int) (si->minx + (.166 * width)),
1722 (int) (si->miny + (.166 * height)),
1723 (unsigned int) (.666 * width), (unsigned int)(.666 * height),
1726 XDrawArc(si->dpy, si->win, si->grid,
1727 (int) (si->minx + (.333 * width)),
1728 (int) (si->miny + (.333 * height)),
1729 (unsigned int) (.333 * width), (unsigned int) (.333 * height),
1732 /* Draw the radial lines */
1734 for (i = 0; i < 360; i += 10)
1736 XDrawLine(si->dpy, si->win, si->grid, si->centrex, si->centrey,
1737 (int) (si->centrex +
1738 (si->radius + 10) * (cos((double) i / 57.29578))),
1739 (int) (si->centrey -
1740 (si->radius + 10)*(sin((double) i / 57.29578))));
1742 XDrawLine(si->dpy, si->win, si->grid,
1743 (int) (si->centrex + si->radius *
1744 (cos((double) i / 57.29578))),
1745 (int) (si->centrey - si->radius *
1746 (sin((double) i / 57.29578))),
1747 (int) (si->centrex +
1748 (si->radius + 10) * (cos((double) i / 57.29578))),
1749 (int) (si->centrey -
1750 (si->radius + 10) * (sin((double) i / 57.29578))));
1754 * Update the Sonar scope.
1757 * si - The Sonar information.
1758 * bl - A list of bogies to add to the scope.
1762 Sonar(sonar_info *si, Bogie *bl)
1765 /* Local Variables */
1770 /* Check for expired tagets and remove them from the visable list */
1773 for (bp = si->visable; bp != NULL; bp = (bp ? bp->next : 0)) {
1776 * Remove it from the visable list if it's expired or we have
1777 * a new target with the same name.
1782 if (((bp->tick == si->current) && (++bp->age >= bp->ttl)) ||
1783 (findNode(bl, bp->name) != NULL)) {
1784 DrawBogie(si, 0, bp->name, bp->tick,
1785 bp->distance, bp->ttl, bp->age);
1787 si->visable = bp->next;
1789 prev->next = bp->next;
1796 /* Draw the sweep */
1799 int seg_deg = (si->sweep_degrees * 64) / si->sweep_segs;
1800 int start_deg = si->current * 4 * 64;
1801 if (seg_deg <= 0) seg_deg = 1;
1802 for (i = 0; i < si->sweep_segs; i++) {
1803 XSetForeground(si->dpy, si->hi, si->sweep_colors[i].pixel);
1804 XFillArc(si->dpy, si->win, si->hi, si->minx, si->miny,
1805 si->maxx - si->minx, si->maxy - si->miny,
1806 start_deg + (i * seg_deg),
1810 /* Remove the trailing wedge the sonar */
1811 XFillArc(si->dpy, si->win, si->erase, si->minx, si->miny,
1812 si->maxx - si->minx, si->maxy - si->miny,
1813 start_deg + (i * seg_deg),
1817 /* Move the new targets to the visable list */
1819 for (bp = bl; bp != (Bogie *) 0; bp = bl) {
1821 bp->next = si->visable;
1825 /* Draw the visable targets */
1827 for (bp = si->visable; bp != NULL; bp = bp->next) {
1828 if (bp->age < bp->ttl) /* grins */
1829 DrawBogie(si, 1, bp->name, bp->tick, bp->distance, bp->ttl,bp->age);
1832 /* Redraw the grid */
1838 static ping_target *
1839 parse_mode (Bool ping_works_p)
1841 char *source = get_string_resource ("ping", "Ping");
1844 ping_target *hostlist = 0;
1846 if (!source) source = strdup("");
1848 if (!*source || !strcmp (source, "default"))
1851 if (ping_works_p) /* if root or setuid, ping will work. */
1852 source = strdup("subnet/29,/etc/hosts");
1855 source = strdup("simulation");
1859 end = source + strlen(source);
1866 unsigned int n0=0, n1=0, n2=0, n3=0, m=0;
1868 # endif /* HAVE_PING */
1871 *next != ',' && *next != ' ' && *next != '\t' && *next != '\n';
1878 fprintf (stderr, "%s: parsing %s\n", progname, token);
1880 if (!strcmp (token, "simulation"))
1886 "%s: this program must be setuid to root for `ping mode' to work.\n"
1887 " Running in `simulation mode' instead.\n",
1893 if ((4 == sscanf (token, "%d.%d.%d/%d %c", &n0,&n1,&n2, &m,&d)) ||
1894 (5 == sscanf (token, "%d.%d.%d.%d/%d %c", &n0,&n1,&n2,&n3,&m,&d)))
1896 /* subnet: A.B.C.D/M
1899 unsigned long ip = (n0 << 24) | (n1 << 16) | (n2 << 8) | n3;
1900 new = subnetHostsList(ip, m);
1902 else if (4 == sscanf (token, "%d.%d.%d.%d %c", &n0, &n1, &n2, &n3, &d))
1906 new = newHost (token);
1908 else if (!strcmp (token, "subnet"))
1910 new = subnetHostsList(0, 24);
1912 else if (1 == sscanf (token, "subnet/%d %c", &m))
1914 new = subnetHostsList(0, m);
1916 else if (*token == '.' || *token == '/' || !stat (token, &st))
1920 new = readPingHostsFile (token);
1924 /* not an existant file - must be a host name
1926 new = newHost (token);
1931 ping_target *nn = new;
1932 while (nn && nn->next)
1934 nn->next = hostlist;
1939 #endif /* HAVE_PING */
1942 while (token < end &&
1943 (*token == ',' || *token == ' ' ||
1944 *token == '\t' || *token == '\n'))
1954 * Main screen saver hack.
1957 * dpy - The X display.
1958 * win - The X window.
1962 screenhack(Display *dpy, Window win)
1965 /* Local Variables */
1968 struct timeval start, finish;
1972 debug_p = get_boolean_resource ("debug", "Debug");
1976 sensor_info = (void *) init_ping();
1977 # else /* !HAVE_PING */
1979 parse_mode (0); /* just to check argument syntax */
1980 # endif /* !HAVE_PING */
1985 if ((sensor_info = (void *) init_sim()) == NULL)
1989 if ((si = init_sonar(dpy, win)) == (sonar_info *) 0)
1997 /* Call the sensor and display the results */
1999 gettimeofday(&start, (struct timezone *) 0);
2000 bl = sensor(si, sensor_info);
2003 /* Set up and sleep for the next one */
2005 si->current = (si->current - 1) % 90;
2006 if (si->current == 0)
2009 gettimeofday(&finish, (struct timezone *) 0);
2010 sleeptime = si->delay - delta(&start, &finish);
2011 screenhack_handle_events (dpy);