src/oping.c

   1 /**
   2  * Object oriented C module to send ICMP and ICMPv6 `echo's.
   3  * Copyright (C) 2006-2011  Florian octo Forster <ff at octo.it>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation; only version 2 of the License is
   8  * applicable.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  18  */
  19
  20 #if HAVE_CONFIG_H
  21 # include <config.h>
  22 #endif
  23
  24 #if STDC_HEADERS
  25 # include <stdlib.h>
  26 # include <stdio.h>
  27 # include <string.h>
  28 # include <stdint.h>
  29 # include <inttypes.h>
  30 # include <errno.h>
  31 # include <assert.h>
  32 #else
  33 # error "You don't have the standard C99 header files installed"
  34 #endif /* STDC_HEADERS */
  35
  36 #if HAVE_UNISTD_H
  37 # include <unistd.h>
  38 #endif
  39
  40 #if HAVE_MATH_H
  41 # include <math.h>
  42 #endif
  43
  44 #if TIME_WITH_SYS_TIME
  45 # include <sys/time.h>
  46 # include <time.h>
  47 #else
  48 # if HAVE_SYS_TIME_H
  49 #  include <sys/time.h>
  50 # else
  51 #  include <time.h>
  52 # endif
  53 #endif
  54
  55 #if HAVE_SYS_SOCKET_H
  56 # include <sys/socket.h>
  57 #endif
  58 #if HAVE_NETINET_IN_H
  59 # include <netinet/in.h>
  60 #endif
  61 #if HAVE_NETINET_IP_H
  62 # include <netinet/ip.h>
  63 #endif
  64
  65 #if HAVE_NETDB_H
  66 # include <netdb.h> /* NI_MAXHOST */
  67 #endif
  68
  69 #if HAVE_SIGNAL_H
  70 # include <signal.h>
  71 #endif
  72
  73 #if HAVE_SYS_TYPES_H
  74 #include <sys/types.h>
  75 #endif
  76
  77 #include <locale.h>
  78
  79 #if USE_NCURSES
  80 # define NCURSES_OPAQUE 1
  81 /* http://newsgroups.derkeiler.com/Archive/Rec/rec.games.roguelike.development/2010-09/msg00050.html */
  82 # define _X_OPEN_SOURCE_EXTENDED
  83 # include <ncursesw/ncurses.h>
  84
  85 # define OPING_GREEN 1
  86 # define OPING_YELLOW 2
  87 # define OPING_RED 3
  88 #endif
  89
  90 #include "oping.h"
  91
  92 const char *bars[BARS_LEN] = { "▁", "▂", "▃", "▄", "▅", "▆", "▇", "█" };
  93
  94 #ifndef _POSIX_SAVED_IDS
  95 # define _POSIX_SAVED_IDS 0
  96 #endif
  97
  98 /* Remove GNU specific __attribute__ settings when using another compiler */
  99 #if !__GNUC__
 100 # define __attribute__(x) /**/
 101 #endif
 102
 103 typedef struct ping_context
 104 {
 105         char host[NI_MAXHOST];
 106         char addr[NI_MAXHOST];
 107
 108         int index;
 109         int req_sent;
 110         int req_rcvd;
 111
 112         double latency_min;
 113         double latency_max;
 114         double latency_total;
 115         double latency_total_square;
 116
 117 #if USE_NCURSES
 118         WINDOW *window;
 119 #endif
 120 } ping_context_t;
 121
 122 static double  opt_interval   = 1.0;
 123 static int     opt_addrfamily = PING_DEF_AF;
 124 static char   *opt_srcaddr    = NULL;
 125 static char   *opt_device     = NULL;
 126 static char   *opt_filename   = NULL;
 127 static int     opt_count      = -1;
 128 static int     opt_send_ttl   = 64;
 129 static uint8_t opt_send_qos   = 0;
 130
 131 static int host_num = 0;
 132
 133 #if USE_NCURSES
 134 static WINDOW *main_win = NULL;
 135 #endif
 136
 137 static void sigint_handler (int signal) /* {{{ */
 138 {
 139         /* Make compiler happy */
 140         signal = 0;
 141         /* Exit the loop */
 142         opt_count = 0;
 143 } /* }}} void sigint_handler */
 144
 145 static ping_context_t *context_create (void) /* {{{ */
 146 {
 147         ping_context_t *ret;
 148
 149         if ((ret = malloc (sizeof (ping_context_t))) == NULL)
 150                 return (NULL);
 151
 152         memset (ret, '\0', sizeof (ping_context_t));
 153
 154         ret->latency_min   = -1.0;
 155         ret->latency_max   = -1.0;
 156         ret->latency_total = 0.0;
 157         ret->latency_total_square = 0.0;
 158
 159 #if USE_NCURSES
 160         ret->window = NULL;
 161 #endif
 162
 163         return (ret);
 164 } /* }}} ping_context_t *context_create */
 165
 166 static void context_destroy (ping_context_t *context) /* {{{ */
 167 {
 168         if (context == NULL)
 169                 return;
 170
 171 #if USE_NCURSES
 172         if (context->window != NULL)
 173         {
 174                 delwin (context->window);
 175                 context->window = NULL;
 176         }
 177 #endif
 178
 179         free (context);
 180 } /* }}} void context_destroy */
 181
 182 static double context_get_average (ping_context_t *ctx) /* {{{ */
 183 {
 184         double num_total;
 185
 186         if (ctx == NULL)
 187                 return (-1.0);
 188
 189         if (ctx->req_rcvd < 1)
 190                 return (-0.0);
 191
 192         num_total = (double) ctx->req_rcvd;
 193         return (ctx->latency_total / num_total);
 194 } /* }}} double context_get_average */
 195
 196 static double context_get_stddev (ping_context_t *ctx) /* {{{ */
 197 {
 198         double num_total;
 199
 200         if (ctx == NULL)
 201                 return (-1.0);
 202
 203         if (ctx->req_rcvd < 1)
 204                 return (-0.0);
 205         else if (ctx->req_rcvd < 2)
 206                 return (0.0);
 207
 208         num_total = (double) ctx->req_rcvd;
 209         return (sqrt (((num_total * ctx->latency_total_square)
 210                                         - (ctx->latency_total * ctx->latency_total))
 211                                 / (num_total * (num_total - 1.0))));
 212 } /* }}} double context_get_stddev */
 213
 214 static double context_get_packet_loss (const ping_context_t *ctx) /* {{{ */
 215 {
 216         if (ctx == NULL)
 217                 return (-1.0);
 218
 219         if (ctx->req_sent < 1)
 220                 return (0.0);
 221
 222         return (100.0 * (ctx->req_sent - ctx->req_rcvd)
 223                         / ((double) ctx->req_sent));
 224 } /* }}} double context_get_packet_loss */
 225
 226 static int ping_initialize_contexts (pingobj_t *ping) /* {{{ */
 227 {
 228         pingobj_iter_t *iter;
 229         int index;
 230
 231         if (ping == NULL)
 232                 return (EINVAL);
 233
 234         index = 0;
 235         for (iter = ping_iterator_get (ping);
 236                         iter != NULL;
 237                         iter = ping_iterator_next (iter))
 238         {
 239                 ping_context_t *context;
 240                 size_t buffer_size;
 241
 242                 context = context_create ();
 243                 context->index = index;
 244
 245                 buffer_size = sizeof (context->host);
 246                 ping_iterator_get_info (iter, PING_INFO_HOSTNAME, context->host, &buffer_size);
 247
 248                 buffer_size = sizeof (context->addr);
 249                 ping_iterator_get_info (iter, PING_INFO_ADDRESS, context->addr, &buffer_size);
 250
 251                 ping_iterator_set_context (iter, (void *) context);
 252
 253                 index++;
 254         }
 255
 256         return (0);
 257 } /* }}} int ping_initialize_contexts */
 258
 259 static void usage_exit (const char *name, int status) /* {{{ */
 260 {
 261         fprintf (stderr, "Usage: %s [OPTIONS] "
 262                                 "-f filename | host [host [host ...]]\n"
 263
 264                         "\nAvailable options:\n"
 265                         "  -4|-6        force the use of IPv4 or IPv6\n"
 266                         "  -c count     number of ICMP packets to send\n"
 267                         "  -i interval  interval with which to send ICMP packets\n"
 268                         "  -t ttl       time to live for each ICMP packet\n"
 269                         "  -Q qos       Quality of Service (QoS) of outgoing packets\n"
 270                         "               Use \"-Q help\" for a list of valid options.\n"
 271                         "  -I srcaddr   source address\n"
 272                         "  -D device    outgoing interface name\n"
 273                         "  -f filename  filename to read hosts from\n"
 274
 275                         "\noping "PACKAGE_VERSION", http://verplant.org/liboping/\n"
 276                         "by Florian octo Forster <octo@verplant.org>\n"
 277                         "for contributions see `AUTHORS'\n",
 278                         name);
 279         exit (status);
 280 } /* }}} void usage_exit */
 281
 282 __attribute__((noreturn))
 283 static void usage_qos_exit (const char *arg, int status) /* {{{ */
 284 {
 285         if (arg != 0)
 286                 fprintf (stderr, "Invalid QoS argument: \"%s\"\n\n", arg);
 287
 288         fprintf (stderr, "Valid QoS arguments (option \"-Q\") are:\n"
 289                         "\n"
 290                         "  Differentiated Services (IPv4 and IPv6, RFC 2474)\n"
 291                         "\n"
 292                         "    be                     Best Effort (BE, default PHB).\n"
 293                         "    ef                     Expedited Forwarding (EF) PHB group (RFC 3246).\n"
 294                         "                           (low delay, low loss, low jitter)\n"
 295                         "    va                     Voice Admit (VA) DSCP (RFC 5865).\n"
 296                         "                           (capacity-admitted traffic)\n"
 297                         "    af[1-4][1-3]           Assured Forwarding (AF) PHB group (RFC 2597).\n"
 298                         "                           For example: \"af12\" (class 1, precedence 2)\n"
 299                         "    cs[0-7]                Class Selector (CS) PHB group (RFC 2474).\n"
 300                         "                           For example: \"cs1\" (priority traffic)\n"
 301                         "\n"
 302                         "  Type of Service (IPv4, RFC 1349, obsolete)\n"
 303                         "\n"
 304                         "    lowdelay     (%#04x)    minimize delay\n"
 305                         "    throughput   (%#04x)    maximize throughput\n"
 306                         "    reliability  (%#04x)    maximize reliability\n"
 307                         "    mincost      (%#04x)    minimize monetary cost\n"
 308                         "\n"
 309                         "  Specify manually\n"
 310                         "\n"
 311                         "    0x00 - 0xff            Hexadecimal numeric specification.\n"
 312                         "       0 -  255            Decimal numeric specification.\n"
 313                         "\n",
 314                         (unsigned int) IPTOS_LOWDELAY,
 315                         (unsigned int) IPTOS_THROUGHPUT,
 316                         (unsigned int) IPTOS_RELIABILITY,
 317                         (unsigned int) IPTOS_MINCOST);
 318
 319         exit (status);
 320 } /* }}} void usage_qos_exit */
 321
 322 static int set_opt_send_qos (const char *opt) /* {{{ */
 323 {
 324         if (opt == NULL)
 325                 return (EINVAL);
 326
 327         if (strcasecmp ("help", opt) == 0)
 328                 usage_qos_exit (/* arg = */ NULL, /* status = */ EXIT_SUCCESS);
 329         /* DiffServ (RFC 2474): */
 330         /* - Best effort (BE) */
 331         else if (strcasecmp ("be", opt) == 0)
 332                 opt_send_qos = 0;
 333         /* - Expedited Forwarding (EF, RFC 3246) */
 334         else if (strcasecmp ("ef", opt) == 0)
 335                 opt_send_qos = 0xB8; /* == 0x2E << 2 */
 336         /* - Voice Admit (VA, RFC 5865) */
 337         else if (strcasecmp ("va", opt) == 0)
 338                 opt_send_qos = 0xB0; /* == 0x2D << 2 */
 339         /* - Assured Forwarding (AF, RFC 2597) */
 340         else if ((strncasecmp ("af", opt, strlen ("af")) == 0)
 341                         && (strlen (opt) == 4))
 342         {
 343                 uint8_t dscp;
 344                 uint8_t class = 0;
 345                 uint8_t prec = 0;
 346
 347                 /* There are four classes, AF1x, AF2x, AF3x, and AF4x. */
 348                 if (opt[2] == '1')
 349                         class = 1;
 350                 else if (opt[2] == '2')
 351                         class = 2;
 352                 else if (opt[2] == '3')
 353                         class = 3;
 354                 else if (opt[2] == '4')
 355                         class = 4;
 356                 else
 357                         usage_qos_exit (/* arg = */ opt, /* status = */ EXIT_SUCCESS);
 358
 359                 /* In each class, there are three precedences, AFx1, AFx2, and AFx3 */
 360                 if (opt[3] == '1')
 361                         prec = 1;
 362                 else if (opt[3] == '2')
 363                         prec = 2;
 364                 else if (opt[3] == '3')
 365                         prec = 3;
 366                 else
 367                         usage_qos_exit (/* arg = */ opt, /* status = */ EXIT_SUCCESS);
 368
 369                 dscp = (8 * class) + (2 * prec);
 370                 /* The lower two bits are used for Explicit Congestion Notification (ECN) */
 371                 opt_send_qos = dscp << 2;
 372         }
 373         /* - Class Selector (CS) */
 374         else if ((strncasecmp ("cs", opt, strlen ("cs")) == 0)
 375                         && (strlen (opt) == 3))
 376         {
 377                 uint8_t class;
 378
 379                 if ((opt[2] < '0') || (opt[2] > '7'))
 380                         usage_qos_exit (/* arg = */ opt, /* status = */ EXIT_FAILURE);
 381
 382                 /* Not exactly legal by the C standard, but I don't know of any
 383                  * system not supporting this hack. */
 384                 class = ((uint8_t) opt[2]) - ((uint8_t) '0');
 385                 opt_send_qos = class << 5;
 386         }
 387         /* Type of Service (RFC 1349) */
 388         else if (strcasecmp ("lowdelay", opt) == 0)
 389                 opt_send_qos = IPTOS_LOWDELAY;
 390         else if (strcasecmp ("throughput", opt) == 0)
 391                 opt_send_qos = IPTOS_THROUGHPUT;
 392         else if (strcasecmp ("reliability", opt) == 0)
 393                 opt_send_qos = IPTOS_RELIABILITY;
 394         else if (strcasecmp ("mincost", opt) == 0)
 395                 opt_send_qos = IPTOS_MINCOST;
 396         /* Numeric value */
 397         else
 398         {
 399                 unsigned long value;
 400                 char *endptr;
 401
 402                 errno = 0;
 403                 endptr = NULL;
 404                 value = strtoul (opt, &endptr, /* base = */ 0);
 405                 if ((errno != 0) || (endptr == opt)
 406                                 || (endptr == NULL) || (*endptr != 0)
 407                                 || (value > 0xff))
 408                         usage_qos_exit (/* arg = */ opt, /* status = */ EXIT_FAILURE);
 409
 410                 opt_send_qos = (uint8_t) value;
 411         }
 412
 413         return (0);
 414 } /* }}} int set_opt_send_qos */
 415
 416 static char *format_qos (uint8_t qos, char *buffer, size_t buffer_size) /* {{{ */
 417 {
 418         uint8_t dscp;
 419         uint8_t ecn;
 420         char *dscp_str;
 421         char *ecn_str;
 422
 423         dscp = qos >> 2;
 424         ecn = qos & 0x03;
 425
 426         switch (dscp)
 427         {
 428                 case 0x00: dscp_str = "be";  break;
 429                 case 0x2e: dscp_str = "ef";  break;
 430                 case 0x2d: dscp_str = "va";  break;
 431                 case 0x0a: dscp_str = "af11"; break;
 432                 case 0x0c: dscp_str = "af12"; break;
 433                 case 0x0e: dscp_str = "af13"; break;
 434                 case 0x12: dscp_str = "af21"; break;
 435                 case 0x14: dscp_str = "af22"; break;
 436                 case 0x16: dscp_str = "af23"; break;
 437                 case 0x1a: dscp_str = "af31"; break;
 438                 case 0x1c: dscp_str = "af32"; break;
 439                 case 0x1e: dscp_str = "af33"; break;
 440                 case 0x22: dscp_str = "af41"; break;
 441                 case 0x24: dscp_str = "af42"; break;
 442                 case 0x26: dscp_str = "af43"; break;
 443                 case 0x08: dscp_str = "cs1";  break;
 444                 case 0x10: dscp_str = "cs2";  break;
 445                 case 0x18: dscp_str = "cs3";  break;
 446                 case 0x20: dscp_str = "cs4";  break;
 447                 case 0x28: dscp_str = "cs5";  break;
 448                 case 0x30: dscp_str = "cs6";  break;
 449                 case 0x38: dscp_str = "cs7";  break;
 450                 default:   dscp_str = NULL;
 451         }
 452
 453         switch (ecn)
 454         {
 455                 case 0x01: ecn_str = ",ecn(1)"; break;
 456                 case 0x02: ecn_str = ",ecn(0)"; break;
 457                 case 0x03: ecn_str = ",ce"; break;
 458                 default:   ecn_str = "";
 459         }
 460
 461         if (dscp_str == NULL)
 462                 snprintf (buffer, buffer_size, "0x%02x%s", dscp, ecn_str);
 463         else
 464                 snprintf (buffer, buffer_size, "%s%s", dscp_str, ecn_str);
 465         buffer[buffer_size - 1] = 0;
 466
 467         return (buffer);
 468 } /* }}} char *format_qos */
 469
 470 static int read_options (int argc, char **argv) /* {{{ */
 471 {
 472         int optchar;
 473
 474         while (1)
 475         {
 476                 optchar = getopt (argc, argv, "46c:hi:I:t:Q:f:D:");
 477
 478                 if (optchar == -1)
 479                         break;
 480
 481                 switch (optchar)
 482                 {
 483                         case '4':
 484                         case '6':
 485                                 opt_addrfamily = (optchar == '4') ? AF_INET : AF_INET6;
 486                                 break;
 487
 488                         case 'c':
 489                                 {
 490                                         int new_count;
 491                                         new_count = atoi (optarg);
 492                                         if (new_count > 0)
 493                                                 opt_count = new_count;
 494                                         else
 495                                                 fprintf(stderr, "Ignoring invalid count: %s\n",
 496                                                                 optarg);
 497                                 }
 498                                 break;
 499
 500                         case 'f':
 501                                 {
 502                                         if (opt_filename != NULL)
 503                                                 free (opt_filename);
 504                                         opt_filename = strdup (optarg);
 505                                 }
 506                                 break;
 507
 508                         case 'i':
 509                                 {
 510                                         double new_interval;
 511                                         new_interval = atof (optarg);
 512                                         if (new_interval < 0.001)
 513                                                 fprintf (stderr, "Ignoring invalid interval: %s\n",
 514                                                                 optarg);
 515                                         else
 516                                                 opt_interval = new_interval;
 517                                 }
 518                                 break;
 519                         case 'I':
 520                                 {
 521                                         if (opt_srcaddr != NULL)
 522                                                 free (opt_srcaddr);
 523                                         opt_srcaddr = strdup (optarg);
 524                                 }
 525                                 break;
 526
 527                         case 'D':
 528                                 opt_device = optarg;
 529                                 break;
 530
 531                         case 't':
 532                         {
 533                                 int new_send_ttl;
 534                                 new_send_ttl = atoi (optarg);
 535                                 if ((new_send_ttl > 0) && (new_send_ttl < 256))
 536                                         opt_send_ttl = new_send_ttl;
 537                                 else
 538                                         fprintf (stderr, "Ignoring invalid TTL argument: %s\n",
 539                                                         optarg);
 540                                 break;
 541                         }
 542
 543                         case 'Q':
 544                                 set_opt_send_qos (optarg);
 545                                 break;
 546
 547                         case 'h':
 548                                 usage_exit (argv[0], 0);
 549                                 break;
 550                         default:
 551                                 usage_exit (argv[0], 1);
 552                 }
 553         }
 554
 555         return (optind);
 556 } /* }}} read_options */
 557
 558 static void time_normalize (struct timespec *ts) /* {{{ */
 559 {
 560         while (ts->tv_nsec < 0)
 561         {
 562                 if (ts->tv_sec == 0)
 563                 {
 564                         ts->tv_nsec = 0;
 565                         return;
 566                 }
 567
 568                 ts->tv_sec  -= 1;
 569                 ts->tv_nsec += 1000000000;
 570         }
 571
 572         while (ts->tv_nsec >= 1000000000)
 573         {
 574                 ts->tv_sec  += 1;
 575                 ts->tv_nsec -= 1000000000;
 576         }
 577 } /* }}} void time_normalize */
 578
 579 static void time_calc (struct timespec *ts_dest, /* {{{ */
 580                 const struct timespec *ts_int,
 581                 const struct timeval  *tv_begin,
 582                 const struct timeval  *tv_end)
 583 {
 584         ts_dest->tv_sec = tv_begin->tv_sec + ts_int->tv_sec;
 585         ts_dest->tv_nsec = (tv_begin->tv_usec * 1000) + ts_int->tv_nsec;
 586         time_normalize (ts_dest);
 587
 588         /* Assure that `(begin + interval) > end'.
 589          * This may seem overly complicated, but `tv_sec' is of type `time_t'
 590          * which may be `unsigned. *sigh* */
 591         if ((tv_end->tv_sec > ts_dest->tv_sec)
 592                         || ((tv_end->tv_sec == ts_dest->tv_sec)
 593                                 && ((tv_end->tv_usec * 1000) > ts_dest->tv_nsec)))
 594         {
 595                 ts_dest->tv_sec  = 0;
 596                 ts_dest->tv_nsec = 0;
 597                 return;
 598         }
 599
 600         ts_dest->tv_sec = ts_dest->tv_sec - tv_end->tv_sec;
 601         ts_dest->tv_nsec = ts_dest->tv_nsec - (tv_end->tv_usec * 1000);
 602         time_normalize (ts_dest);
 603 } /* }}} void time_calc */
 604
 605 #if USE_NCURSES
 606 static int update_stats_from_context (ping_context_t *ctx, pingobj_iter_t *iter) /* {{{ */
 607 {
 608         double latency = -1.0;
 609         size_t buffer_len = sizeof (latency);
 610         ping_iterator_get_info (iter, PING_INFO_LATENCY,
 611                         &latency, &buffer_len);
 612
 613         unsigned int sequence = 0;
 614         buffer_len = sizeof (sequence);
 615         ping_iterator_get_info (iter, PING_INFO_SEQUENCE,
 616                         &sequence, &buffer_len);
 617
 618
 619         if ((ctx == NULL) || (ctx->window == NULL))
 620                 return (EINVAL);
 621
 622         /* werase (ctx->window); */
 623
 624         box (ctx->window, 0, 0);
 625         wattron (ctx->window, A_BOLD);
 626         mvwprintw (ctx->window, /* y = */ 0, /* x = */ 5,
 627                         " %s ", ctx->host);
 628         wattroff (ctx->window, A_BOLD);
 629         wprintw (ctx->window, "ping statistics ");
 630         mvwprintw (ctx->window, /* y = */ 1, /* x = */ 2,
 631                         "%i packets transmitted, %i received, %.2f%% packet "
 632                         "loss, time %.1fms",
 633                         ctx->req_sent, ctx->req_rcvd,
 634                         context_get_packet_loss (ctx),
 635                         ctx->latency_total);
 636         if (ctx->req_rcvd != 0)
 637         {
 638                 double average;
 639                 double deviation;
 640
 641                 average = context_get_average (ctx);
 642                 deviation = context_get_stddev (ctx);
 643
 644                 mvwprintw (ctx->window, /* y = */ 2, /* x = */ 2,
 645                                 "rtt min/avg/max/sdev = %.3f/%.3f/%.3f/%.3f ms\n",
 646                                 ctx->latency_min,
 647                                 average,
 648                                 ctx->latency_max,
 649                                 deviation);
 650         }
 651
 652         if (latency > 0.0)
 653         {
 654                 if (has_colors () == TRUE)
 655                 {
 656                         int color = OPING_GREEN;
 657                         float ratio = 0;
 658                         int index = 0;
 659
 660                         ratio = latency / PING_DEF_TTL;
 661                         if (ratio > 2/3.0) {
 662                           color = OPING_RED;
 663                         }
 664                         else if (ratio > 1/3.0) {
 665                           color = OPING_YELLOW;
 666                         }
 667                         index = (int) (ratio * BARS_LEN * 3); /* 3 colors */
 668                         /* HOST_PRINTF ("%%r%f-ia%d-", ratio, index); */
 669                         index = index % (BARS_LEN-1);
 670                         /* HOST_PRINTF ("im%d-", index); */
 671                         if (index < 0 || index >= BARS_LEN) {
 672                           index = 0; /* safety check */
 673                         }
 674                         wattron (ctx->window, COLOR_PAIR(color));
 675                         mvwprintw (ctx->window,
 676                                    /* y = */ 3, /* x = */ 1 + sequence,
 677                                    bars[index]);
 678                         wattroff (ctx->window, COLOR_PAIR(color));
 679                 }
 680                 else
 681                 {
 682                 }
 683         }
 684         else {
 685                 wattron (ctx->window, COLOR_PAIR(OPING_RED) | A_BOLD);
 686                 mvwprintw (ctx->window,
 687                            /* y = */ 3, /* x = */ 1 + sequence,
 688                            "!");
 689                 wattroff (ctx->window, COLOR_PAIR(OPING_RED) | A_BOLD);
 690         }
 691         wrefresh (ctx->window);
 692
 693         return (0);
 694 } /* }}} int update_stats_from_context */
 695
 696 static int on_resize (pingobj_t *ping) /* {{{ */
 697 {
 698         pingobj_iter_t *iter;
 699         int width = 0;
 700         int height = 0;
 701         int main_win_height;
 702
 703         getmaxyx (stdscr, height, width);
 704         if ((height < 1) || (width < 1))
 705                 return (EINVAL);
 706
 707         main_win_height = height - (5 * host_num);
 708         wresize (main_win, main_win_height, /* width = */ width);
 709         /* Allow scrolling */
 710         scrollok (main_win, TRUE);
 711         /* wsetscrreg (main_win, 0, main_win_height - 1); */
 712         /* Allow hardware accelerated scrolling. */
 713         idlok (main_win, TRUE);
 714         wrefresh (main_win);
 715
 716         for (iter = ping_iterator_get (ping);
 717                         iter != NULL;
 718                         iter = ping_iterator_next (iter))
 719         {
 720                 ping_context_t *context;
 721
 722                 context = ping_iterator_get_context (iter);
 723                 if (context == NULL)
 724                         continue;
 725
 726                 if (context->window != NULL)
 727                 {
 728                         delwin (context->window);
 729                         context->window = NULL;
 730                 }
 731                 context->window = newwin (/* height = */ 5,
 732                                 /* width = */ width,
 733                                 /* y = */ main_win_height + (5 * context->index),
 734                                 /* x = */ 0);
 735         }
 736
 737         return (0);
 738 } /* }}} */
 739
 740 static int check_resize (pingobj_t *ping) /* {{{ */
 741 {
 742         int need_resize = 0;
 743
 744         while (42)
 745         {
 746                 int key = wgetch (stdscr);
 747                 if (key == ERR)
 748                         break;
 749                 else if (key == KEY_RESIZE)
 750                         need_resize = 1;
 751         }
 752
 753         if (need_resize)
 754                 return (on_resize (ping));
 755         else
 756                 return (0);
 757 } /* }}} int check_resize */
 758
 759 static int pre_loop_hook (pingobj_t *ping) /* {{{ */
 760 {
 761         pingobj_iter_t *iter;
 762         int width = 0;
 763         int height = 0;
 764         int main_win_height;
 765
 766         initscr ();
 767         cbreak ();
 768         noecho ();
 769         nodelay (stdscr, TRUE);
 770
 771         getmaxyx (stdscr, height, width);
 772         if ((height < 1) || (width < 1))
 773                 return (EINVAL);
 774
 775         if (has_colors () == TRUE)
 776         {
 777                 start_color ();
 778                 init_pair (OPING_GREEN,  COLOR_GREEN,  /* default = */ 0);
 779                 init_pair (OPING_YELLOW, COLOR_YELLOW, /* default = */ 0);
 780                 init_pair (OPING_RED,    COLOR_RED,    /* default = */ 0);
 781         }
 782
 783         main_win_height = height - (5 * host_num);
 784         main_win = newwin (/* height = */ main_win_height,
 785                         /* width = */ width,
 786                         /* y = */ 0, /* x = */ 0);
 787         /* Allow scrolling */
 788         scrollok (main_win, TRUE);
 789         /* wsetscrreg (main_win, 0, main_win_height - 1); */
 790         /* Allow hardware accelerated scrolling. */
 791         idlok (main_win, TRUE);
 792         wmove (main_win, /* y = */ main_win_height - 1, /* x = */ 0);
 793         wrefresh (main_win);
 794
 795         for (iter = ping_iterator_get (ping);
 796                         iter != NULL;
 797                         iter = ping_iterator_next (iter))
 798         {
 799                 ping_context_t *context;
 800
 801                 context = ping_iterator_get_context (iter);
 802                 if (context == NULL)
 803                         continue;
 804
 805                 if (context->window != NULL)
 806                 {
 807                         delwin (context->window);
 808                         context->window = NULL;
 809                 }
 810                 context->window = newwin (/* height = */ 5,
 811                                 /* width = */ width,
 812                                 /* y = */ main_win_height + (5 * context->index),
 813                                 /* x = */ 0);
 814         }
 815
 816
 817         /* Don't know what good this does exactly, but without this code
 818          * "check_resize" will be called right after startup and *somehow*
 819          * this leads to display errors. If we purge all initial characters
 820          * here, the problem goes away. "wgetch" is non-blocking due to
 821          * "nodelay" (see above). */
 822         while (wgetch (stdscr) != ERR)
 823         {
 824                 /* eat up characters */;
 825         }
 826
 827         return (0);
 828 } /* }}} int pre_loop_hook */
 829
 830 static int pre_sleep_hook (pingobj_t *ping) /* {{{ */
 831 {
 832         return (check_resize (ping));
 833 } /* }}} int pre_sleep_hook */
 834
 835 static int post_sleep_hook (pingobj_t *ping) /* {{{ */
 836 {
 837         return (check_resize (ping));
 838 } /* }}} int pre_sleep_hook */
 839 #else /* if !USE_NCURSES */
 840 static int pre_loop_hook (pingobj_t *ping) /* {{{ */
 841 {
 842         pingobj_iter_t *iter;
 843
 844         for (iter = ping_iterator_get (ping);
 845                         iter != NULL;
 846                         iter = ping_iterator_next (iter))
 847         {
 848                 ping_context_t *ctx;
 849                 size_t buffer_size;
 850
 851                 ctx = ping_iterator_get_context (iter);
 852                 if (ctx == NULL)
 853                         continue;
 854
 855                 buffer_size = 0;
 856                 ping_iterator_get_info (iter, PING_INFO_DATA, NULL, &buffer_size);
 857
 858                 printf ("PING %s (%s) %zu bytes of data.\n",
 859                                 ctx->host, ctx->addr, buffer_size);
 860         }
 861
 862         return (0);
 863 } /* }}} int pre_loop_hook */
 864
 865 static int pre_sleep_hook (__attribute__((unused)) pingobj_t *ping) /* {{{ */
 866 {
 867         fflush (stdout);
 868
 869         return (0);
 870 } /* }}} int pre_sleep_hook */
 871
 872 static int post_sleep_hook (__attribute__((unused)) pingobj_t *ping) /* {{{ */
 873 {
 874         return (0);
 875 } /* }}} int post_sleep_hook */
 876 #endif
 877
 878 static void update_host_hook (pingobj_iter_t *iter, /* {{{ */
 879                 __attribute__((unused)) int index)
 880 {
 881         double          latency;
 882         unsigned int    sequence;
 883         int             recv_ttl;
 884         uint8_t         recv_qos;
 885         char            recv_qos_str[16];
 886         size_t          buffer_len;
 887         size_t          data_len;
 888         ping_context_t *context;
 889
 890         latency = -1.0;
 891         buffer_len = sizeof (latency);
 892         ping_iterator_get_info (iter, PING_INFO_LATENCY,
 893                         &latency, &buffer_len);
 894
 895         sequence = 0;
 896         buffer_len = sizeof (sequence);
 897         ping_iterator_get_info (iter, PING_INFO_SEQUENCE,
 898                         &sequence, &buffer_len);
 899
 900         recv_ttl = -1;
 901         buffer_len = sizeof (recv_ttl);
 902         ping_iterator_get_info (iter, PING_INFO_RECV_TTL,
 903                         &recv_ttl, &buffer_len);
 904
 905         recv_qos = 0;
 906         buffer_len = sizeof (recv_qos);
 907         ping_iterator_get_info (iter, PING_INFO_RECV_QOS,
 908                         &recv_qos, &buffer_len);
 909
 910         data_len = 0;
 911         ping_iterator_get_info (iter, PING_INFO_DATA,
 912                         NULL, &data_len);
 913
 914         context = (ping_context_t *) ping_iterator_get_context (iter);
 915
 916 #if USE_NCURSES
 917 # define HOST_PRINTF(...) wprintw(main_win, __VA_ARGS__)
 918 #else
 919 # define HOST_PRINTF(...) printf(__VA_ARGS__)
 920 #endif
 921
 922         context->req_sent++;
 923         if (latency > 0.0)
 924         {
 925                 context->req_rcvd++;
 926                 context->latency_total += latency;
 927                 context->latency_total_square += (latency * latency);
 928
 929                 if ((context->latency_max < 0.0) || (context->latency_max < latency))
 930                         context->latency_max = latency;
 931                 if ((context->latency_min < 0.0) || (context->latency_min > latency))
 932                         context->latency_min = latency;
 933
 934 #if USE_NCURSES
 935                 if (has_colors () == TRUE)
 936                 {
 937                         int color = OPING_GREEN;
 938                         float ratio = 0;
 939                         int index = 0;
 940
 941                         ratio = latency / PING_DEF_TTL;
 942                         if (ratio > 2/3.0) {
 943                           color = OPING_RED;
 944                         }
 945                         else if (ratio > 1/3.0) {
 946                           color = OPING_YELLOW;
 947                         }
 948                         index = (int) (ratio * BARS_LEN * 3); /* 3 colors */
 949                         /* HOST_PRINTF ("%%r%f-ia%d-", ratio, index); */
 950                         index = index % (BARS_LEN-1);
 951                         /* HOST_PRINTF ("im%d-", index); */
 952                         if (index < 0 || index >= BARS_LEN) {
 953                           index = 0; /* safety check */
 954                         }
 955                         wattron (main_win, COLOR_PAIR(color));
 956                         HOST_PRINTF (bars[index]);
 957                         wattroff (main_win, COLOR_PAIR(color));
 958                 }
 959                 else
 960                 {
 961 #endif
 962                 HOST_PRINTF ("%zu bytes from %s (%s): icmp_seq=%u ttl=%i ",
 963                                 data_len,
 964                                 context->host, context->addr,
 965                                 sequence, recv_ttl);
 966                 if ((recv_qos != 0) || (opt_send_qos != 0))
 967                 {
 968                         HOST_PRINTF ("qos=%s ",
 969                                         format_qos (recv_qos, recv_qos_str, sizeof (recv_qos_str)));
 970                 }
 971                 HOST_PRINTF ("time=%.2f ms\n", latency);
 972 #if USE_NCURSES
 973                 }
 974 #endif
 975         }
 976         else
 977         {
 978 #if USE_NCURSES
 979                 if (has_colors () == TRUE)
 980                 {
 981                         wattron (main_win, COLOR_PAIR(OPING_RED) | A_BOLD);
 982                         HOST_PRINTF ("!");
 983                         wattroff (main_win, COLOR_PAIR(OPING_RED) | A_BOLD);
 984                 }
 985                 else
 986                 {
 987 #endif
 988                 HOST_PRINTF ("echo reply from %s (%s): icmp_seq=%u timeout\n",
 989                                 context->host, context->addr,
 990                                 sequence);
 991 #if USE_NCURSES
 992                 }
 993 #endif
 994         }
 995
 996 #if USE_NCURSES
 997         update_stats_from_context (context, iter);
 998         wrefresh (main_win);
 999 #endif
1000 } /* }}} void update_host_hook */
1001
1002 static int post_loop_hook (pingobj_t *ping) /* {{{ */
1003 {
1004         pingobj_iter_t *iter;
1005
1006 #if USE_NCURSES
1007         endwin ();
1008 #endif
1009
1010         for (iter = ping_iterator_get (ping);
1011                         iter != NULL;
1012                         iter = ping_iterator_next (iter))
1013         {
1014                 ping_context_t *context;
1015
1016                 context = ping_iterator_get_context (iter);
1017
1018                 printf ("\n--- %s ping statistics ---\n"
1019                                 "%i packets transmitted, %i received, %.2f%% packet loss, time %.1fms\n",
1020                                 context->host, context->req_sent, context->req_rcvd,
1021                                 context_get_packet_loss (context),
1022                                 context->latency_total);
1023
1024                 if (context->req_rcvd != 0)
1025                 {
1026                         double average;
1027                         double deviation;
1028
1029                         average = context_get_average (context);
1030                         deviation = context_get_stddev (context);
1031
1032                         printf ("rtt min/avg/max/sdev = %.3f/%.3f/%.3f/%.3f ms\n",
1033                                         context->latency_min,
1034                                         average,
1035                                         context->latency_max,
1036                                         deviation);
1037                 }
1038
1039                 ping_iterator_set_context (iter, NULL);
1040                 context_destroy (context);
1041         }
1042
1043         return (0);
1044 } /* }}} int post_loop_hook */
1045
1046 int main (int argc, char **argv) /* {{{ */
1047 {
1048         pingobj_t      *ping;
1049         pingobj_iter_t *iter;
1050
1051         struct sigaction sigint_action;
1052
1053         struct timeval  tv_begin;
1054         struct timeval  tv_end;
1055         struct timespec ts_wait;
1056         struct timespec ts_int;
1057
1058         int optind;
1059         int i;
1060         int status;
1061 #if _POSIX_SAVED_IDS
1062         uid_t saved_set_uid;
1063
1064         /* Save the old effective user id */
1065         saved_set_uid = geteuid ();
1066         /* Set the effective user ID to the real user ID without changing the
1067          * saved set-user ID */
1068         status = seteuid (getuid ());
1069         if (status != 0)
1070         {
1071                 fprintf (stderr, "Temporarily dropping privileges "
1072                                 "failed: %s\n", strerror (errno));
1073                 exit (EXIT_FAILURE);
1074         }
1075 #endif
1076
1077         setlocale(LC_ALL, "");
1078         optind = read_options (argc, argv);
1079
1080 #if !_POSIX_SAVED_IDS
1081         /* Cannot temporarily drop privileges -> reject every file but "-". */
1082         if ((opt_filename != NULL)
1083                         && (strcmp ("-", opt_filename) != 0)
1084                         && (getuid () != geteuid ()))
1085         {
1086                 fprintf (stderr, "Your real and effective user IDs don't "
1087                                 "match. Reading from a file (option '-f')\n"
1088                                 "is therefore too risky. You can still read "
1089                                 "from STDIN using '-f -' if you like.\n"
1090                                 "Sorry.\n");
1091                 exit (EXIT_FAILURE);
1092         }
1093 #endif
1094
1095         if ((optind >= argc) && (opt_filename == NULL)) {
1096                 usage_exit (argv[0], 1);
1097         }
1098
1099         if ((ping = ping_construct ()) == NULL)
1100         {
1101                 fprintf (stderr, "ping_construct failed\n");
1102                 return (1);
1103         }
1104
1105         if (ping_setopt (ping, PING_OPT_TTL, &opt_send_ttl) != 0)
1106         {
1107                 fprintf (stderr, "Setting TTL to %i failed: %s\n",
1108                                 opt_send_ttl, ping_get_error (ping));
1109         }
1110
1111         if (ping_setopt (ping, PING_OPT_QOS, &opt_send_qos) != 0)
1112         {
1113                 fprintf (stderr, "Setting TOS to %i failed: %s\n",
1114                                 opt_send_qos, ping_get_error (ping));
1115         }
1116
1117         {
1118                 double temp_sec;
1119                 double temp_nsec;
1120
1121                 temp_nsec = modf (opt_interval, &temp_sec);
1122                 ts_int.tv_sec  = (time_t) temp_sec;
1123                 ts_int.tv_nsec = (long) (temp_nsec * 1000000000L);
1124
1125                 /* printf ("ts_int = %i.%09li\n", (int) ts_int.tv_sec, ts_int.tv_nsec); */
1126         }
1127
1128         if (opt_addrfamily != PING_DEF_AF)
1129                 ping_setopt (ping, PING_OPT_AF, (void *) &opt_addrfamily);
1130
1131         if (opt_srcaddr != NULL)
1132         {
1133                 if (ping_setopt (ping, PING_OPT_SOURCE, (void *) opt_srcaddr) != 0)
1134                 {
1135                         fprintf (stderr, "Setting source address failed: %s\n",
1136                                         ping_get_error (ping));
1137                 }
1138         }
1139
1140         if (opt_device != NULL)
1141         {
1142                 if (ping_setopt (ping, PING_OPT_DEVICE, (void *) opt_device) != 0)
1143                 {
1144                         fprintf (stderr, "Setting device failed: %s\n",
1145                                         ping_get_error (ping));
1146                 }
1147         }
1148
1149         if (opt_filename != NULL)
1150         {
1151                 FILE *infile;
1152                 char line[256];
1153                 char host[256];
1154
1155                 if (strcmp (opt_filename, "-") == 0)
1156                         /* Open STDIN */
1157                         infile = fdopen(0, "r");
1158                 else
1159                         infile = fopen(opt_filename, "r");
1160
1161                 if (infile == NULL)
1162                 {
1163                         fprintf (stderr, "Opening %s failed: %s\n",
1164                                         (strcmp (opt_filename, "-") == 0)
1165                                         ? "STDIN" : opt_filename,
1166                                         strerror(errno));
1167                         return (1);
1168                 }
1169
1170 #if _POSIX_SAVED_IDS
1171                 /* Regain privileges */
1172                 status = seteuid (saved_set_uid);
1173                 if (status != 0)
1174                 {
1175                         fprintf (stderr, "Temporarily re-gaining privileges "
1176                                         "failed: %s\n", strerror (errno));
1177                         exit (EXIT_FAILURE);
1178                 }
1179 #endif
1180
1181                 while (fgets(line, sizeof(line), infile))
1182                 {
1183                         /* Strip whitespace */
1184                         if (sscanf(line, "%s", host) != 1)
1185                                 continue;
1186
1187                         if ((host[0] == 0) || (host[0] == '#'))
1188                                 continue;
1189
1190                         if (ping_host_add(ping, host) < 0)
1191                         {
1192                                 const char *errmsg = ping_get_error (ping);
1193
1194                                 fprintf (stderr, "Adding host `%s' failed: %s\n", host, errmsg);
1195                                 continue;
1196                         }
1197                         else
1198                         {
1199                                 host_num++;
1200                         }
1201                 }
1202
1203 #if _POSIX_SAVED_IDS
1204                 /* Drop privileges */
1205                 status = seteuid (getuid ());
1206                 if (status != 0)
1207                 {
1208                         fprintf (stderr, "Temporarily dropping privileges "
1209                                         "failed: %s\n", strerror (errno));
1210                         exit (EXIT_FAILURE);
1211                 }
1212 #endif
1213
1214                 fclose(infile);
1215         }
1216
1217 #if _POSIX_SAVED_IDS
1218         /* Regain privileges */
1219         status = seteuid (saved_set_uid);
1220         if (status != 0)
1221         {
1222                 fprintf (stderr, "Temporarily re-gaining privileges "
1223                                 "failed: %s\n", strerror (errno));
1224                 exit (EXIT_FAILURE);
1225         }
1226 #endif
1227
1228         for (i = optind; i < argc; i++)
1229         {
1230                 if (ping_host_add (ping, argv[i]) < 0)
1231                 {
1232                         const char *errmsg = ping_get_error (ping);
1233
1234                         fprintf (stderr, "Adding host `%s' failed: %s\n", argv[i], errmsg);
1235                         continue;
1236                 }
1237                 else
1238                 {
1239                         host_num++;
1240                 }
1241         }
1242
1243         /* Permanently drop root privileges if we're setuid-root. */
1244         status = setuid (getuid ());
1245         if (status != 0)
1246         {
1247                 fprintf (stderr, "Dropping privileges failed: %s\n",
1248                                 strerror (errno));
1249                 exit (EXIT_FAILURE);
1250         }
1251
1252 #if _POSIX_SAVED_IDS
1253         saved_set_uid = (uid_t) -1;
1254 #endif
1255
1256         ping_initialize_contexts (ping);
1257
1258         if (i == 0)
1259                 return (1);
1260
1261         memset (&sigint_action, '\0', sizeof (sigint_action));
1262         sigint_action.sa_handler = sigint_handler;
1263         if (sigaction (SIGINT, &sigint_action, NULL) < 0)
1264         {
1265                 perror ("sigaction");
1266                 return (1);
1267         }
1268
1269         pre_loop_hook (ping);
1270
1271         while (opt_count != 0)
1272         {
1273                 int index;
1274                 int status;
1275
1276                 if (gettimeofday (&tv_begin, NULL) < 0)
1277                 {
1278                         perror ("gettimeofday");
1279                         return (1);
1280                 }
1281
1282                 if (ping_send (ping) < 0)
1283                 {
1284                         fprintf (stderr, "ping_send failed: %s\n",
1285                                         ping_get_error (ping));
1286                         return (1);
1287                 }
1288
1289                 index = 0;
1290                 for (iter = ping_iterator_get (ping);
1291                                 iter != NULL;
1292                                 iter = ping_iterator_next (iter))
1293                 {
1294                         update_host_hook (iter, index);
1295                         index++;
1296                 }
1297
1298                 pre_sleep_hook (ping);
1299
1300                 /* Don't sleep in the last iteration */
1301                 if (opt_count == 1)
1302                         break;
1303
1304                 if (gettimeofday (&tv_end, NULL) < 0)
1305                 {
1306                         perror ("gettimeofday");
1307                         return (1);
1308                 }
1309
1310                 time_calc (&ts_wait, &ts_int, &tv_begin, &tv_end);
1311
1312                 /* printf ("Sleeping for %i.%09li seconds\n", (int) ts_wait.tv_sec, ts_wait.tv_nsec); */
1313                 while ((status = nanosleep (&ts_wait, &ts_wait)) != 0)
1314                 {
1315                         if (errno != EINTR)
1316                         {
1317                                 perror ("nanosleep");
1318                                 break;
1319                         }
1320                         else if (opt_count == 0)
1321                         {
1322                                 /* sigint */
1323                                 break;
1324                         }
1325                 }
1326
1327                 post_sleep_hook (ping);
1328
1329                 if (opt_count > 0)
1330                         opt_count--;
1331         } /* while (opt_count != 0) */
1332
1333         post_loop_hook (ping);
1334
1335         ping_destroy (ping);
1336
1337         return (0);
1338 } /* }}} int main */
1339
1340 /* vim: set fdm=marker : */