WebSVN – Kolibri OS – Diff – /kernel/branches/Kolibri-acpi/network/loopback.inc


;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                                                 ;;
;; Copyright (C) KolibriOS team 2004-2015. All rights reserved.    ;;
;; Distributed under terms of the GNU General Public License       ;;
;;                                                                 ;;
;;  loopback.inc                                                   ;;
;;                                                                 ;;
;;  LoopBack device for KolibriOS                                  ;;
;;                                                                 ;;
;;    Written by hidnplayr@kolibrios.org                           ;;
;;                                                                 ;;
;;          GNU GENERAL PUBLIC LICENSE                             ;;
;;             Version 2, June 1991                                ;;
;;                                                                 ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
$Revision: 6011 $
 
iglobal
align 4
 
LOOPBACK_DEVICE:
 
        .device_type    dd NET_DEVICE_LOOPBACK
        .mtu            dd 4096
        .name           dd .namestr
 
        .unload         dd .dummy_fn
        .reset          dd .dummy_fn
        .transmit       dd loop_input
 
        .bytes_tx       dq 0
        .bytes_rx       dq 0
        .packets_tx     dd 0
        .packets_rx     dd 0
 
        .link_state     dd -1
        .hwacc          dd NET_HWACC_TCP_IPv4_IN + NET_HWACC_TCP_IPv4_OUT
 
        .namestr        db 'loopback', 0
 
        .dummy_fn:
        ret
 
endg
 
 
macro   loop_init {
local   .fail
 
        mov     ebx, LOOPBACK_DEVICE
        call    net_add_device
 
        cmp     eax, -1
        je      .fail
 
        mov     [IP_LIST], 127 + 1 shl 24
        mov     [SUBNET_LIST], 255
        mov     [BROADCAST_LIST], 0xffffff00 + 127
 
  .fail:
}
 
;-----------------------------------------------------------------;
;                                                                 ;
; loop_input                                                      ;
;                                                                 ;
;   IN: [esp+4] = Pointer to buffer                               ;
;                                                                 ;
;  OUT: /                                                         ;
;                                                                 ;
;-----------------------------------------------------------------;
align 4
loop_input:
 
        mov     eax, [esp+4]
 
; Update stats
        inc     [LOOPBACK_DEVICE.packets_rx]
 
        mov     ecx, [eax + NET_BUFF.length]
        add     dword[LOOPBACK_DEVICE.bytes_rx], ecx
        adc     dword[LOOPBACK_DEVICE.bytes_rx + 4], 0
 
        DEBUGF  DEBUG_NETWORK_VERBOSE, "LOOP_input: ptr=%x size=%u\n", eax, ecx
 
; Reverse buffptr and returnaddr on stack
        pop     edx edi
        push    edx edi
 
; Set registers for protocol handlers
        lea     edx, [eax + NET_BUFF.data]
        mov     ebx, [eax + NET_BUFF.device]
        mov     eax, [eax + NET_BUFF.type]
 
; Place protocol handlers here
        cmp     eax, AF_INET4
        je      ipv4_input
 
        DEBUGF  DEBUG_NETWORK_VERBOSE, "LOOP_input: Unknown packet type=%x\n", eax
 
  .dump:
        DEBUGF  DEBUG_NETWORK_VERBOSE, "LOOP_input: dumping\n"
        call    net_buff_free
        ret
 
 
;-----------------------------------------------------------------;
;                                                                 ;
; loop_output                                                     ;
;                                                                 ;
;  IN:  ecx = packet size                                         ;
;       edi = address family                                      ;
;                                                                 ;
; OUT:  eax = start of net frame / 0 on error                     ;
;       ebx = to device structure                                 ;
;       ecx = unchanged (packet size of embedded data)            ;
;       edi = start of payload                                    ;
;                                                                 ;
;-----------------------------------------------------------------;
align 4
loop_output:
 
        DEBUGF  DEBUG_NETWORK_VERBOSE, "LOOP_output\n"
 
        cmp     ecx, [LOOPBACK_DEVICE.mtu]
        ja      .too_large
 
        push    ecx edi
        add     ecx, NET_BUFF.data
        stdcall net_buff_alloc, ecx
        test    eax, eax
        jz      .out_of_ram
 
        pop     edi
        mov     [eax + NET_BUFF.type], edi
        mov     ebx, LOOPBACK_DEVICE
        mov     [eax + NET_BUFF.device], ebx
        pop     ecx
        mov     [eax + NET_BUFF.length], ecx
        lea     edi, [eax + NET_BUFF.data]
 
        inc     [LOOPBACK_DEVICE.packets_tx]
        add     dword[LOOPBACK_DEVICE.bytes_tx], ecx
        adc     dword[LOOPBACK_DEVICE.bytes_tx + 4], 0
 
        DEBUGF  DEBUG_NETWORK_VERBOSE, "LOOP_output: ptr=%x size=%u\n", eax, ecx
        ret
 
  .too_large:
        DEBUGF  DEBUG_NETWORK_ERROR, "LOOP_output: packet is too large\n"
        xor     eax, eax
        ret
 
  .out_of_ram:
        DEBUGF  DEBUG_NETWORK_ERROR, "LOOP_output: out of memory\n"
        add     esp, 4+4
        xor     eax, eax
        ret

