Subversion Repositories Kolibri OS

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

;;                                                                 ;;

;; Copyright (C) KolibriOS team 2004-2022. All rights reserved.    ;;

;; Distributed under terms of the GNU General Public License       ;;

;;                                                                 ;;

;;  ICMP.INC                                                       ;;

;;                                                                 ;;

;;  Part of the tcp/ip network stack for KolibriOS                 ;;

;;                                                                 ;;

;;  Based on the work of [Johnny_B] and [smb]                      ;;

;;                                                                 ;;

;;    Written by hidnplayr@kolibrios.org                           ;;

;;                                                                 ;;

;;          GNU GENERAL PUBLIC LICENSE                             ;;

;;             Version 2, June 1991                                ;;

;;                                                                 ;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

$Revision: 9816 $

; ICMP types & codes

ICMP_ECHOREPLY                  = 0             ; echo reply message

ICMP_UNREACH                    = 3

ICMP_UNREACH_NET                = 0             ; bad net

ICMP_UNREACH_HOST               = 1             ; bad host

ICMP_UNREACH_PROTOCOL           = 2             ; bad protocol

ICMP_UNREACH_PORT               = 3             ; bad port

ICMP_UNREACH_NEEDFRAG           = 4             ; IP_DF caused drop

ICMP_UNREACH_SRCFAIL            = 5             ; src route failed

ICMP_UNREACH_NET_UNKNOWN        = 6             ; unknown net

ICMP_UNREACH_HOST_UNKNOWN       = 7             ; unknown host

ICMP_UNREACH_ISOLATED           = 8             ; src host isolated

ICMP_UNREACH_NET_PROHIB         = 9             ; prohibited access

ICMP_UNREACH_HOST_PROHIB        = 10            ; ditto

ICMP_UNREACH_TOSNET             = 11            ; bad tos for net

ICMP_UNREACH_TOSHOST            = 12            ; bad tos for host

ICMP_UNREACH_FILTER_PROHIB      = 13            ; admin prohib

ICMP_UNREACH_HOST_PRECEDENCE    = 14            ; host prec vio.

ICMP_UNREACH_PRECEDENCE_CUTOFF  = 15            ; prec cutoff

ICMP_SOURCEQUENCH               = 4             ; Packet lost, slow down

ICMP_REDIRECT                   = 5             ; shorter route, codes:

ICMP_REDIRECT_NET               = 0             ; for network

ICMP_REDIRECT_HOST              = 1             ; for host

ICMP_REDIRECT_TOSNET            = 2             ; for tos and net

ICMP_REDIRECT_TOSHOST           = 3             ; for tos and host

ICMP_ALTHOSTADDR                = 6             ; alternate host address

ICMP_ECHO                       = 8             ; echo service

ICMP_ROUTERADVERT               = 9             ; router advertisement

ICMP_ROUTERADVERT_NORMAL        = 0             ; normal advertisement

ICMP_ROUTERADVERT_NOROUTE_COMMON= 16            ; selective routing

ICMP_ROUTERSOLICIT              = 10            ; router solicitation

ICMP_TIMXCEED                   = 11            ; time exceeded, code:

ICMP_TIMXCEED_INTRANS           = 0             ; ttl==0 in transit

ICMP_TIMXCEED_REASS             = 1             ; ttl==0 in reass

ICMP_PARAMPROB                  = 12            ; ip header bad

ICMP_PARAMPROB_ERRATPTR         = 0             ; error at param ptr

ICMP_PARAMPROB_OPTABSENT        = 1             ; req. opt. absent

ICMP_PARAMPROB_LENGTH           = 2             ; bad length

ICMP_TSTAMP                     = 13            ; timestamp request

ICMP_TSTAMPREPLY                = 14            ; timestamp reply

ICMP_IREQ                       = 15            ; information request

ICMP_IREQREPLY                  = 16            ; information reply

ICMP_MASKREQ                    = 17            ; address mask request

ICMP_MASKREPLY                  = 18            ; address mask reply

