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 visible 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 *visible; /* List of visible 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 */
366 /* Allocate a bogie and initialize it */
368 if ((new = (Bogie *) calloc(1, sizeof(Bogie))) == NULL) {
369 fprintf(stderr, "%s: Out of Memory\n", progname);
373 new->distance = distance;
377 new->next = (Bogie *) 0;
385 * b - The bogie to free.
392 if (b->name != (char *) 0)
398 * Find a bogie by name in a list.
400 * This does a simple linear search of the list for a given name.
403 * bl - The Bogie list to search.
404 * name - The name to look for.
407 * The requested Bogie or null if it wasn't found.
411 findNode(Bogie *bl, char *name)
414 /* Local Variables */
418 /* Abort if the list is empty or no name is given */
420 if ((name == NULL) || (bl == NULL))
423 /* Search the list for the desired name */
427 if (strcmp(p->name, name) == 0)
439 /* Packs an IP address quad into bigendian network order. */
441 pack_addr (unsigned int a, unsigned int b, unsigned int c, unsigned int d)
443 unsigned long i = (((a & 255) << 24) |
450 /* Unpacks an IP address quad from bigendian network order. */
452 unpack_addr (unsigned long addr,
453 unsigned int *a, unsigned int *b,
454 unsigned int *c, unsigned int *d)
457 *a = (addr >> 24) & 255;
458 *b = (addr >> 16) & 255;
459 *c = (addr >> 8) & 255;
465 * Lookup the address for a ping target;
468 * target - The ping_target fill in the address for.
471 * 1 if the host was successfully resolved, 0 otherwise.
475 lookupHost(ping_target *target)
477 struct hostent *hent;
478 struct sockaddr_in *iaddr;
483 iaddr = (struct sockaddr_in *) &(target->address);
484 iaddr->sin_family = AF_INET;
486 if (4 == sscanf (target->name, " %u.%u.%u.%u %c",
487 &ip[0], &ip[1], &ip[2], &ip[3], &c))
489 /* It's an IP address.
494 fprintf (stderr, "%s: ignoring bogus IP %s\n",
495 progname, target->name);
499 iaddr->sin_addr.s_addr = pack_addr (ip[0], ip[1], ip[2], ip[3]);
500 hent = gethostbyaddr ((const char *) &iaddr->sin_addr.s_addr,
501 sizeof(iaddr->sin_addr.s_addr),
505 fprintf (stderr, "%s: %s => %s\n",
506 progname, target->name,
507 ((hent && hent->h_name && *hent->h_name)
508 ? hent->h_name : "<unknown>"));
510 if (hent && hent->h_name && *hent->h_name)
511 target->name = strdup (hent->h_name);
519 /* don't waste time being confused by non-hostname tokens
520 in .ssh/known_hosts */
521 if (!strcmp (target->name, "ssh-rsa") ||
522 !strcmp (target->name, "ssh-dsa") ||
523 !strcmp (target->name, "ssh-dss") ||
524 strlen (target->name) >= 80)
527 hent = gethostbyname (target->name);
530 fprintf (stderr, "%s: could not resolve host: %s\n",
531 progname, target->name);
535 memcpy (&iaddr->sin_addr, hent->h_addr_list[0],
536 sizeof(iaddr->sin_addr));
540 unsigned int a, b, c, d;
541 unpack_addr (iaddr->sin_addr.s_addr, &a, &b, &c, &d);
542 fprintf (stderr, "%s: %s => %d.%d.%d.%d\n",
543 progname, target->name, a, b, c, d);
551 print_host (FILE *out, unsigned long ip, const char *name)
554 unsigned int a, b, c, d;
555 unpack_addr (ip, &a, &b, &c, &d); /* ip is in network order */
556 sprintf (ips, "%u.%u.%u.%u", a, b, c, d);
557 if (!name || !*name) name = "<unknown>";
558 fprintf (out, "%-16s %s\n", ips, name);
563 * Create a target for a host.
566 * name - The name of the host.
569 * A newly allocated target or null if the host could not be resolved.
576 /* Local Variables */
578 ping_target *target = NULL;
580 /* Create the target */
582 if ((target = calloc(1, sizeof(ping_target))) == NULL) {
583 fprintf(stderr, "%s: Out of Memory\n", progname);
584 goto target_init_error;
586 if ((target->name = strdup(name)) == NULL) {
587 fprintf(stderr, "%s: Out of Memory\n", progname);
588 goto target_init_error;
591 /* Lookup the host */
593 if (! lookupHost(target))
594 goto target_init_error;
596 /* Don't ever use loopback (127.0.0.x) hosts */
598 struct sockaddr_in *iaddr = (struct sockaddr_in *) &(target->address);
599 unsigned long ip = iaddr->sin_addr.s_addr;
601 if ((ntohl (ip) & 0xFFFFFF00L) == 0x7f000000L) /* 127.0.0 */
604 fprintf (stderr, "%s: ignoring loopback host %s\n",
605 progname, target->name);
606 goto target_init_error;
614 struct sockaddr_in *iaddr = (struct sockaddr_in *) &(target->address);
615 unsigned long ip = iaddr->sin_addr.s_addr;
616 fprintf (stderr, "%s: added ", progname);
617 print_host (stderr, ip, target->name);
622 /* Handle errors here */
631 * Generate a list of ping targets from the entries in a file.
634 * fname - The name of the file. This file is expected to be in the same
635 * format as /etc/hosts.
638 * A list of targets to ping or null if an error occured.
642 readPingHostsFile(char *fname)
644 /* Local Variables */
649 ping_target *list = NULL;
653 /* Make sure we in fact have a file to process */
655 if ((fname == NULL) || (fname[0] == '\0')) {
656 fprintf(stderr, "%s: invalid ping host file name\n", progname);
662 if ((fp = fopen(fname, "r")) == NULL) {
664 sprintf(msg, "%s: unable to open host file %s", progname, fname);
670 fprintf (stderr, "%s: reading file %s\n", progname, fname);
672 /* Read the file line by line */
674 while ((p = fgets(buf, LINE_MAX, fp)) != NULL) {
677 * Parse the line skipping those that start with '#'.
678 * The rest of the lines in the file should be in the same
679 * format as a /etc/hosts file. We are only concerned with
680 * the first two field, the IP address and the name
683 while ((*p == ' ') || (*p == '\t'))
688 /* Get the name and address */
691 if ((addr = strtok(buf, " ,;\t\n")) != NULL)
692 name = strtok(NULL, " ,;\t\n");
696 /* Check to see if the addr looks like an addr. If not, assume
697 the addr is a name and there is no addr. This way, we can
698 handle files whose lines have "xx.xx.xx.xx hostname" as their
699 first two tokens, and also files that have a hostname as their
700 first token (like .ssh/known_hosts and .rhosts.)
704 if (4 != sscanf(addr, "%d.%d.%d.%d%c", &i, &i, &i, &i, &c))
711 /* If the name is all digits, it's not a name. */
715 for (s = name; *s; s++)
716 if (*s < '0' || *s > '9')
721 fprintf (stderr, "%s: skipping bogus name \"%s\" (%s)\n",
722 progname, name, addr);
727 /* Create a new target using first the name then the address */
732 if (new == NULL && addr != NULL)
735 /* Add it to the list if we got one */
743 /* Close the file and return the list */
751 delete_duplicate_hosts (ping_target *list)
753 ping_target *head = list;
756 for (rest = head; rest; rest = rest->next)
758 struct sockaddr_in *i1 = (struct sockaddr_in *) &(rest->address);
759 unsigned long ip1 = i1->sin_addr.s_addr;
761 static ping_target *rest2;
762 for (rest2 = rest; rest2; rest2 = rest2->next)
764 if (rest2 && rest2->next)
766 struct sockaddr_in *i2 = (struct sockaddr_in *)
767 &(rest2->next->address);
768 unsigned long ip2 = i2->sin_addr.s_addr;
774 fprintf (stderr, "%s: deleted duplicate: ", progname);
775 print_host (stderr, ip2, rest2->next->name);
777 rest2->next = rest2->next->next;
790 * Generate a list ping targets consisting of all of the entries on
791 * the same subnet. 'base' ip is in network order; 0 means localhost.
794 * A list of all of the hosts on this net.
798 subnetHostsList(unsigned long n_base, int subnet_width)
800 unsigned long h_mask; /* host order */
801 unsigned long h_base; /* host order */
803 /* Local Variables */
805 char hostname[BUFSIZ];
806 char address[BUFSIZ];
807 struct hostent *hent;
811 ping_target *list = NULL;
813 if (subnet_width < 24)
816 "%s: pinging %lu hosts is a bad idea; please use a subnet mask of 24 bits\n"
817 " or more (255 hosts max.)\n",
818 progname, (unsigned long) (1L << (32 - subnet_width)) - 1);
821 else if (subnet_width > 30)
823 fprintf (stderr, "%s: a subnet of %d bits doesn't make sense:"
824 " try \"subnet/24\" or \"subnet/29\".\n",
825 progname, subnet_width);
831 fprintf (stderr, "%s: adding %d-bit subnet\n", progname, subnet_width);
833 /* Get our hostname */
835 if (gethostname(hostname, BUFSIZ)) {
836 fprintf(stderr, "%s: unable to get local hostname\n", progname);
840 /* Get our IP address and convert it to a string */
842 if ((hent = gethostbyname(hostname)) == NULL) {
843 fprintf(stderr, "%s: unable to lookup our IP address\n", progname);
846 strcpy(address, inet_ntoa(*((struct in_addr *)hent->h_addr_list[0])));
848 /* Construct targets for all addresses in this subnet */
851 for (i = 0; i < subnet_width; i++)
852 h_mask |= (1L << (31-i));
854 /* If no base IP specified, assume localhost. */
856 n_base = pack_addr (hent->h_addr_list[0][0],
857 hent->h_addr_list[0][1],
858 hent->h_addr_list[0][2],
859 hent->h_addr_list[0][3]);
860 h_base = ntohl (n_base);
862 if (h_base == 0x7F000001L) /* 127.0.0.1 in host order */
864 unsigned int a, b, c, d;
865 unpack_addr (n_base, &a, &b, &c, &d);
867 "%s: unable to determine local subnet address: \"%s\"\n"
868 " resolves to loopback address %u.%u.%u.%u.\n",
869 progname, hostname, a, b, c, d);
873 for (i = 255; i >= 0; i--) {
874 unsigned int a, b, c, d;
875 int ip = (h_base & 0xFFFFFF00L) | i; /* host order */
877 if ((ip & h_mask) != (h_base & h_mask)) /* not in mask range at all */
879 if ((ip & ~h_mask) == 0) /* broadcast address */
881 if ((ip & ~h_mask) == ~h_mask) /* broadcast address */
884 unpack_addr (htonl (ip), &a, &b, &c, &d);
885 sprintf (address, "%u.%u.%u.%u", a, b, c, d);
889 unsigned int aa, ab, ac, ad;
890 unsigned int ma, mb, mc, md;
891 unpack_addr (htonl (h_base & h_mask), &aa, &ab, &ac, &ad);
892 unpack_addr (htonl (h_mask), &ma, &mb, &mc, &md);
894 "%s: subnet: %s (%u.%u.%u.%u & %u.%u.%u.%u / %d)\n",
901 p = address + strlen(address) + 1;
904 new = newHost(address);
917 * Initialize the ping sensor.
920 * A newly allocated ping_info structure or null if an error occured.
923 static ping_target *parse_mode (Bool ping_works_p);
929 Bool socket_initted_p = False;
931 /* Local Variables */
933 ping_info *pi = NULL; /* The new ping_info struct */
934 ping_target *pt; /* Used to count the targets */
936 /* Create the ping info structure */
938 if ((pi = (ping_info *) calloc(1, sizeof(ping_info))) == NULL) {
939 fprintf(stderr, "%s: Out of memory\n", progname);
940 goto ping_init_error;
943 /* Create the ICMP socket */
945 if ((pi->icmpsock = socket(AF_INET, SOCK_RAW, IPPROTO_ICMP)) >= 0) {
946 socket_initted_p = True;
954 pi->pid = getpid() & 0xFFFF;
956 pi->timeout = get_integer_resource("pingTimeout", "PingTimeout");
958 /* Generate a list of targets */
960 pi->targets = parse_mode (socket_initted_p);
961 pi->targets = delete_duplicate_hosts (pi->targets);
967 fprintf (stderr, "%s: Target list:\n", progname);
968 for (t = pi->targets; t; t = t->next)
970 struct sockaddr_in *iaddr = (struct sockaddr_in *) &(t->address);
971 unsigned long ip = iaddr->sin_addr.s_addr;
972 fprintf (stderr, "%s: ", progname);
973 print_host (stderr, ip, t->name);
977 /* Make sure there is something to ping */
979 if (pi->targets == NULL) {
980 goto ping_init_error;
983 /* Count the targets */
996 /* Handle initialization errors here */
1009 * pi - The ping information strcuture.
1010 * host - The name or IP address of the host to ping (in ascii).
1014 sendping(ping_info *pi, ping_target *pt)
1017 /* Local Variables */
1024 * Note, we will send the character name of the host that we are
1025 * pinging in the packet so that we don't have to keep track of the
1026 * name or do an address lookup when it comes back.
1029 int pcktsiz = sizeof(struct ICMP) + sizeof(struct timeval) +
1030 strlen(pt->name) + 1;
1032 /* Create the ICMP packet */
1034 if ((packet = (u_char *) malloc(pcktsiz)) == (void *) 0)
1035 return; /* Out of memory */
1036 icmph = (struct ICMP *) packet;
1037 ICMP_TYPE(icmph) = ICMP_ECHO;
1038 ICMP_CODE(icmph) = 0;
1039 ICMP_CHECKSUM(icmph) = 0;
1040 ICMP_ID(icmph) = pi->pid;
1041 ICMP_SEQ(icmph) = pi->seq++;
1042 # ifdef GETTIMEOFDAY_TWO_ARGS
1043 gettimeofday((struct timeval *) &packet[sizeof(struct ICMP)],
1044 (struct timezone *) 0);
1046 gettimeofday((struct timeval *) &packet[sizeof(struct ICMP)]);
1049 strcpy((char *) &packet[sizeof(struct ICMP) + sizeof(struct timeval)],
1051 ICMP_CHECKSUM(icmph) = checksum((u_short *)packet, pcktsiz);
1055 if ((result = sendto(pi->icmpsock, packet, pcktsiz, 0,
1056 &pt->address, sizeof(pt->address))) != pcktsiz) {
1058 char errbuf[BUFSIZ];
1059 sprintf(errbuf, "%s: error sending ping to %s", progname, pt->name);
1066 * Catch a signal and do nothing.
1069 * sig - The signal that was caught.
1079 * Compute the checksum on a ping packet.
1082 * packet - A pointer to the packet to compute the checksum for.
1083 * size - The size of the packet.
1086 * The computed checksum
1091 checksum(u_short *packet, int size)
1094 /* Local Variables */
1096 register int nleft = size;
1097 register u_short *w = packet;
1098 register int sum = 0;
1102 * Our algorithm is simple, using a 32 bit accumulator (sum), we add
1103 * sequential 16 bit words to it, and at the end, fold back all the
1104 * carry bits from the top 16 bits into the lower 16 bits.
1112 /* mop up an odd byte, if necessary */
1115 *(u_char *)(&answer) = *(u_char *)w ;
1116 *(1 + (u_char *)(&answer)) = 0;
1120 /* add back carry outs from top 16 bits to low 16 bits */
1122 sum = (sum >> 16) + (sum & 0xffff); /* add hi 16 to low 16 */
1123 sum += (sum >> 16); /* add carry */
1124 answer = ~sum; /* truncate to 16 bits */
1132 * Look for ping replies.
1134 * Retrieve all outstanding ping replies.
1137 * si - Information about the sonar.
1138 * pi - Ping information.
1139 * ttl - The time each bogie is to live on the screen
1142 * A Bogie list of all the machines that replied.
1146 getping(sonar_info *si, ping_info *pi)
1149 /* Local Variables */
1151 struct sockaddr from;
1152 unsigned int fromlen; /* Posix says socklen_t, but that's not portable */
1154 u_char packet[1024];
1156 struct timeval *then;
1163 struct sigaction sa;
1164 struct itimerval it;
1168 /* Set up a signal to interupt our wait for a packet */
1170 sigemptyset(&sa.sa_mask);
1172 sa.sa_handler = sigcatcher;
1173 if (sigaction(SIGALRM, &sa, 0) == -1) {
1175 sprintf(msg, "%s: unable to trap SIGALRM", progname);
1180 /* Set up a timer to interupt us if we don't get a packet */
1182 it.it_interval.tv_sec = 0;
1183 it.it_interval.tv_usec = 0;
1184 it.it_value.tv_sec = 0;
1185 it.it_value.tv_usec = pi->timeout;
1187 setitimer(ITIMER_REAL, &it, NULL);
1189 /* Wait for a result packet */
1191 fromlen = sizeof(from);
1192 while (! timer_expired) {
1193 tv.tv_usec=pi->timeout;
1196 /* This breaks on BSD, which uses bzero() in the definition of FD_ZERO */
1199 memset (&rfds, 0, sizeof(rfds));
1201 FD_SET(pi->icmpsock,&rfds);
1202 /* only wait a little while, in case we raced with the timer expiration.
1203 From Valentijn Sessink <valentyn@openoffice.nl> */
1204 if (select(pi->icmpsock+1, &rfds, NULL, NULL, &tv) >0) {
1205 result = recvfrom(pi->icmpsock, packet, sizeof(packet),
1206 0, &from, &fromlen);
1208 /* Check the packet */
1210 # ifdef GETTIMEOFDAY_TWO_ARGS
1211 gettimeofday(&now, (struct timezone *) 0);
1215 ip = (struct ip *) packet;
1216 iphdrlen = IP_HDRLEN(ip) << 2;
1217 icmph = (struct ICMP *) &packet[iphdrlen];
1219 /* Was the packet a reply?? */
1221 if (ICMP_TYPE(icmph) != ICMP_ECHOREPLY) {
1222 /* Ignore anything but ICMP Replies */
1223 continue; /* Nope */
1226 /* Was it for us? */
1228 if (ICMP_ID(icmph) != pi->pid) {
1229 /* Ignore packets not set from us */
1230 continue; /* Nope */
1233 /* Copy the name of the bogie */
1236 strdup((char *) &packet[iphdrlen +
1237 + sizeof(struct ICMP)
1238 + sizeof(struct timeval)])) == NULL) {
1239 fprintf(stderr, "%s: Out of memory\n", progname);
1243 /* If the name is an IP addr, try to resolve it. */
1247 if (4 == sscanf(name, " %d.%d.%d.%d %c",
1248 &iip[0], &iip[1], &iip[2], &iip[3], &c))
1250 struct sockaddr_in iaddr;
1252 iaddr.sin_addr.s_addr = pack_addr (iip[0],iip[1],iip[2],iip[3]);
1253 h = gethostbyaddr ((const char *) &iaddr.sin_addr.s_addr,
1254 sizeof(iaddr.sin_addr.s_addr),
1257 if (h && h->h_name && *h->h_name)
1260 name = strdup (h->h_name);
1265 /* Create the new Bogie and add it to the list we are building */
1267 if ((new = newBogie(name, 0, si->current, si->TTL)) == NULL)
1272 /* Compute the round trip time */
1274 then = (struct timeval *) &packet[iphdrlen +
1275 sizeof(struct ICMP)];
1276 new->distance = delta(then, &now) / 100;
1277 if (new->distance == 0)
1278 new->distance = 2; /* HACK */
1291 * si - Sonar Information.
1292 * pi - Ping Information.
1295 * A list of hosts that replied to pings or null if there were none.
1299 ping(sonar_info *si, void *vpi)
1303 * This tries to distribute the targets evely around the field of the
1307 ping_info *pi = (ping_info *) vpi;
1308 static ping_target *ptr = NULL;
1310 int tick = si->current * -1 + 1;
1311 if ((ptr == NULL) && (tick == 1))
1314 if (pi->numtargets <= 90) {
1315 int xdrant = 90 / pi->numtargets;
1316 if ((tick % xdrant) == 0) {
1317 if (ptr != (ping_target *) 0) {
1323 } else if (pi->numtargets > 90) {
1324 if (ptr != (ping_target *) 0) {
1330 /* Get the results */
1332 return getping(si, pi);
1335 #endif /* HAVE_PING */
1338 * Calculate the difference between two timevals in microseconds.
1341 * then - The older timeval.
1342 * now - The newer timeval.
1345 * The difference between the two in microseconds.
1349 delta(struct timeval *then, struct timeval *now)
1351 return (((now->tv_sec - then->tv_sec) * 1000000) +
1352 (now->tv_usec - then->tv_usec));
1356 * Initialize the simulation mode.
1363 /* Local Variables */
1368 /* Create the simulation info structure */
1370 if ((si = (sim_info *) calloc(1, sizeof(sim_info))) == NULL) {
1371 fprintf(stderr, "%s: Out of memory\n", progname);
1377 si->numA = get_integer_resource("teamACount", "TeamACount");
1378 if ((si->teamA = (sim_target *)calloc(si->numA, sizeof(sim_target)))
1381 fprintf(stderr, "%s: Out of Memory\n", progname);
1384 si->teamAID = get_string_resource("teamAName", "TeamAName");
1385 for (i = 0; i < si->numA; i++) {
1386 if ((si->teamA[i].name = (char *) malloc(strlen(si->teamAID) + 4))
1389 fprintf(stderr, "%s: Out of Memory\n", progname);
1392 sprintf(si->teamA[i].name, "%s%03d", si->teamAID, i+1);
1393 si->teamA[i].nexttick = random() % 90;
1394 si->teamA[i].nextdist = random() % 100;
1395 si->teamA[i].movedonsweep = -1;
1400 si->numB = get_integer_resource("teamBCount", "TeamBCount");
1401 if ((si->teamB = (sim_target *)calloc(si->numB, sizeof(sim_target)))
1404 fprintf(stderr, "%s: Out of Memory\n", progname);
1407 si->teamBID = get_string_resource("teamBName", "TeamBName");
1408 for (i = 0; i < si->numB; i++) {
1409 if ((si->teamB[i].name = (char *) malloc(strlen(si->teamBID) + 4))
1412 fprintf(stderr, "%s: Out of Memory\n", progname);
1415 sprintf(si->teamB[i].name, "%s%03d", si->teamBID, i+1);
1416 si->teamB[i].nexttick = random() % 90;
1417 si->teamB[i].nextdist = random() % 100;
1418 si->teamB[i].movedonsweep = -1;
1427 * Creates and returns a drawing mask for the scope:
1428 * mask out anything outside of the disc.
1431 scope_mask (Display *dpy, Window win, sonar_info *si)
1434 Pixmap mask = XCreatePixmap(dpy, win, si->width, si->height, 1);
1435 GC gc = XCreateGC (dpy, mask, 0, &gcv);
1436 XSetFunction (dpy, gc, GXclear);
1437 XFillRectangle (dpy, mask, gc, 0, 0, si->width, si->height);
1438 XSetFunction (dpy, gc, GXset);
1439 XFillArc(dpy, mask, gc, si->minx, si->miny,
1440 si->maxx - si->minx, si->maxy - si->miny,
1447 * Initialize the Sonar.
1450 * dpy - The X display.
1451 * win - The X window;
1454 * A sonar_info strcuture or null if memory allocation problems occur.
1458 init_sonar(Display *dpy, Window win)
1461 /* Local Variables */
1464 XWindowAttributes xwa;
1468 double s1, s2, v1, v2;
1470 /* Create the Sonar information structure */
1472 if ((si = (sonar_info *) calloc(1, sizeof(sonar_info))) == NULL) {
1473 fprintf(stderr, "%s: Out of memory\n", progname);
1477 /* Initialize the structure for the current environment */
1482 XGetWindowAttributes(dpy, win, &xwa);
1483 si->cmap = xwa.colormap;
1484 si->width = xwa.width;
1485 si->height = xwa.height;
1486 si->centrex = si->width / 2;
1487 si->centrey = si->height / 2;
1488 si->maxx = si->centrex + MY_MIN(si->centrex, si->centrey) - 10;
1489 si->minx = si->centrex - MY_MIN(si->centrex, si->centrey) + 10;
1490 si->maxy = si->centrey + MY_MIN(si->centrex, si->centrey) - 10;
1491 si->miny = si->centrey - MY_MIN(si->centrex, si->centrey) + 10;
1492 si->radius = si->maxx - si->centrex;
1498 if (((si->font = XLoadQueryFont(dpy, get_string_resource ("font", "Font")))
1500 ((si->font = XLoadQueryFont(dpy, "fixed")) == NULL)) {
1501 fprintf(stderr, "%s: can't load an appropriate font\n", progname);
1505 /* Get the delay between animation frames */
1507 si->delay = get_integer_resource ("delay", "Integer");
1509 if (si->delay < 0) si->delay = 0;
1510 si->TTL = get_integer_resource("ttl", "TTL");
1512 /* Create the Graphics Contexts that will be used to draw things */
1515 get_pixel_resource ("sweepColor", "SweepColor", dpy, si->cmap);
1516 si->hi = XCreateGC(dpy, win, GCForeground, &gcv);
1517 gcv.font = si->font->fid;
1518 si->text = XCreateGC(dpy, win, GCForeground|GCFont, &gcv);
1519 gcv.foreground = get_pixel_resource("scopeColor", "ScopeColor",
1521 si->erase = XCreateGC (dpy, win, GCForeground, &gcv);
1522 gcv.foreground = get_pixel_resource("gridColor", "GridColor",
1524 si->grid = XCreateGC (dpy, win, GCForeground, &gcv);
1526 /* Install the clip mask... */
1528 Pixmap mask = scope_mask (dpy, win, si);
1529 XSetClipMask(dpy, si->text, mask);
1530 XSetClipMask(dpy, si->erase, mask);
1531 XFreePixmap (dpy, mask); /* it's been copied into the GCs */
1534 /* Compute pixel values for fading text on the display */
1536 XParseColor(dpy, si->cmap,
1537 get_string_resource("textColor", "TextColor"), &start);
1538 XParseColor(dpy, si->cmap,
1539 get_string_resource("scopeColor", "ScopeColor"), &end);
1541 rgb_to_hsv (start.red, start.green, start.blue, &h1, &s1, &v1);
1542 rgb_to_hsv (end.red, end.green, end.blue, &h2, &s2, &v2);
1544 si->text_steps = get_integer_resource("textSteps", "TextSteps");
1545 if (si->text_steps < 0 || si->text_steps > 255)
1546 si->text_steps = 10;
1548 si->text_colors = (XColor *) calloc(si->text_steps, sizeof(XColor));
1549 make_color_ramp (dpy, si->cmap,
1552 si->text_colors, &si->text_steps,
1553 False, True, False);
1555 /* Compute the pixel values for the fading sweep */
1557 XParseColor(dpy, si->cmap,
1558 get_string_resource("sweepColor", "SweepColor"), &start);
1560 rgb_to_hsv (start.red, start.green, start.blue, &h1, &s1, &v1);
1562 si->sweep_degrees = get_integer_resource("sweepDegrees", "Degrees");
1563 if (si->sweep_degrees <= 0) si->sweep_degrees = 20;
1564 if (si->sweep_degrees > 350) si->sweep_degrees = 350;
1566 si->sweep_segs = get_integer_resource("sweepSegments", "SweepSegments");
1567 if (si->sweep_segs < 1 || si->sweep_segs > 255)
1568 si->sweep_segs = 255;
1570 si->sweep_colors = (XColor *) calloc(si->sweep_segs, sizeof(XColor));
1571 make_color_ramp (dpy, si->cmap,
1574 si->sweep_colors, &si->sweep_segs,
1575 False, True, False);
1577 if (si->sweep_segs <= 0)
1586 * Update the location of a simulated bogie.
1590 updateLocation(sim_target *t)
1595 xtick = (int) (random() % 3) - 1;
1596 xdist = (int) (random() % 11) - 5;
1597 if (((t->nexttick + xtick) < 90) && ((t->nexttick + xtick) >= 0))
1598 t->nexttick += xtick;
1600 t->nexttick -= xtick;
1601 if (((t->nextdist + xdist) < 100) && ((t->nextdist+xdist) >= 0))
1602 t->nextdist += xdist;
1604 t->nextdist -= xdist;
1608 * The simulator. This uses information in the sim_info to simulate a bunch
1609 * of bogies flying around on the screen.
1613 * TODO: It would be cool to have the two teams chase each other around and
1618 simulator(sonar_info *si, void *vinfo)
1621 /* Local Variables */
1627 sim_info *info = (sim_info *) vinfo;
1631 for (i = 0; i < info->numA; i++) {
1632 t = &info->teamA[i];
1633 if ((t->movedonsweep != si->sweepnum) &&
1634 (t->nexttick == (si->current * -1))) {
1635 new = newBogie(strdup(t->name), t->nextdist, si->current, si->TTL);
1640 t->movedonsweep = si->sweepnum;
1646 for (i = 0; i < info->numB; i++) {
1647 t = &info->teamB[i];
1648 if ((t->movedonsweep != si->sweepnum) &&
1649 (t->nexttick == (si->current * -1))) {
1650 new = newBogie(strdup(t->name), t->nextdist, si->current, si->TTL);
1655 t->movedonsweep = si->sweepnum;
1665 * Compute the X coordinate of the label.
1668 * si - The sonar info block.
1669 * label - The label that will be drawn.
1670 * x - The x coordinate of the bogie.
1673 * The x coordinate of the start of the label.
1677 computeStringX(sonar_info *si, char *label, int x)
1680 int width = XTextWidth(si->font, label, strlen(label));
1681 return x - (width / 2);
1685 * Compute the Y coordinate of the label.
1688 * si - The sonar information.
1689 * y - The y coordinate of the bogie.
1692 * The y coordinate of the start of the label.
1695 /* TODO: Add smarts to keep label in sonar screen */
1698 computeStringY(sonar_info *si, int y)
1701 int fheight = si->font->ascent + si->font->descent;
1702 return y + 5 + fheight;
1706 * Draw a Bogie on the radar screen.
1709 * si - Sonar Information.
1710 * draw - A flag to indicate if the bogie should be drawn or erased.
1711 * name - The name of the bogie.
1712 * degrees - The number of degrees that it should apprear at.
1713 * distance - The distance the object is from the centre.
1714 * ttl - The time this bogie has to live.
1715 * age - The time this bogie has been around.
1719 DrawBogie(sonar_info *si, int draw, char *name, int degrees,
1720 int distance, int ttl, int age)
1723 /* Local Variables */
1727 int ox = si->centrex;
1728 int oy = si->centrey;
1731 /* Compute the coordinates of the object */
1734 distance = (log((double) distance) / 10.0) * si->radius;
1735 x = ox + ((double) distance * cos(4.0 * ((double) degrees)/57.29578));
1736 y = oy - ((double) distance * sin(4.0 * ((double) degrees)/57.29578));
1738 /* Set up the graphics context */
1742 /* Here we attempt to compute the distance into the total life of
1743 * object that we currently are. This distance is used against
1744 * the total lifetime to compute a fraction which is the index of
1745 * the color to draw the bogie.
1748 if (si->current <= degrees)
1749 delta = (si->current - degrees) * -1;
1751 delta = 90 + (degrees - si->current);
1752 delta += (age * 90);
1753 index = (si->text_steps - 1) * ((float) delta / (90.0 * (float) ttl));
1755 XSetForeground(si->dpy, gc, si->text_colors[index].pixel);
1760 /* Draw (or erase) the Bogie */
1762 XFillArc(si->dpy, si->win, gc, x, y, 5, 5, 0, 360 * 64);
1763 XDrawString(si->dpy, si->win, gc,
1764 computeStringX(si, name, x),
1765 computeStringY(si, y), name, strlen(name));
1770 * Draw the sonar grid.
1773 * si - Sonar information block.
1777 drawGrid(sonar_info *si)
1780 /* Local Variables */
1783 int width = si->maxx - si->minx;
1784 int height = si->maxy - si->miny;
1786 /* Draw the circles */
1788 XDrawArc(si->dpy, si->win, si->grid, si->minx - 10, si->miny - 10,
1789 width + 20, height + 20, 0, (360 * 64));
1791 XDrawArc(si->dpy, si->win, si->grid, si->minx, si->miny,
1792 width, height, 0, (360 * 64));
1794 XDrawArc(si->dpy, si->win, si->grid,
1795 (int) (si->minx + (.166 * width)),
1796 (int) (si->miny + (.166 * height)),
1797 (unsigned int) (.666 * width), (unsigned int)(.666 * height),
1800 XDrawArc(si->dpy, si->win, si->grid,
1801 (int) (si->minx + (.333 * width)),
1802 (int) (si->miny + (.333 * height)),
1803 (unsigned int) (.333 * width), (unsigned int) (.333 * height),
1806 /* Draw the radial lines */
1808 for (i = 0; i < 360; i += 10)
1810 XDrawLine(si->dpy, si->win, si->grid, si->centrex, si->centrey,
1811 (int) (si->centrex +
1812 (si->radius + 10) * (cos((double) i / 57.29578))),
1813 (int) (si->centrey -
1814 (si->radius + 10)*(sin((double) i / 57.29578))));
1816 XDrawLine(si->dpy, si->win, si->grid,
1817 (int) (si->centrex + si->radius *
1818 (cos((double) i / 57.29578))),
1819 (int) (si->centrey - si->radius *
1820 (sin((double) i / 57.29578))),
1821 (int) (si->centrex +
1822 (si->radius + 10) * (cos((double) i / 57.29578))),
1823 (int) (si->centrey -
1824 (si->radius + 10) * (sin((double) i / 57.29578))));
1828 * Update the Sonar scope.
1831 * si - The Sonar information.
1832 * bl - A list of bogies to add to the scope.
1836 Sonar(sonar_info *si, Bogie *bl)
1839 /* Local Variables */
1844 /* Check for expired tagets and remove them from the visible list */
1847 for (bp = si->visible; bp != NULL; bp = (bp ? bp->next : 0)) {
1850 * Remove it from the visible list if it's expired or we have
1851 * a new target with the same name.
1856 if (((bp->tick == si->current) && (++bp->age >= bp->ttl)) ||
1857 (findNode(bl, bp->name) != NULL)) {
1858 DrawBogie(si, 0, bp->name, bp->tick,
1859 bp->distance, bp->ttl, bp->age);
1861 si->visible = bp->next;
1863 prev->next = bp->next;
1870 /* Draw the sweep */
1873 int seg_deg = (si->sweep_degrees * 64) / si->sweep_segs;
1874 int start_deg = si->current * 4 * 64;
1875 if (seg_deg <= 0) seg_deg = 1;
1876 for (i = 0; i < si->sweep_segs; i++) {
1877 XSetForeground(si->dpy, si->hi, si->sweep_colors[i].pixel);
1878 XFillArc(si->dpy, si->win, si->hi, si->minx, si->miny,
1879 si->maxx - si->minx, si->maxy - si->miny,
1880 start_deg + (i * seg_deg),
1884 /* Remove the trailing wedge the sonar */
1885 XFillArc(si->dpy, si->win, si->erase, si->minx, si->miny,
1886 si->maxx - si->minx, si->maxy - si->miny,
1887 start_deg + (i * seg_deg),
1891 /* Move the new targets to the visible list */
1893 for (bp = bl; bp != (Bogie *) 0; bp = bl) {
1895 bp->next = si->visible;
1899 /* Draw the visible targets */
1901 for (bp = si->visible; bp != NULL; bp = bp->next) {
1902 if (bp->age < bp->ttl) /* grins */
1903 DrawBogie(si, 1, bp->name, bp->tick, bp->distance, bp->ttl,bp->age);
1906 /* Redraw the grid */
1912 static ping_target *
1913 parse_mode (Bool ping_works_p)
1915 char *source = get_string_resource ("ping", "Ping");
1919 ping_target *hostlist = 0;
1921 if (!source) source = strdup("");
1923 if (!*source || !strcmp (source, "default"))
1926 if (ping_works_p) /* if root or setuid, ping will work. */
1927 source = strdup("subnet/29,/etc/hosts");
1930 source = strdup("simulation");
1934 end = source + strlen(source);
1941 unsigned int n0=0, n1=0, n2=0, n3=0, m=0;
1943 # endif /* HAVE_PING */
1947 *next != ',' && *next != ' ' && *next != '\t' && *next != '\n';
1954 fprintf (stderr, "%s: parsing %s\n", progname, token);
1956 if (!strcmp (token, "simulation"))
1962 "%s: this program must be setuid to root for `ping mode' to work.\n"
1963 " Running in `simulation mode' instead.\n",
1969 if ((4 == sscanf (token, "%u.%u.%u/%u %c", &n0,&n1,&n2, &m,&d)) ||
1970 (5 == sscanf (token, "%u.%u.%u.%u/%u %c", &n0,&n1,&n2,&n3,&m,&d)))
1972 /* subnet: A.B.C.D/M
1975 unsigned long ip = pack_addr (n0, n1, n2, n3);
1976 new = subnetHostsList(ip, m);
1978 else if (4 == sscanf (token, "%u.%u.%u.%u %c", &n0, &n1, &n2, &n3, &d))
1982 new = newHost (token);
1984 else if (!strcmp (token, "subnet"))
1986 new = subnetHostsList(0, 24);
1988 else if (1 == sscanf (token, "subnet/%u %c", &m, &dummy))
1990 new = subnetHostsList(0, m);
1992 else if (*token == '.' || *token == '/' || !stat (token, &st))
1996 new = readPingHostsFile (token);
2000 /* not an existant file - must be a host name
2002 new = newHost (token);
2007 ping_target *nn = new;
2008 while (nn && nn->next)
2010 nn->next = hostlist;
2015 #endif /* HAVE_PING */
2018 while (token < end &&
2019 (*token == ',' || *token == ' ' ||
2020 *token == '\t' || *token == '\n'))
2030 * Main screen saver hack.
2033 * dpy - The X display.
2034 * win - The X window.
2038 screenhack(Display *dpy, Window win)
2041 /* Local Variables */
2044 struct timeval start, finish;
2048 debug_p = get_boolean_resource ("debug", "Debug");
2052 sensor_info = (void *) init_ping();
2053 # else /* !HAVE_PING */
2055 parse_mode (0); /* just to check argument syntax */
2056 # endif /* !HAVE_PING */
2061 if ((sensor_info = (void *) init_sim()) == NULL)
2065 if ((si = init_sonar(dpy, win)) == (sonar_info *) 0)
2073 /* Call the sensor and display the results */
2075 # ifdef GETTIMEOFDAY_TWO_ARGS
2076 gettimeofday(&start, (struct timezone *) 0);
2078 gettimeofday(&start);
2080 bl = sensor(si, sensor_info);
2083 /* Set up and sleep for the next one */
2085 si->current = (si->current - 1) % 90;
2086 if (si->current == 0)
2089 # ifdef GETTIMEOFDAY_TWO_ARGS
2090 gettimeofday(&finish, (struct timezone *) 0);
2092 gettimeofday(&finish);
2094 sleeptime = si->delay - delta(&start, &finish);
2095 screenhack_handle_events (dpy);