Subversion Repositories Kolibri OS

Rev

Rev 261 | Go to most recent revision | Blame | Last modification | View Log | Download | RSS feed

  1. $Revision: 425 $
  2. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  3. ;;
  4. ;;  ICMP.INC
  5. ;;
  6. ;;  Internet Control Message Protocol ( RFC 792 )
  7. ;;
  8. ;;  Last revision: 11.11.2006
  9. ;;
  10. ;;  This file contains the following:
  11. ;;   icmp_rx - processes ICMP-packets received by the IP layer
  12. ;;
  13. ;;  Changes history:
  14. ;;   22.09.2003 - [Mike Hibbett] : mikeh@oceanfree.net
  15. ;;   11.11.2006 - [Johnny_B] and [smb]
  16. ;;
  17. ;;   Current status:
  18. ;;      This implemetation of ICMP proto supports message of ECHO type.
  19. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  20.  
  21.  
  22. struc ICMP_PACKET
  23. {  .Type            db   ?  ;+00
  24.    .Code            db   ?  ;+01
  25.    .Checksum        dw   ?  ;+02
  26.    .Identifier      dw   ?  ;+04
  27.    .SequenceNumber  dw   ?  ;+06
  28.    .Data            db   ?  ;+08
  29. }
  30.  
  31. virtual at 0
  32.   ICMP_PACKET ICMP_PACKET
  33. end virtual
  34.  
  35.  
  36. ;   Example:
  37. ;       ECHO message format
  38. ;
  39. ;
  40. ;           0               1               2               3
  41. ;    0 1 2 3 4 5 6 7 0 1 2 3 4 5 6 7 0 1 2 3 4 5 6 7 0 1 2 3 4 5 6 7
  42. ;   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
  43. ;   |     Type      |     Code      |          Checksum             |
  44. ;   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
  45. ;   |           Identifier          |        Sequence Number        |
  46. ;   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
  47. ;   |     Data ...
  48. ;   +-+-+-+-+-
  49. ;
  50.  
  51. ;
  52. ; ICMP types & codes, RFC 792 and FreeBSD's ICMP sources
  53. ;
  54.  
  55. ICMP_ECHOREPLY          equ     0               ; echo reply message
  56.  
  57. ICMP_UNREACH            equ     3
  58.         ICMP_UNREACH_NET        equ     0               ; bad net
  59.         ICMP_UNREACH_HOST       equ     1               ; bad host
  60.         ICMP_UNREACH_PROTOCOL   equ     2               ; bad protocol
  61.         ICMP_UNREACH_PORT       equ     3               ; bad port
  62.         ICMP_UNREACH_NEEDFRAG   equ     4               ; IP_DF caused drop
  63.         ICMP_UNREACH_SRCFAIL    equ     5               ; src route failed
  64.         ICMP_UNREACH_NET_UNKNOWN equ    6               ; unknown net
  65.         ICMP_UNREACH_HOST_UNKNOWN equ   7               ; unknown host
  66.         ICMP_UNREACH_ISOLATED   equ     8               ; src host isolated
  67.         ICMP_UNREACH_NET_PROHIB equ     9               ; prohibited access
  68.         ICMP_UNREACH_HOST_PROHIB equ    10              ; ditto
  69.         ICMP_UNREACH_TOSNET     equ     11              ; bad tos for net
  70.         ICMP_UNREACH_TOSHOST    equ     12              ; bad tos for host
  71.         ICMP_UNREACH_FILTER_PROHIB equ  13              ; admin prohib
  72.         ICMP_UNREACH_HOST_PRECEDENCE equ 14             ; host prec vio.
  73.         ICMP_UNREACH_PRECEDENCE_CUTOFF equ 15           ; prec cutoff
  74.  
  75. ICMP_SOURCEQUENCH       equ     4               ; packet lost, slow down
  76.  
  77. ICMP_REDIRECT           equ     5               ; shorter route, codes:
  78.         ICMP_REDIRECT_NET       equ     0               ; for network
  79.         ICMP_REDIRECT_HOST      equ     1               ; for host
  80.         ICMP_REDIRECT_TOSNET    equ     2               ; for tos and net
  81.         ICMP_REDIRECT_TOSHOST   equ     3               ; for tos and host
  82.        
  83. ICMP_ALTHOSTADDR        equ     6               ; alternate host address
  84. ICMP_ECHO               equ     8               ; echo service
  85. ICMP_ROUTERADVERT       equ     9               ; router advertisement
  86.         ICMP_ROUTERADVERT_NORMAL equ 0                  ; normal advertisement
  87.         ICMP_ROUTERADVERT_NOROUTE_COMMON equ 16         ; selective routing
  88.  
  89. ICMP_ROUTERSOLICIT      equ     10              ; router solicitation
  90. ICMP_TIMXCEED           equ     11              ; time exceeded, code:
  91.     ICMP_TIMXCEED_INTRANS       equ     0               ; ttl==0 in transit
  92.     ICMP_TIMXCEED_REASS equ     1               ; ttl==0 in reass
  93.  
  94. ICMP_PARAMPROB            equ  12               ; ip header bad
  95.     ICMP_PARAMPROB_ERRATPTR   equ  0            ; error at param ptr
  96.     ICMP_PARAMPROB_OPTABSENT  equ  1            ; req. opt. absent
  97.     ICMP_PARAMPROB_LENGTH     equ  2            ; bad length
  98.        
  99. ICMP_TSTAMP             equ     13              ; timestamp request
  100. ICMP_TSTAMPREPLY        equ     14              ; timestamp reply
  101. ICMP_IREQ               equ     15              ; information request
  102. ICMP_IREQREPLY          equ     16              ; information reply
  103. ICMP_MASKREQ            equ     17              ; address mask request
  104. ICMP_MASKREPLY          equ     18              ; address mask reply
  105. ICMP_TRACEROUTE         equ     30              ; traceroute
  106. ICMP_DATACONVERR        equ     31              ; data conversion error
  107. ICMP_MOBILE_REDIRECT    equ     32              ; mobile host redirect
  108. ICMP_IPV6_WHEREAREYOU   equ     33              ; IPv6 where-are-you
  109.  ICMP_IPV6_IAMHERE      equ     34              ; IPv6 i-am-here
  110. ICMP_MOBILE_REGREQUEST  equ     35              ; mobile registration req
  111. ICMP_MOBILE_REGREPLY    equ     36              ; mobile registreation reply
  112. ICMP_SKIP               equ     39              ; SKIP
  113.  
  114. ICMP_PHOTURIS           equ     40              ; Photuris
  115.     ICMP_PHOTURIS_UNKNOWN_INDEX   equ  1                ; unknown sec index
  116.     ICMP_PHOTURIS_AUTH_FAILED     equ  2                ; auth failed
  117.     ICMP_PHOTURIS_DECRYPT_FAILED  equ  3                ; decrypt failed
  118.  
  119.  
  120. ;***************************************************************************
  121. ;   Function
  122. ;      icmp_rx  [by Johnny_B]
  123. ;
  124. ;   Description
  125. ;       ICMP protocol handler
  126. ;       This is a kernel function, called by ip_rx
  127. ;
  128. ;  IN:
  129. ;    buffer_number  - # of IP-buffer. This buffer must be reused or marked as empty afterwards
  130. ;    IPPacketBase   - IP_PACKET base address
  131. ;    IPHeaderLength - Header length of IP_PACKET
  132. ;
  133. ;  OUT:
  134. ;    EAX=not defined
  135. ;
  136. ;           All used registers will be saved
  137. ;
  138. ;***************************************************************************
  139. proc icmp_rx  stdcall  uses ebx esi edi,\
  140.     buffer_number:DWORD,IPPacketBase:DWORD,IPHeaderLength:DWORD
  141.  
  142.     mov     esi,[IPPacketBase]   ;esi=IP_PACKET base address
  143.     mov     edi, esi
  144.     add     edi,[IPHeaderLength] ;edi=ICMP_PACKET base address
  145.  
  146.     cmp     byte[edi + ICMP_PACKET.Type], ICMP_ECHO ; Is this an echo request? discard if not
  147.     jz      .icmp_echo
  148.  
  149.     mov     eax, [buffer_number]
  150.     call    freeBuff
  151.     jmp     .exit
  152.  
  153.   .icmp_echo:
  154.  
  155.     ; swap the source and destination addresses
  156.     mov     ecx, [esi + IP_PACKET.DestinationAddress]
  157.     mov     ebx, [esi + IP_PACKET.SourceAddress]
  158.     mov     [esi + IP_PACKET.DestinationAddress], ebx
  159.     mov     [esi + IP_PACKET.SourceAddress], ecx
  160.  
  161.     ; recalculate the IP header checksum
  162.     mov     eax,[IPHeaderLength]
  163.     stdcall checksum_jb,esi,eax   ;buf_ptr,buf_size
  164.  
  165.     mov     byte[esi + IP_PACKET.HeaderChecksum], ah
  166.     mov     byte[esi + IP_PACKET.HeaderChecksum + 1], al      ; ?? correct byte order?
  167.  
  168.     mov     byte[edi + ICMP_PACKET.Type], ICMP_ECHOREPLY  ; change the request to a response
  169.     mov     word[edi + ICMP_PACKET.Checksum], 0  ; clear ICMP checksum prior to re-calc
  170.  
  171.     ; Calculate the length of the ICMP data ( IP payload)
  172.     xor     eax, eax
  173.     mov     ah, byte[esi + IP_PACKET.TotalLength]
  174.     mov     al, byte[esi + IP_PACKET.TotalLength + 1]
  175.     sub     ax, word[IPHeaderLength]  ;ax=ICMP-packet length
  176.  
  177.     stdcall checksum_jb,edi,eax   ;buf_ptr,buf_size
  178.  
  179.     mov     byte[edi + ICMP_PACKET.Checksum], ah
  180.     mov     byte[edi + ICMP_PACKET.Checksum + 1], al
  181.  
  182.     ; Queue packet for transmission
  183.     mov     ebx, [buffer_number]
  184.     mov     eax, NET1OUT_QUEUE
  185.     call    queue
  186.  
  187.   .exit:
  188.     ret
  189. endp