Subversion Repositories Kolibri OS

Rev

Rev 261 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
425 victor 1
$Revision: 425 $
261 hidnplayr 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