ping.c
上传用户:atfdc5678
上传日期:2022-08-06
资源大小:61k
文件大小:13k
源码类别:

网络编程

开发平台:

Visual C++

  1. // Module Name: Ping.c
  2. //
  3. // Description:
  4. //    This sample illustrates how an ICMP ping app can be written
  5. //    using the SOCK_RAW socket type and IPPROTO_ICMP protocol.
  6. //    By creating a raw socket, the underlying layer does not change
  7. //    the protocol header so that when we submit the ICMP header
  8. //    nothing is changed so that the receiving end will see an 
  9. //    ICMP packet. Additionally, we use the record route IP option
  10. //    to get a round trip path to the endpoint. Note that the size
  11. //    of the IP option header that records the route is limited to
  12. //    nine IP addresses.
  13. //
  14. // Compile:
  15. //     cl -o Ping Ping.c ws2_32.lib /Zp1
  16. //
  17. // Command Line Options/Parameters:
  18. //     Ping [host] [packet-size]
  19. //     
  20. //     host         String name of host to ping
  21. //     packet-size  Integer size of packet to send 
  22. //                      (smaller than 1024 bytes)
  23. //
  24. //#pragma pack(1)
  25. #define WIN32_LEAN_AND_MEAN
  26. #include <winsock2.h>
  27. #include <ws2tcpip.h>
  28. #include <stdio.h>
  29. #include <stdlib.h>
  30. #define IP_RECORD_ROUTE  0x7
  31. // 
  32. // IP header structure
  33. //
  34. typedef struct _iphdr 
  35. {
  36.     unsigned int   h_len:4;        // Length of the header
  37.     unsigned int   version:4;      // Version of IP
  38.     unsigned char  tos;            // Type of service
  39.     unsigned short total_len;      // Total length of the packet
  40.     unsigned short ident;          // Unique identifier
  41.     unsigned short frag_and_flags; // Flags
  42.     unsigned char  ttl;            // Time to live
  43.     unsigned char  proto;          // Protocol (TCP, UDP etc)
  44.     unsigned short checksum;       // IP checksum
  45.     unsigned int   sourceIP;
  46.     unsigned int   destIP;
  47. } IpHeader;
  48. #define ICMP_ECHO        8
  49. #define ICMP_ECHOREPLY   0
  50. #define ICMP_MIN         8 // Minimum 8-byte ICMP packet (header)
  51. //
  52. // ICMP header structure
  53. //
  54. typedef struct _icmphdr 
  55. {
  56.     BYTE   i_type;
  57.     BYTE   i_code;                 // Type sub code
  58.     USHORT i_cksum;
  59.     USHORT i_id;
  60.     USHORT i_seq;
  61.     // This is not the standard header, but we reserve space for time
  62.     ULONG  timestamp;
  63. } IcmpHeader;
  64. //
  65. // IP option header - use with socket option IP_OPTIONS
  66. //
  67. typedef struct _ipoptionhdr
  68. {
  69.     unsigned char        code;        // Option type
  70.     unsigned char        len;         // Length of option hdr
  71.     unsigned char        ptr;         // Offset into options
  72.     unsigned long        addr[9];     // List of IP addrs
  73. } IpOptionHeader;
  74. #define DEF_PACKET_SIZE  32        // Default packet size
  75. #define MAX_PACKET       1024      // Max ICMP packet size
  76. #define MAX_IP_HDR_SIZE  60        // Max IP header size w/options
  77. BOOL  bRecordRoute;
  78. int   datasize;
  79. char *lpdest;
  80. //
  81. // Function: usage
  82. //
  83. // Description:
  84. //    Print usage information
  85. //
  86. void usage(char *progname)
  87. {
  88.     printf("usage: ping -r <host> [data size]n");
  89.     printf("       -r           record routen");
  90.     printf("        host        remote machine to pingn");
  91.     printf("        datasize    can be up to 1KBn");
  92.     ExitProcess(-1);
  93. }
  94. // 
  95. // Function: FillICMPData
  96. //
  97. // Description:
  98. //    Helper function to fill in various fields for our ICMP request
  99. //
  100. void FillICMPData(char *icmp_data, int datasize)
  101. {
  102.     IcmpHeader *icmp_hdr = NULL;
  103.     char       *datapart = NULL;
  104.     icmp_hdr = (IcmpHeader*)icmp_data;
  105.     icmp_hdr->i_type = ICMP_ECHO;        // Request an ICMP echo
  106.     icmp_hdr->i_code = 0;
  107.     icmp_hdr->i_id = (USHORT)GetCurrentProcessId();
  108.     icmp_hdr->i_cksum = 0;
  109.     icmp_hdr->i_seq = 0;
  110.   
  111.     datapart = icmp_data + sizeof(IcmpHeader);
  112.     //
  113.     // Place some junk in the buffer
  114.     //
  115.     memset(datapart,'E', datasize - sizeof(IcmpHeader));
  116. }
  117. // 
  118. // Function: checksum
  119. //
  120. // Description:
  121. //    This function calculates the 16-bit one's complement sum
  122. //    of the supplied buffer (ICMP) header
  123. //
  124. USHORT checksum(USHORT *buffer, int size) 
  125. {
  126.     unsigned long cksum=0;
  127.     while (size > 1) 
  128.     {
  129.         cksum += *buffer++;
  130.         size -= sizeof(USHORT);
  131.     }
  132.     if (size) 
  133.     {
  134.         cksum += *(UCHAR*)buffer;
  135.     }
  136.     cksum = (cksum >> 16) + (cksum & 0xffff);
  137.     cksum += (cksum >>16);
  138.     return (USHORT)(~cksum);
  139. }
  140. //
  141. // Function: DecodeIPOptions
  142. //
  143. // Description:
  144. //    If the IP option header is present, find the IP options
  145. //    within the IP header and print the record route option
  146. //    values
  147. //
  148. void DecodeIPOptions(char *buf, int bytes)
  149. {
  150.     IpOptionHeader *ipopt = NULL;
  151.     IN_ADDR         inaddr;
  152.     int             i;
  153.     HOSTENT        *host = NULL;
  154.     ipopt = (IpOptionHeader *)(buf + 20);
  155.     printf("RR:   ");
  156.     for(i = 0; i < (ipopt->ptr / 4) - 1; i++)
  157.     {
  158.         inaddr.S_un.S_addr = ipopt->addr[i];
  159.         if (i != 0)
  160.             printf("      ");
  161.         host = gethostbyaddr((char *)&inaddr.S_un.S_addr,
  162.                     sizeof(inaddr.S_un.S_addr), AF_INET);
  163.         if (host)
  164.             printf("(%-15s) %sn", inet_ntoa(inaddr), host->h_name);
  165.         else
  166.             printf("(%-15s)n", inet_ntoa(inaddr));
  167.     }
  168.     return;
  169. }
  170. //
  171. // Function: DecodeICMPHeader
  172. //
  173. // Description:
  174. //    The response is an IP packet. We must decode the IP header to
  175. //    locate the ICMP data.
  176. //
  177. void DecodeICMPHeader(char *buf, int bytes, 
  178.     struct sockaddr_in *from)
  179. {
  180.     IpHeader       *iphdr = NULL;
  181.     IcmpHeader     *icmphdr = NULL;
  182.     unsigned short  iphdrlen;
  183.     DWORD           tick;
  184.     static   int    icmpcount = 0;
  185.     iphdr = (IpHeader *)buf;
  186. // Number of 32-bit words * 4 = bytes
  187.     iphdrlen = iphdr->h_len * 4;
  188.     tick = GetTickCount();
  189.     if ((iphdrlen == MAX_IP_HDR_SIZE) && (!icmpcount))
  190.         DecodeIPOptions(buf, bytes);
  191.     if (bytes  < iphdrlen + ICMP_MIN) 
  192.     {
  193.         printf("Too few bytes from %sn", 
  194.             inet_ntoa(from->sin_addr));
  195.     }
  196.     icmphdr = (IcmpHeader*)(buf + iphdrlen);
  197.     if (icmphdr->i_type != ICMP_ECHOREPLY) 
  198.     {
  199.         printf("nonecho type %d recvdn", icmphdr->i_type);
  200.         return;
  201.     }
  202.     // Make sure this is an ICMP reply to something we sent!
  203.     //
  204.     if (icmphdr->i_id != (USHORT)GetCurrentProcessId()) 
  205.     {
  206.         printf("someone else's packet!n");
  207.         return ;
  208.     }
  209.     printf("%d bytes from %s:", bytes, inet_ntoa(from->sin_addr));
  210.     printf(" icmp_seq = %d. ", icmphdr->i_seq);
  211.     printf(" time: %d ms", tick - icmphdr->timestamp);
  212.     printf("n");
  213.     icmpcount++;
  214.     return;
  215. }
  216. void ValidateArgs(int argc, char **argv)
  217. {
  218.     int                i;
  219.     bRecordRoute = FALSE;
  220.     lpdest = NULL;
  221.     datasize = DEF_PACKET_SIZE;
  222.     
  223.     for(i = 1; i < argc; i++)
  224.     {
  225.         if ((argv[i][0] == '-') || (argv[i][0] == '/'))
  226.         {
  227.             switch (tolower(argv[i][1]))
  228.             {
  229.                 case 'r':        // Record route option
  230.                     bRecordRoute = TRUE;
  231.                     break;
  232.                 default:
  233.                     usage(argv[0]);
  234.                     break;
  235.             }
  236.         }
  237.         else if (isdigit(argv[i][0]))
  238.             datasize = atoi(argv[i]);
  239.         else
  240.             lpdest = argv[i];
  241.     }
  242. }
  243.         
  244. //
  245. // Function: main
  246. //
  247. // Description:
  248. //    Setup the ICMP raw socket, and create the ICMP header. Add
  249. //    the appropriate IP option header, and start sending ICMP
  250. //    echo requests to the endpoint. For each send and receive,
  251. //    we set a timeout value so that we don't wait forever for a 
  252. //    response in case the endpoint is not responding. When we
  253. //    receive a packet decode it.
  254. //
  255. int main(int argc, char **argv)
  256. {
  257.     WSADATA            wsaData;
  258.     SOCKET             sockRaw = INVALID_SOCKET;
  259.     struct sockaddr_in dest,
  260.                        from;
  261.     int                bread,
  262.                        fromlen = sizeof(from),
  263.                        timeout = 1000,
  264.                        ret;
  265.     char              *icmp_data = NULL,
  266.                       *recvbuf = NULL;
  267.     unsigned int       addr = 0;
  268.     USHORT             seq_no = 0;
  269.     struct hostent    *hp = NULL;
  270.     IpOptionHeader     ipopt;
  271.     if (WSAStartup(MAKEWORD(2, 2), &wsaData) != 0)
  272.     {
  273.         printf("WSAStartup() failed: %dn", GetLastError());
  274.         return -1;
  275.     }
  276.     ValidateArgs(argc, argv);
  277.     //
  278.     // WSA_FLAG_OVERLAPPED flag is required for SO_RCVTIMEO, 
  279.     // SO_SNDTIMEO option. If NULL is used as last param for 
  280.     // WSASocket, all I/O on the socket is synchronous, the 
  281.     // internal user mode wait code never gets a chance to 
  282.     // execute, and therefore kernel-mode I/O blocks forever. 
  283.     // A socket created via the socket function has the over-
  284.  // lapped I/O attribute set internally. But here we need 
  285.  // to use WSASocket to specify a raw socket.
  286.     //
  287.     // If you want to use timeout with a synchronous 
  288.     // nonoverlapped socket created by WSASocket with last 
  289.  // param set to NULL, you can set the timeout by using 
  290.  // the select function, or you can use WSAEventSelect and 
  291.  // set the timeout in the WSAWaitForMultipleEvents 
  292.  // function.
  293.     //
  294.     sockRaw = WSASocket (AF_INET, SOCK_RAW, IPPROTO_ICMP, NULL, 0,
  295.                          WSA_FLAG_OVERLAPPED);
  296.     if (sockRaw == INVALID_SOCKET) 
  297.     {
  298.         printf("WSASocket() failed: %dn", WSAGetLastError());
  299.         return -1;
  300.     }
  301.     if (bRecordRoute)
  302.     {
  303.         // Setup the IP option header to go out on every ICMP packet
  304.         //
  305.         ZeroMemory(&ipopt, sizeof(ipopt));
  306.         ipopt.code = IP_RECORD_ROUTE; // Record route option
  307.         ipopt.ptr  = 4;               // Point to the first addr offset
  308.         ipopt.len  = 39;              // Length of option header
  309.   
  310.         ret = setsockopt(sockRaw, IPPROTO_IP, IP_OPTIONS, 
  311.             (char *)&ipopt, sizeof(ipopt));
  312.         if (ret == SOCKET_ERROR)
  313.         {
  314.             printf("setsockopt(IP_OPTIONS) failed: %dn", 
  315.                 WSAGetLastError());
  316.         }
  317.     }
  318.     // Set the send/recv timeout values
  319.     //
  320.     bread = setsockopt(sockRaw, SOL_SOCKET, SO_RCVTIMEO, 
  321.                 (char*)&timeout, sizeof(timeout));
  322.     if(bread == SOCKET_ERROR) 
  323.     {
  324.         printf("setsockopt(SO_RCVTIMEO) failed: %dn", 
  325.             WSAGetLastError());
  326.         return -1;
  327.     }
  328.     timeout = 1000;
  329.     bread = setsockopt(sockRaw, SOL_SOCKET, SO_SNDTIMEO, 
  330.                 (char*)&timeout, sizeof(timeout));
  331.     if (bread == SOCKET_ERROR) 
  332.     {
  333.         printf("setsockopt(SO_SNDTIMEO) failed: %dn", 
  334.             WSAGetLastError());
  335.         return -1;
  336.     }
  337.     memset(&dest, 0, sizeof(dest));
  338.     //
  339.     // Resolve the endpoint's name if necessary
  340.     //
  341.     dest.sin_family = AF_INET;
  342.     if ((dest.sin_addr.s_addr = inet_addr(lpdest)) == INADDR_NONE)
  343.     {
  344.         if ((hp = gethostbyname(lpdest)) != NULL)
  345.         {
  346.             memcpy(&(dest.sin_addr), hp->h_addr, hp->h_length);
  347.             dest.sin_family = hp->h_addrtype;
  348.             printf("dest.sin_addr = %sn", inet_ntoa(dest.sin_addr));
  349.         }
  350.         else
  351.         {
  352.             printf("gethostbyname() failed: %dn", 
  353.                 WSAGetLastError());
  354.             return -1;
  355.         }
  356.     }        
  357.     // 
  358.     // Create the ICMP packet
  359.     //       
  360.     datasize += sizeof(IcmpHeader);  
  361.     icmp_data = HeapAlloc(GetProcessHeap(), HEAP_ZERO_MEMORY,
  362.                   MAX_PACKET);
  363.     recvbuf = HeapAlloc(GetProcessHeap(), HEAP_ZERO_MEMORY,
  364.                   MAX_PACKET);
  365.     if (!icmp_data) 
  366.     {
  367.         printf("HeapAlloc() failed: %dn", GetLastError());
  368.         return -1;
  369.     }
  370.     memset(icmp_data,0,MAX_PACKET);
  371.     FillICMPData(icmp_data,datasize);
  372.     //
  373.     // Start sending/receiving ICMP packets
  374.     //
  375.     while(1) 
  376.     {
  377.         static int nCount = 0;
  378.         int        bwrote;
  379.                 
  380.         if (nCount++ == 4) 
  381.             break;
  382.                 
  383.         ((IcmpHeader*)icmp_data)->i_cksum = 0;
  384.         ((IcmpHeader*)icmp_data)->timestamp = GetTickCount();
  385.         ((IcmpHeader*)icmp_data)->i_seq = seq_no++;
  386.         ((IcmpHeader*)icmp_data)->i_cksum = 
  387.             checksum((USHORT*)icmp_data, datasize);
  388.         bwrote = sendto(sockRaw, icmp_data, datasize, 0, 
  389.                      (struct sockaddr*)&dest, sizeof(dest));
  390.         if (bwrote == SOCKET_ERROR)
  391.         {
  392.             if (WSAGetLastError() == WSAETIMEDOUT) 
  393.             {
  394.                 printf("timed outn");
  395.                 continue;
  396.             }
  397.             printf("sendto() failed: %dn", WSAGetLastError());
  398.             return -1;
  399.         }
  400.         if (bwrote < datasize) 
  401.         {
  402.             printf("Wrote %d bytesn", bwrote);
  403.         }
  404.         bread = recvfrom(sockRaw, recvbuf, MAX_PACKET, 0, 
  405.                     (struct sockaddr*)&from, &fromlen);
  406.         if (bread == SOCKET_ERROR)
  407.         {
  408.             if (WSAGetLastError() == WSAETIMEDOUT) 
  409.             {
  410.                 printf("timed outn");
  411.                 continue;
  412.             }
  413.             printf("recvfrom() failed: %dn", WSAGetLastError());
  414.             return -1;
  415.         }
  416.         DecodeICMPHeader(recvbuf, bread, &from);
  417.         Sleep(1000);
  418.     }
  419.     // Cleanup
  420.     //
  421.     if (sockRaw != INVALID_SOCKET) 
  422.         closesocket(sockRaw);
  423.     HeapFree(GetProcessHeap(), 0, recvbuf);
  424.     HeapFree(GetProcessHeap(), 0, icmp_data);
  425.     WSACleanup();
  426.     return 0;
  427. }