reactos/lib/icmp/icmp_main.c

   1 /*
   2  * ICMP
   3  *
   4  * Francois Gouget, 1999, based on the work of
   5  *   RW Hall, 1999, based on public domain code PING.C by Mike Muus (1983)
   6  *   and later works (c) 1989 Regents of Univ. of California - see copyright
   7  *   notice at end of source-code.
   8  *
   9  * This library is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU Lesser General Public
  11  * License as published by the Free Software Foundation; either
  12  * version 2.1 of the License, or (at your option) any later version.
  13  *
  14  * This library is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  17  * Lesser General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU Lesser General Public
  20  * License along with this library; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  22  */
  23
  24 /* Future work:
  25  * - Systems like FreeBSD don't seem to support the IP_TTL option and maybe others.
  26  *   But using IP_HDRINCL and building the IP header by hand might work.
  27  * - Not all IP options are supported.
  28  * - Are ICMP handles real handles, i.e. inheritable and all? There might be some
  29  *   more work to do here, including server side stuff with synchronization.
  30  * - Is it correct to use malloc for the internal buffer, for allocating the
  31  *   handle's structure?
  32  * - This API should probably be thread safe. Is it really?
  33  * - Using the winsock functions has not been tested.
  34  */
  35
  36 #include "config.h"
  37
  38 #include <sys/types.h>
  39 #ifdef HAVE_SYS_SOCKET_H
  40 # include <sys/socket.h>
  41 #endif
  42 #ifdef HAVE_NETDB_H
  43 # include <netdb.h>
  44 #endif
  45 #ifdef HAVE_NETINET_IN_SYSTM_H
  46 # include <netinet/in_systm.h>
  47 #endif
  48 #ifdef HAVE_NETINET_IN_H
  49 # include <netinet/in.h>
  50 #endif
  51
  52 #ifdef HAVE_SYS_TIME_H
  53 # include <sys/time.h>
  54 #endif
  55 #include <stdarg.h>
  56 #include <string.h>
  57 #include <errno.h>
  58 #ifdef HAVE_UNISTD_H
  59 # include <unistd.h>
  60 #endif
  61 #ifdef HAVE_ARPA_INET_H
  62 # include <arpa/inet.h>
  63 #endif
  64
  65 #include "windef.h"
  66 #include "winbase.h"
  67 #include "winerror.h"
  68 #include "ipexport.h"
  69 #include <ws2tcpip.h>
  70 #include "icmpapi.h"
  71 #include "wine/debug.h"
  72
  73 /* Set up endiannes macros for the ip and ip_icmp BSD headers */
  74 #ifndef BIG_ENDIAN
  75 #define BIG_ENDIAN       4321
  76 #endif
  77 #ifndef LITTLE_ENDIAN
  78 #define LITTLE_ENDIAN    1234
  79 #endif
  80 #ifndef BYTE_ORDER
  81 #ifdef WORDS_BIGENDIAN
  82 #define BYTE_ORDER       BIG_ENDIAN
  83 #else
  84 #define BYTE_ORDER       LITTLE_ENDIAN
  85 #endif
  86 #endif /* BYTE_ORDER */
  87
  88 #define u_int16_t  WORD
  89 #define u_int32_t  DWORD
  90
  91 /* These are BSD headers. We use these here because they are needed on
  92  * libc5 Linux systems. On other platforms they are usually simply more
  93  * complete than the native stuff, and cause less portability problems
  94  * so we use them anyway.
  95  */
  96 #include "ip.h"
  97 #include "ip_icmp.h"
  98
  99
 100 WINE_DEFAULT_DEBUG_CHANNEL(icmp);
 101
 102
 103 typedef struct {
 104     int sid;
 105     IP_OPTION_INFORMATION default_opts;
 106 } icmp_t;
 107
 108 #define IP_OPTS_UNKNOWN     0
 109 #define IP_OPTS_DEFAULT     1
 110 #define IP_OPTS_CUSTOM      2
 111
 112 /* The sequence number is unique process wide, so that all threads
 113  * have a distinct sequence number.
 114  */
 115 static LONG icmp_sequence=0;
 116
 117 static int in_cksum(u_short *addr, int len)
 118 {
 119     int nleft=len;
 120     u_short *w = addr;
 121     int sum = 0;
 122     u_short answer = 0;
 123
 124     while (nleft > 1) {
 125         sum += *w++;
 126         nleft -= 2;
 127     }
 128
 129     if (nleft == 1) {
 130         *(u_char *)(&answer) = *(u_char *)w;
 131         sum += answer;
 132     }
 133
 134     sum = (sum >> 16) + (sum & 0xffff);
 135     sum  += (sum >> 16);
 136     answer = ~sum;
 137     return(answer);
 138 }
 139
 140
 141
 142 /*
 143  * Exported Routines.
 144  */
 145
 146 /***********************************************************************
 147  *              IcmpCreateFile (ICMP.@)
 148  */
 149 HANDLE WINAPI IcmpCreateFile(VOID)
 150 {
 151     icmp_t* icp;
 152
 153     int sid=socket(AF_INET,SOCK_RAW,IPPROTO_ICMP);
 154     if (sid < 0) {
 155         MESSAGE("WARNING: Trying to use ICMP (network ping) will fail unless running as root\n");
 156         SetLastError(ERROR_ACCESS_DENIED);
 157         return INVALID_HANDLE_VALUE;
 158     }
 159
 160     icp=HeapAlloc(GetProcessHeap(), 0, sizeof(*icp));
 161     if (icp==NULL) {
 162         SetLastError(IP_NO_RESOURCES);
 163         return INVALID_HANDLE_VALUE;
 164     }
 165     icp->sid=sid;
 166     icp->default_opts.OptionsSize=IP_OPTS_UNKNOWN;
 167     return (HANDLE)icp;
 168 }
 169
 170
 171 /***********************************************************************
 172  *              IcmpCloseHandle (ICMP.@)
 173  */
 174 BOOL WINAPI IcmpCloseHandle(HANDLE  IcmpHandle)
 175 {
 176     icmp_t* icp=(icmp_t*)IcmpHandle;
 177     if (IcmpHandle==INVALID_HANDLE_VALUE) {
 178         /* FIXME: in fact win98 seems to ignore the handle value !!! */
 179         SetLastError(ERROR_INVALID_HANDLE);
 180         return FALSE;
 181     }
 182
 183     shutdown(icp->sid,2);
 184     HeapFree(GetProcessHeap (), 0, icp);
 185     return TRUE;
 186 }
 187
 188
 189 /***********************************************************************
 190  *              IcmpSendEcho (ICMP.@)
 191  */
 192 DWORD WINAPI IcmpSendEcho(
 193     HANDLE                   IcmpHandle,
 194     IPAddr                   DestinationAddress,
 195     LPVOID                   RequestData,
 196     WORD                     RequestSize,
 197     PIP_OPTION_INFORMATION   RequestOptions,
 198     LPVOID                   ReplyBuffer,
 199     DWORD                    ReplySize,
 200     DWORD                    Timeout
 201     )
 202 {
 203     icmp_t* icp=(icmp_t*)IcmpHandle;
 204     unsigned char* reqbuf;
 205     int reqsize;
 206
 207     struct icmp_echo_reply* ier;
 208     struct ip* ip_header;
 209     struct icmp* icmp_header;
 210     char* endbuf;
 211     int ip_header_len;
 212     int maxlen;
 213     fd_set fdr;
 214     struct timeval timeout;
 215     DWORD send_time,recv_time;
 216     struct sockaddr_in addr;
 217     unsigned int addrlen;
 218     unsigned short id,seq,cksum;
 219     int res;
 220
 221     if (IcmpHandle==INVALID_HANDLE_VALUE) {
 222         /* FIXME: in fact win98 seems to ignore the handle value !!! */
 223         SetLastError(ERROR_INVALID_HANDLE);
 224         return 0;
 225     }
 226
 227     if (ReplySize<sizeof(ICMP_ECHO_REPLY)+ICMP_MINLEN) {
 228         SetLastError(IP_BUF_TOO_SMALL);
 229         return 0;
 230     }
 231     /* check the request size against SO_MAX_MSG_SIZE using getsockopt */
 232
 233     /* Prepare the request */
 234     id=getpid() & 0xFFFF;
 235     seq=InterlockedIncrement(&icmp_sequence) & 0xFFFF;
 236
 237     reqsize=ICMP_MINLEN+RequestSize;
 238     reqbuf=HeapAlloc(GetProcessHeap(), 0, reqsize);
 239     if (reqbuf==NULL) {
 240         SetLastError(ERROR_OUTOFMEMORY);
 241         return 0;
 242     }
 243
 244     icmp_header=(struct icmp*)reqbuf;
 245     icmp_header->icmp_type=ICMP_ECHO;
 246     icmp_header->icmp_code=0;
 247     icmp_header->icmp_cksum=0;
 248     icmp_header->icmp_id=id;
 249     icmp_header->icmp_seq=seq;
 250     memcpy(reqbuf+ICMP_MINLEN, RequestData, RequestSize);
 251     icmp_header->icmp_cksum=cksum=in_cksum((u_short*)reqbuf,reqsize);
 252
 253     addr.sin_family=AF_INET;
 254     addr.sin_addr.s_addr=DestinationAddress;
 255     addr.sin_port=0;
 256
 257     if (RequestOptions!=NULL) {
 258         int val;
 259         if (icp->default_opts.OptionsSize==IP_OPTS_UNKNOWN) {
 260             unsigned int len;
 261             /* Before we mess with the options, get the default values */
 262             len=sizeof(val);
 263             getsockopt(icp->sid,IPPROTO_IP,IP_TTL,(char *)&val,&len);
 264             icp->default_opts.Ttl=val;
 265
 266             len=sizeof(val);
 267             getsockopt(icp->sid,IPPROTO_IP,IP_TOS,(char *)&val,&len);
 268             icp->default_opts.Tos=val;
 269             /* FIXME: missing: handling of IP 'flags', and all the other options */
 270         }
 271
 272         val=RequestOptions->Ttl;
 273         setsockopt(icp->sid,IPPROTO_IP,IP_TTL,(char *)&val,sizeof(val));
 274         val=RequestOptions->Tos;
 275         setsockopt(icp->sid,IPPROTO_IP,IP_TOS,(char *)&val,sizeof(val));
 276         /* FIXME:  missing: handling of IP 'flags', and all the other options */
 277
 278         icp->default_opts.OptionsSize=IP_OPTS_CUSTOM;
 279     } else if (icp->default_opts.OptionsSize==IP_OPTS_CUSTOM) {
 280         int val;
 281
 282         /* Restore the default options */
 283         val=icp->default_opts.Ttl;
 284         setsockopt(icp->sid,IPPROTO_IP,IP_TTL,(char *)&val,sizeof(val));
 285         val=icp->default_opts.Tos;
 286         setsockopt(icp->sid,IPPROTO_IP,IP_TOS,(char *)&val,sizeof(val));
 287         /* FIXME: missing: handling of IP 'flags', and all the other options */
 288
 289         icp->default_opts.OptionsSize=IP_OPTS_DEFAULT;
 290     }
 291
 292     /* Get ready for receiving the reply
 293      * Do it before we send the request to minimize the risk of introducing delays
 294      */
 295     FD_ZERO(&fdr);
 296     FD_SET(icp->sid,&fdr);
 297     timeout.tv_sec=Timeout/1000;
 298     timeout.tv_usec=(Timeout % 1000)*1000;
 299     addrlen=sizeof(addr);
 300     ier=ReplyBuffer;
 301     ip_header=(struct ip *) ((char *) ReplyBuffer+sizeof(ICMP_ECHO_REPLY));
 302     endbuf=(char *) ReplyBuffer+ReplySize;
 303     maxlen=ReplySize-sizeof(ICMP_ECHO_REPLY);
 304
 305     /* Send the packet */
 306     TRACE("Sending %d bytes (RequestSize=%d) to %s\n", reqsize, RequestSize, inet_ntoa(addr.sin_addr));
 307 #if 0
 308     if (TRACE_ON(icmp)){
 309         unsigned char* buf=(unsigned char*)reqbuf;
 310         int i;
 311         printf("Output buffer:\n");
 312         for (i=0;i<reqsize;i++)
 313             printf("%2x,", buf[i]);
 314         printf("\n");
 315     }
 316 #endif
 317
 318     send_time = GetTickCount();
 319     res=sendto(icp->sid, reqbuf, reqsize, 0, (struct sockaddr*)&addr, sizeof(addr));
 320     HeapFree(GetProcessHeap (), 0, reqbuf);
 321     if (res<0) {
 322         if (errno==EMSGSIZE)
 323             SetLastError(IP_PACKET_TOO_BIG);
 324         else {
 325             switch (errno) {
 326             case ENETUNREACH:
 327                 SetLastError(IP_DEST_NET_UNREACHABLE);
 328                 break;
 329             case EHOSTUNREACH:
 330                 SetLastError(IP_DEST_HOST_UNREACHABLE);
 331                 break;
 332             default:
 333                 TRACE("unknown error: errno=%d\n",errno);
 334                 SetLastError(IP_GENERAL_FAILURE);
 335             }
 336         }
 337         return 0;
 338     }
 339
 340     /* Get the reply */
 341     ip_header_len=0; /* because gcc was complaining */
 342     while ((res=select(icp->sid+1,&fdr,NULL,NULL,&timeout))>0) {
 343         recv_time = GetTickCount();
 344         res=recvfrom(icp->sid, (char*)ip_header, maxlen, 0, (struct sockaddr*)&addr,&addrlen);
 345         TRACE("received %d bytes from %s\n",res, inet_ntoa(addr.sin_addr));
 346         ier->Status=IP_REQ_TIMED_OUT;
 347
 348         /* Check whether we should ignore this packet */
 349         if ((ip_header->ip_p==IPPROTO_ICMP) && (res>=sizeof(struct ip)+ICMP_MINLEN)) {
 350             ip_header_len=ip_header->ip_hl << 2;
 351             icmp_header=(struct icmp*)(((char*)ip_header)+ip_header_len);
 352             TRACE("received an ICMP packet of type,code=%d,%d\n",icmp_header->icmp_type,icmp_header->icmp_code);
 353             if (icmp_header->icmp_type==ICMP_ECHOREPLY) {
 354                 if ((icmp_header->icmp_id==id) && (icmp_header->icmp_seq==seq))
 355                     ier->Status=IP_SUCCESS;
 356             } else {
 357                 switch (icmp_header->icmp_type) {
 358                 case ICMP_UNREACH:
 359                     switch (icmp_header->icmp_code) {
 360                     case ICMP_UNREACH_HOST:
 361 #ifdef ICMP_UNREACH_HOST_UNKNOWN
 362                     case ICMP_UNREACH_HOST_UNKNOWN:
 363 #endif
 364 #ifdef ICMP_UNREACH_ISOLATED
 365                     case ICMP_UNREACH_ISOLATED:
 366 #endif
 367 #ifdef ICMP_UNREACH_HOST_PROHIB
 368                     case ICMP_UNREACH_HOST_PROHIB:
 369 #endif
 370 #ifdef ICMP_UNREACH_TOSHOST
 371                     case ICMP_UNREACH_TOSHOST:
 372 #endif
 373                         ier->Status=IP_DEST_HOST_UNREACHABLE;
 374                         break;
 375                     case ICMP_UNREACH_PORT:
 376                         ier->Status=IP_DEST_PORT_UNREACHABLE;
 377                         break;
 378                     case ICMP_UNREACH_PROTOCOL:
 379                         ier->Status=IP_DEST_PROT_UNREACHABLE;
 380                         break;
 381                     case ICMP_UNREACH_SRCFAIL:
 382                         ier->Status=IP_BAD_ROUTE;
 383                         break;
 384                     default:
 385                         ier->Status=IP_DEST_NET_UNREACHABLE;
 386                     }
 387                     break;
 388                 case ICMP_TIMXCEED:
 389                     if (icmp_header->icmp_code==ICMP_TIMXCEED_REASS)
 390                         ier->Status=IP_TTL_EXPIRED_REASSEM;
 391                     else
 392                         ier->Status=IP_TTL_EXPIRED_TRANSIT;
 393                     break;
 394                 case ICMP_PARAMPROB:
 395                     ier->Status=IP_PARAM_PROBLEM;
 396                     break;
 397                 case ICMP_SOURCEQUENCH:
 398                     ier->Status=IP_SOURCE_QUENCH;
 399                     break;
 400                 }
 401                 if (ier->Status!=IP_REQ_TIMED_OUT) {
 402                     struct ip* rep_ip_header;
 403                     struct icmp* rep_icmp_header;
 404                     /* The ICMP header size of all the packets we accept is the same */
 405                     rep_ip_header=(struct ip*)(((char*)icmp_header)+ICMP_MINLEN);
 406                     rep_icmp_header=(struct icmp*)(((char*)rep_ip_header)+(rep_ip_header->ip_hl << 2));
 407
 408                     /* Make sure that this is really a reply to our packet */
 409                     if (ip_header_len+ICMP_MINLEN+(rep_ip_header->ip_hl << 2)+ICMP_MINLEN>ip_header->ip_len) {
 410                         ier->Status=IP_REQ_TIMED_OUT;
 411                     } else if ((rep_icmp_header->icmp_type!=ICMP_ECHO) ||
 412                         (rep_icmp_header->icmp_code!=0) ||
 413                         (rep_icmp_header->icmp_id!=id) ||
 414                         /* windows doesn't check this checksum, else tracert */
 415                         /* behind a Linux 2.2 masquerading firewall would fail*/
 416                         /* (rep_icmp_header->icmp_cksum!=cksum) || */
 417                         (rep_icmp_header->icmp_seq!=seq)) {
 418                         /* This was not a reply to one of our packets after all */
 419                         TRACE("skipping type,code=%d,%d id,seq=%d,%d cksum=%d\n",
 420                             rep_icmp_header->icmp_type,rep_icmp_header->icmp_code,
 421                             rep_icmp_header->icmp_id,rep_icmp_header->icmp_seq,
 422                             rep_icmp_header->icmp_cksum);
 423                         TRACE("expected type,code=8,0 id,seq=%d,%d cksum=%d\n",
 424                             id,seq,
 425                             cksum);
 426                         ier->Status=IP_REQ_TIMED_OUT;
 427                     }
 428                 }
 429             }
 430         }
 431
 432         if (ier->Status==IP_REQ_TIMED_OUT) {
 433             /* This packet was not for us.
 434              * Decrease the timeout so that we don't enter an endless loop even
 435              * if we get flooded with ICMP packets that are not for us.
 436              */
 437             int t = Timeout - (recv_time - send_time);
 438             if (t < 0) t = 0;
 439             timeout.tv_sec = t / 1000;
 440             timeout.tv_usec = (t % 1000) * 1000;
 441             continue;
 442         } else {
 443             /* This is a reply to our packet */
 444             memcpy(&ier->Address,&ip_header->ip_src,sizeof(IPAddr));
 445             /* Status is already set */
 446             ier->RoundTripTime= recv_time - send_time;
 447             ier->DataSize=res-ip_header_len-ICMP_MINLEN;
 448             ier->Reserved=0;
 449             ier->Data=endbuf-ier->DataSize;
 450             memmove(ier->Data,((char*)ip_header)+ip_header_len+ICMP_MINLEN,ier->DataSize);
 451             ier->Options.Ttl=ip_header->ip_ttl;
 452             ier->Options.Tos=ip_header->ip_tos;
 453             ier->Options.Flags=ip_header->ip_off >> 13;
 454             ier->Options.OptionsSize=ip_header_len-sizeof(struct ip);
 455             if (ier->Options.OptionsSize!=0) {
 456                 ier->Options.OptionsData=(unsigned char *) ier->Data-ier->Options.OptionsSize;
 457                 /* FIXME: We are supposed to rearrange the option's 'source route' data */
 458                 memmove(ier->Options.OptionsData,((char*)ip_header)+ip_header_len,ier->Options.OptionsSize);
 459                 endbuf=(char*)ier->Options.OptionsData;
 460             } else {
 461                 ier->Options.OptionsData=NULL;
 462                 endbuf=ier->Data;
 463             }
 464
 465             /* Prepare for the next packet */
 466             ier++;
 467             ip_header=(struct ip*)(((char*)ip_header)+sizeof(ICMP_ECHO_REPLY));
 468             maxlen=endbuf-(char*)ip_header;
 469
 470             /* Check out whether there is more but don't wait this time */
 471             timeout.tv_sec=0;
 472             timeout.tv_usec=0;
 473         }
 474         FD_ZERO(&fdr);
 475         FD_SET(icp->sid,&fdr);
 476     }
 477     res=ier-(ICMP_ECHO_REPLY*)ReplyBuffer;
 478     if (res==0)
 479         SetLastError(IP_REQ_TIMED_OUT);
 480     TRACE("received %d replies\n",res);
 481     return res;
 482 }
 483
 484 /*
 485  * Copyright (c) 1989 The Regents of the University of California.
 486  * All rights reserved.
 487  *
 488  * This code is derived from software contributed to Berkeley by
 489  * Mike Muuss.
 490  *
 491  * Redistribution and use in source and binary forms, with or without
 492  * modification, are permitted provided that the following conditions
 493  * are met:
 494  * 1. Redistributions of source code must retain the above copyright
 495  *    notice, this list of conditions and the following disclaimer.
 496  * 2. Redistributions in binary form must reproduce the above copyright
 497  *    notice, this list of conditions and the following disclaimer in the
 498  *    documentation and/or other materials provided with the distribution.
 499  * 3. Neither the name of the University nor the names of its contributors
 500  *    may be used to endorse or promote products derived from this software
 501  *    without specific prior written permission.
 502  *
 503  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 504  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 505  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 506  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 507  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 508  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 509  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 510  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 511  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 512  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 513  * SUCH DAMAGE.
 514  *
 515  */