Rev 5984	Rev 6078
1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2	;; ;;	2	;; ;;
3	;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;	3	;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;
4	;; Distributed under terms of the GNU General Public License ;;	4	;; Distributed under terms of the GNU General Public License ;;
5	;; ;;	5	;; ;;
6	;; loopback.inc ;;	6	;; loopback.inc ;;
7	;; ;;	7	;; ;;
8	;; LoopBack device for KolibriOS ;;	8	;; LoopBack device for KolibriOS ;;
9	;; ;;	9	;; ;;
10	;; Written by hidnplayr@kolibrios.org ;;	10	;; Written by hidnplayr@kolibrios.org ;;
11	;; ;;	11	;; ;;
12	;; GNU GENERAL PUBLIC LICENSE ;;	12	;; GNU GENERAL PUBLIC LICENSE ;;
13	;; Version 2, June 1991 ;;	13	;; Version 2, June 1991 ;;
14	;; ;;	14	;; ;;
15	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	15	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
16		16
17	$Revision: 5976 $	17	$Revision: 6011 $
18		18
19	iglobal	19	iglobal
20	align 4	20	align 4
21		21
22	LOOPBACK_DEVICE:	22	LOOPBACK_DEVICE:
23		23
24	.device_type dd NET_DEVICE_LOOPBACK	24	.device_type dd NET_DEVICE_LOOPBACK
25	.mtu dd 4096	25	.mtu dd 4096
26	.name dd .namestr	26	.name dd .namestr
27		27
28	.unload dd .dummy_fn	28	.unload dd .dummy_fn
29	.reset dd .dummy_fn	29	.reset dd .dummy_fn
30	.transmit dd LOOP_input	30	.transmit dd loop_input
31		31
32	.bytes_tx dq 0	32	.bytes_tx dq 0
33	.bytes_rx dq 0	33	.bytes_rx dq 0
34	.packets_tx dd 0	34	.packets_tx dd 0
35	.packets_rx dd 0	35	.packets_rx dd 0
36		36
37	.link_state dd -1	37	.link_state dd -1
38	.hwacc dd NET_HWACC_TCP_IPv4_IN + NET_HWACC_TCP_IPv4_OUT	38	.hwacc dd NET_HWACC_TCP_IPv4_IN + NET_HWACC_TCP_IPv4_OUT
39		39
40	.namestr db 'loopback', 0	40	.namestr db 'loopback', 0
41		41
42	.dummy_fn:	42	.dummy_fn:
43	ret	43	ret
44		44
45	endg	45	endg
46		46
47		47
48	macro LOOP_init {	48	macro loop_init {
49	local .fail	49	local .fail
50		50
51	mov ebx, LOOPBACK_DEVICE	51	mov ebx, LOOPBACK_DEVICE
52	call NET_add_device	52	call net_add_device
53		53
54	cmp eax, -1	54	cmp eax, -1
55	je .fail	55	je .fail
56		56
57	mov [IP_LIST], 127 + 1 shl 24	57	mov [IP_LIST], 127 + 1 shl 24
58	mov [SUBNET_LIST], 255	58	mov [SUBNET_LIST], 255
59	mov [BROADCAST_LIST], 0xffffff00 + 127	59	mov [BROADCAST_LIST], 0xffffff00 + 127
60		60
61	.fail:	61	.fail:
62	}	62	}
63		63
64	;-----------------------------------------------------------------;	64	;-----------------------------------------------------------------;
65	; ;	65	; ;
66	; LOOP_input ;	66	; loop_input ;
67	; ;	67	; ;
68	; IN: [esp+4] = Pointer to buffer ;	68	; IN: [esp+4] = Pointer to buffer ;
69	; ;	69	; ;
70	; OUT: / ;	70	; OUT: / ;
71	; ;	71	; ;
72	;-----------------------------------------------------------------;	72	;-----------------------------------------------------------------;
73	align 4	73	align 4
74	LOOP_input:	74	loop_input:
75		75
76	mov eax, [esp+4]	76	mov eax, [esp+4]
77		77
78	; Update stats	78	; Update stats
79	inc [LOOPBACK_DEVICE.packets_rx]	79	inc [LOOPBACK_DEVICE.packets_rx]
80		80
81	mov ecx, [eax + NET_BUFF.length]	81	mov ecx, [eax + NET_BUFF.length]
82	add dword[LOOPBACK_DEVICE.bytes_rx], ecx	82	add dword[LOOPBACK_DEVICE.bytes_rx], ecx
83	adc dword[LOOPBACK_DEVICE.bytes_rx + 4], 0	83	adc dword[LOOPBACK_DEVICE.bytes_rx + 4], 0
84		84
85	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_input: ptr=%x size=%u\n", eax, ecx	85	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_input: ptr=%x size=%u\n", eax, ecx
86		86
87	; Reverse buffptr and returnaddr on stack	87	; Reverse buffptr and returnaddr on stack
88	pop edx edi	88	pop edx edi
89	push edx edi	89	push edx edi
90		90
91	; Set registers for protocol handlers	91	; Set registers for protocol handlers
92	lea edx, [eax + NET_BUFF.data]	92	lea edx, [eax + NET_BUFF.data]
93	mov ebx, [eax + NET_BUFF.device]	93	mov ebx, [eax + NET_BUFF.device]
94	mov eax, [eax + NET_BUFF.type]	94	mov eax, [eax + NET_BUFF.type]
95		95
96	; Place protocol handlers here	96	; Place protocol handlers here
97	cmp eax, AF_INET4	97	cmp eax, AF_INET4
98	je IPv4_input	98	je ipv4_input
99		99
100	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_input: Unknown packet type=%x\n", eax	100	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_input: Unknown packet type=%x\n", eax
101		101
102	.dump:	102	.dump:
103	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_input: dumping\n"	103	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_input: dumping\n"
104	call NET_BUFF_free	104	call net_buff_free
105	ret	105	ret
106		106
107		107
108	;-----------------------------------------------------------------;	108	;-----------------------------------------------------------------;
109	; ;	109	; ;
110	; LOOP_output ;	110	; loop_output ;
111	; ;	111	; ;
112	; IN: ecx = packet size ;	112	; IN: ecx = packet size ;
113	; edi = address family ;	113	; edi = address family ;
114	; ;	114	; ;
115	; OUT: eax = start of net frame / 0 on error ;	115	; OUT: eax = start of net frame / 0 on error ;
116	; ebx = to device structure ;	116	; ebx = to device structure ;
117	; ecx = unchanged (packet size of embedded data) ;	117	; ecx = unchanged (packet size of embedded data) ;
118	; edi = start of payload ;	118	; edi = start of payload ;
119	; ;	119	; ;
120	;-----------------------------------------------------------------;	120	;-----------------------------------------------------------------;
121	align 4	121	align 4
122	LOOP_output:	122	loop_output:
123		123
124	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_output\n"	124	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_output\n"
125		125
126	cmp ecx, [LOOPBACK_DEVICE.mtu]	126	cmp ecx, [LOOPBACK_DEVICE.mtu]
127	ja .too_large	127	ja .too_large
128		128
129	push ecx edi	129	push ecx edi
130	add ecx, NET_BUFF.data	130	add ecx, NET_BUFF.data
131	stdcall NET_BUFF_alloc, ecx	131	stdcall net_buff_alloc, ecx
132	test eax, eax	132	test eax, eax
133	jz .out_of_ram	133	jz .out_of_ram
134		134
135	pop edi	135	pop edi
136	mov [eax + NET_BUFF.type], edi	136	mov [eax + NET_BUFF.type], edi
137	mov ebx, LOOPBACK_DEVICE	137	mov ebx, LOOPBACK_DEVICE
138	mov [eax + NET_BUFF.device], ebx	138	mov [eax + NET_BUFF.device], ebx
139	pop ecx	139	pop ecx
140	mov [eax + NET_BUFF.length], ecx	140	mov [eax + NET_BUFF.length], ecx
141	lea edi, [eax + NET_BUFF.data]	141	lea edi, [eax + NET_BUFF.data]
142		142
143	inc [LOOPBACK_DEVICE.packets_tx]	143	inc [LOOPBACK_DEVICE.packets_tx]
144	add dword[LOOPBACK_DEVICE.bytes_tx], ecx	144	add dword[LOOPBACK_DEVICE.bytes_tx], ecx
145	adc dword[LOOPBACK_DEVICE.bytes_tx + 4], 0	145	adc dword[LOOPBACK_DEVICE.bytes_tx + 4], 0
146		146
147	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_output: ptr=%x size=%u\n", eax, ecx	147	DEBUGF DEBUG_NETWORK_VERBOSE, "LOOP_output: ptr=%x size=%u\n", eax, ecx
148	ret	148	ret
149		149
150	.too_large:	150	.too_large:
151	DEBUGF DEBUG_NETWORK_ERROR, "LOOP_output: packet is too large\n"	151	DEBUGF DEBUG_NETWORK_ERROR, "LOOP_output: packet is too large\n"
152	xor eax, eax	152	xor eax, eax
153	ret	153	ret
154		154
155	.out_of_ram:	155	.out_of_ram:
156	DEBUGF DEBUG_NETWORK_ERROR, "LOOP_output: out of memory\n"	156	DEBUGF DEBUG_NETWORK_ERROR, "LOOP_output: out of memory\n"
157	add esp, 4+4	157	add esp, 4+4
158	xor eax, eax	158	xor eax, eax
159	ret	159	ret

Subversion Repositories Kolibri OS

(root)/kernel/branches/Kolibri-acpi/network/loopback.inc – Rev 5984 → 6078