ICMP_TRACEROUTE                 = 30            ; traceroute

ICMP_DATACONVERR                = 31            ; data conversion error

ICMP_MOBILE_REDIRECT            = 32            ; mobile host redirect

ICMP_IPV6_WHEREAREYOU           = 33            ; IPv6 where-are-you

ICMP_IPV6_IAMHERE               = 34            ; IPv6 i-am-here

ICMP_MOBILE_REGREQUEST          = 35            ; mobile registration req

ICMP_MOBILE_REGREPLY            = 36            ; mobile registreation reply

ICMP_SKIP                       = 39            ; SKIP

ICMP_PHOTURIS                   = 40            ; Photuris

ICMP_PHOTURIS_UNKNOWN_INDEX     = 1             ; unknown sec index

ICMP_PHOTURIS_AUTH_FAILED       = 2             ; auth failed

ICMP_PHOTURIS_DECRYPT_FAILED    = 3             ; decrypt failed

struct  ICMP_header

        Type                    db ?

        Code                    db ?

        Checksum                dw ?

        Identifier              dw ?

        SequenceNumber          dw ?

ends

uglobal

align 4

        ICMP_packets_tx         rd NET_DEVICES_MAX

        ICMP_packets_rx         rd NET_DEVICES_MAX

endg

;-----------------------------------------------------------------;

;                                                                 ;

; ICMP_init                                                       ;

;                                                                 ;

;-----------------------------------------------------------------;

macro icmp_init {

        xor     eax, eax

        mov     edi, ICMP_packets_tx

        mov     ecx, 2*NET_DEVICES_MAX

        rep stosd

}

;-----------------------------------------------------------------;

;                                                                 ;

; icmp_input: Send a reply's to an ICMP echo or insert packets    ;

; into socket.                                                    ;

;                                                                 ;

;  IN:  [esp] = ptr to buffer                                     ;

;       ebx = ptr to device struct                                ;

;       ecx = ICMP Packet size                                    ;

;       edx = ptr to IPv4 header                                  ;

;       esi = ptr to ICMP Packet data                             ;

;       edi = interface number*4                                  ;

;                                                                 ;

;  OUT: /                                                         ;

;                                                                 ;

;-----------------------------------------------------------------;

align 4

icmp_input:

        DEBUGF  DEBUG_NETWORK_VERBOSE, "ICMP_input\n"

; Dump all multicasts and broadcasts

        mov     eax, [IPv4_address + edi]

        cmp     eax, [edx + IPv4_header.DestinationAddress]

        jne     .dump

; Check the checksum

        push    esi ecx edx

        push    [esi + ICMP_header.Checksum]

        mov     [esi + ICMP_header.Checksum], 0

        xor     edx, edx

        call    checksum_1

        call    checksum_2

        pop     si

        cmp     dx, si

        pop     edx ecx esi

        jne     .checksum_mismatch

        DEBUGF  DEBUG_NETWORK_VERBOSE, "ICMP_input: Checksum OK\n"

; Update stats

        inc     [ICMP_packets_rx + edi]

; Is this an echo request?

        cmp     [esi + ICMP_header.Type], ICMP_ECHO

        je      .echo_request

; Look for an open ICMP socket

        pusha

        mov     ecx, socket_mutex

        call    mutex_lock

        popa

        add     ecx, esi

        sub     ecx, edx

        mov     esi, edx

        mov     eax, net_sockets

  .next_socket:

        mov     eax, [eax + SOCKET.NextPtr]

        or      eax, eax

        jz      .dump_

        cmp     [eax + SOCKET.Domain], AF_INET4

        jne     .next_socket

        cmp     [eax + SOCKET.Protocol], IP_PROTO_ICMP

        jne     .next_socket

        pusha

        mov     ecx, socket_mutex

        call    mutex_unlock

        popa

        DEBUGF  DEBUG_NETWORK_VERBOSE, "socket=%x\n", eax

        pusha

        lea     ecx, [eax + SOCKET.mutex]

        call    mutex_lock

        popa

        jmp     socket_input</