WebSVN – Kolibri OS – Blame – /kernel/trunk/network/ethernet.inc

Rev	Author	Line No.	Line
3545	hidnplayr	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		2	;; ;;
9017	hidnplayr	3	;; Copyright (C) KolibriOS team 2004-2021. All rights reserved. ;;
3545	hidnplayr	4	;; Distributed under terms of the GNU General Public License ;;
		5	;; ;;
		6	;; ETHERNET.INC ;;
		7	;; ;;
		8	;; Ethernet network layer for KolibriOS ;;
		9	;; ;;
		10	;; Written by hidnplayr@kolibrios.org ;;
		11	;; ;;
		12	;; GNU GENERAL PUBLIC LICENSE ;;
		13	;; Version 2, June 1991 ;;
		14	;; ;;
		15	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		16
4850	mario79	17	$Revision: 9395 $
3545	hidnplayr	18
		19	ETH_FRAME_MINIMUM = 60
3982	hidnplayr	20	ETH_QUEUE_SIZE = 255
3545	hidnplayr	21
		22	struct ETH_header
		23
		24	DstMAC dp ? ; destination MAC-address
		25	SrcMAC dp ? ; source MAC-address
		26	Type dw ? ; type of the upper-layer protocol
		27
		28	ends
		29
		30	struct ETH_DEVICE NET_DEVICE
		31
		32	mac dp ?
		33
		34	ends
		35
5522	hidnplayr	36	iglobal
		37	align 4
3982	hidnplayr	38
5522	hidnplayr	39	ETH_BROADCAST dp 0xffffffffffff
3982	hidnplayr	40
5522	hidnplayr	41	ETH_frame_queued dd 0 ; Number of queued frames
3982	hidnplayr	42
5522	hidnplayr	43	ETH_frame_head dd ETH_frame_head ; Pointer to next frame in the linked list
		44	ETH_frame_tail dd ETH_frame_head ; Pointer to last frame in the linked list
3545	hidnplayr	45
		46	endg
		47
3982	hidnplayr	48	uglobal
		49	align 4
		50	ETH_input_event dd ?
		51	endg
		52
6011	hidnplayr	53	macro eth_init {
3982	hidnplayr	54
		55	movi ebx, 1
6011	hidnplayr	56	mov ecx, eth_process_input
3982	hidnplayr	57	call new_sys_threads
		58	test eax, eax
		59	jns @f
		60	DEBUGF DEBUG_NETWORK_ERROR,'K : cannot create kernel thread for ethernet, error %d\n', eax
		61	@@:
		62
		63	}
		64
3545	hidnplayr	65	align 4
9394	Boppan	66	; This function is called by ethernet drivers.
		67	; Push the received ethernet packet onto the ethernet input queue.
		68	;
		69	; Input:
9395	Boppan	70	; [esp] = Pointer to buffer
		71	; [esp + 4] = Return address (yes, really)
9394	Boppan	72	;
		73	; Example:
		74	; push .retaddr
		75	; push buf_addr
		76	; jmp eth_input
6011	hidnplayr	77	eth_input:
3545	hidnplayr	78
5522	hidnplayr	79	pop eax
3982	hidnplayr	80
9017	hidnplayr	81	if defined NETWORK_SANITY_CHECKS
		82	cmp eax, [net_buffs_low]
		83	jb .assert_mbuff
		84	cmp eax, [net_buffs_high]
		85	ja .assert_mbuff
		86	test eax, 0x7ff
		87	jnz .assert_mbuff
		88	end if
		89
		90	spin_lock_irqsave
		91
5522	hidnplayr	92	cmp [ETH_frame_queued], ETH_QUEUE_SIZE
		93	jae .full
		94	inc [ETH_frame_queued]
3982	hidnplayr	95
5522	hidnplayr	96	; Add frame to the end of the linked list
		97	mov [eax + NET_BUFF.NextPtr], ETH_frame_head
		98
		99	mov ebx, [ETH_frame_tail]
		100	mov [eax + NET_BUFF.PrevPtr], ebx
		101
		102	mov [ETH_frame_tail], eax
		103	mov [ebx + NET_BUFF.NextPtr], eax
		104
9017	hidnplayr	105	spin_unlock_irqrestore
5522	hidnplayr	106
7536	hidnplayr	107	; Mark it as being an Ethernet Frame
		108	mov [eax + NET_BUFF.type], NET_BUFF_ETH
		109
5522	hidnplayr	110	; Now queue an event to process it
3982	hidnplayr	111	xor edx, edx
		112	mov eax, [ETH_input_event]
		113	mov ebx, [eax + EVENT.id]
		114	xor esi, esi
		115	call raise_event
		116
		117	ret
		118
5522	hidnplayr	119	.full:
9017	hidnplayr	120	mov ebx, [eax + NET_BUFF.device]
		121	inc [ebx + NET_DEVICE.packets_rx_ovr]
		122	DEBUGF DEBUG_NETWORK_VERBOSE, "ETH incoming queue is full, discarding packet!\n"
		123	spin_unlock_irqrestore
		124	stdcall net_buff_free, eax
3982	hidnplayr	125	ret
		126
9017	hidnplayr	127	if defined NETWORK_SANITY_CHECKS
		128	.assert_mbuff:
		129	DEBUGF DEBUG_NETWORK_ERROR, "eth_input: invalid buffer 0x%x\n", eax
		130	DEBUGF DEBUG_NETWORK_ERROR, "eth_input: caller=0x%x\n", [esp+4]
		131	xor eax, eax
		132	ret
		133	end if
3982	hidnplayr	134
		135
9017	hidnplayr	136
6011	hidnplayr	137	;-----------------------------------------------------------------;
		138	; ;
		139	; eth_process_input: Process packets from ethernet input queue. ;
		140	; ;
		141	; IN: / ;
		142	; ;
		143	; OUT: / ;
		144	; ;
		145	;-----------------------------------------------------------------;
3982	hidnplayr	146	align 4
6011	hidnplayr	147	eth_process_input:
3982	hidnplayr	148
		149	xor esi, esi
		150	mov ecx, MANUAL_DESTROY
		151	call create_event
		152	mov [ETH_input_event], eax
5522	hidnplayr	153	pushf
3982	hidnplayr	154	.wait:
5522	hidnplayr	155	popf
3982	hidnplayr	156	mov eax, [ETH_input_event]
		157	mov ebx, [eax + EVENT.id]
		158	call wait_event
		159
		160	.loop:
5522	hidnplayr	161	pushf
		162	cli
		163	cmp [ETH_frame_queued], 0
		164	je .wait
3982	hidnplayr	165
5522	hidnplayr	166	dec [ETH_frame_queued]
3982	hidnplayr	167
5522	hidnplayr	168	mov esi, [ETH_frame_head]
		169	mov ebx, [esi + NET_BUFF.NextPtr]
3982	hidnplayr	170
5522	hidnplayr	171	mov [ETH_frame_head], ebx
		172	mov [ebx + NET_BUFF.PrevPtr], ETH_frame_head
		173
		174	popf
		175
		176	mov eax, [esi + NET_BUFF.offset]
		177	add eax, esi
		178	mov ecx, [esi + NET_BUFF.length]
		179	mov ebx, [esi + NET_BUFF.device]
		180
		181	pushd .loop ; return address for protocol handler
		182	push esi ; keep pointer to NET_BUFF on stack
		183
3982	hidnplayr	184	DEBUGF DEBUG_NETWORK_VERBOSE, "ETH_input: size=%u\n", ecx
3643	hidnplayr	185	sub ecx, sizeof.ETH_header
9017	hidnplayr	186	jb .err
3545	hidnplayr	187
5522	hidnplayr	188	; Set registers for protocol handlers
3545	hidnplayr	189	lea edx, [eax + sizeof.ETH_header]
		190	mov ax, [eax + ETH_header.Type]
		191
5522	hidnplayr	192	; Place protocol handlers here
3600	hidnplayr	193	cmp ax, ETHER_PROTO_IPv4
6011	hidnplayr	194	je ipv4_input
3545	hidnplayr	195
3601	hidnplayr	196	cmp ax, ETHER_PROTO_ARP
6011	hidnplayr	197	je arp_input
3545	hidnplayr	198
5001	hidnplayr	199	; cmp ax, ETHER_PROTO_IPv6
6011	hidnplayr	200	; je ipv6_input
3545	hidnplayr	201
5001	hidnplayr	202	; cmp ax, ETHER_PROTO_PPP_DISCOVERY
6011	hidnplayr	203	; je pppoe_discovery_input
3545	hidnplayr	204
5001	hidnplayr	205	; cmp ax, ETHER_PROTO_PPP_SESSION
6011	hidnplayr	206	; je pppoe_session_input
3545	hidnplayr	207
4256	hidnplayr	208	DEBUGF DEBUG_NETWORK_VERBOSE, "ETH_input: Unknown packet type=%x\n", ax
3545	hidnplayr	209
9017	hidnplayr	210	.drop:
		211	mov eax, [esp]
		212	mov eax, [eax + NET_BUFF.device]
		213	inc [eax + NET_DEVICE.packets_rx_drop]
		214	DEBUGF DEBUG_NETWORK_VERBOSE, "ETH_input: dropping\n"
6011	hidnplayr	215	call net_buff_free
3545	hidnplayr	216	ret
		217
9017	hidnplayr	218	.err:
		219	mov eax, [esp]
		220	mov eax, [eax + NET_BUFF.device]
		221	inc [eax + NET_DEVICE.packets_rx_err]
		222	DEBUGF DEBUG_NETWORK_VERBOSE, "ETH_input: invalid frame received\n"
		223	call net_buff_free
		224	ret
6011	hidnplayr	225
		226
9017	hidnplayr	227
		228
6011	hidnplayr	229	;-----------------------------------------------------------------;
		230	; ;
		231	; eth_output ;
		232	; ;
		233	; IN: ax = protocol ;
		234	; ebx = device ptr ;
		235	; ecx = payload size ;
		236	; edx = pointer to destination mac ;
		237	; ;
		238	; OUT: eax = start of net frame / 0 on error ;
		239	; ebx = device ptr ;
		240	; ecx = payload size ;
		241	; edi = start of payload ;
		242	; ;
		243	;-----------------------------------------------------------------;
3545	hidnplayr	244	align 4
6011	hidnplayr	245	eth_output:
3545	hidnplayr	246
3556	hidnplayr	247	DEBUGF DEBUG_NETWORK_VERBOSE, "ETH_output: size=%u device=%x\n", ecx, ebx
3545	hidnplayr	248
5015	hidnplayr	249	cmp ecx, [ebx + ETH_DEVICE.mtu]
9017	hidnplayr	250	ja .too_large
3545	hidnplayr	251
		252	push ecx
5015	hidnplayr	253	push ax edx
3545	hidnplayr	254
5522	hidnplayr	255	add ecx, sizeof.ETH_header + NET_BUFF.data
6011	hidnplayr	256	stdcall net_buff_alloc, ecx
3545	hidnplayr	257	test eax, eax
		258	jz .out_of_ram
9017	hidnplayr	259
5522	hidnplayr	260	mov [eax + NET_BUFF.type], NET_BUFF_ETH
		261	mov [eax + NET_BUFF.device], ebx
		262	mov [eax + NET_BUFF.offset], NET_BUFF.data
		263	lea edi, [eax + NET_BUFF.data]
3545	hidnplayr	264
		265	pop esi
		266	movsd
		267	movsw
5015	hidnplayr	268	lea esi, [ebx + ETH_DEVICE.mac]
3545	hidnplayr	269	movsd
		270	movsw
		271	pop ax
		272	stosw
		273
5522	hidnplayr	274	lea eax, [edi - sizeof.ETH_header - NET_BUFF.data] ; Set eax to buffer start
3545	hidnplayr	275	pop ecx
5522	hidnplayr	276
3545	hidnplayr	277	lea edx, [ecx + sizeof.ETH_header] ; Set edx to complete buffer size
		278	cmp edx, ETH_FRAME_MINIMUM
		279	jbe .adjust_size
		280	.done:
5522	hidnplayr	281	mov [eax + NET_BUFF.length], edx
3556	hidnplayr	282	DEBUGF DEBUG_NETWORK_VERBOSE, "ETH_output: ptr=%x size=%u\n", eax, edx
3545	hidnplayr	283	ret
		284
		285	.adjust_size:
		286	mov edx, ETH_FRAME_MINIMUM
5015	hidnplayr	287	test edx, edx ; clear zero flag
3545	hidnplayr	288	jmp .done
		289
		290	.out_of_ram:
9017	hidnplayr	291	inc [ebx + NET_DEVICE.packets_tx_drop]
		292	DEBUGF DEBUG_NETWORK_VERBOSE, "ETH_output: Out of ram!\n"
		293	add esp, 4+2
		294	pop ecx
5015	hidnplayr	295	xor eax, eax
3545	hidnplayr	296	ret
		297
9017	hidnplayr	298	.too_large:
		299	inc [eax + NET_DEVICE.packets_tx_err]
		300	DEBUGF DEBUG_NETWORK_VERBOSE, "ETH_output: Packet too large!\n"
5015	hidnplayr	301	xor eax, eax
3545	hidnplayr	302	ret
		303
		304
		305
6011	hidnplayr	306	;-----------------------------------------------------------------;
		307	; ;
		308	; eth_api: Part of system function 76. ;
		309	; ;
		310	; IN: bl = subfunction number ;
		311	; bh = device number ;
		312	; ecx, edx, .. depends on subfunction ;
		313	; ;
		314	; OUT: depends on subfunction ;
		315	; ;
		316	;-----------------------------------------------------------------;
3545	hidnplayr	317	align 4
6011	hidnplayr	318	eth_api:
3545	hidnplayr	319
3600	hidnplayr	320	cmp bh, NET_DEVICES_MAX
3545	hidnplayr	321	ja .error
		322	movzx eax, bh
7679	hidnplayr	323	mov eax, dword [net_device_list + 4*eax]
3600	hidnplayr	324	cmp [eax + NET_DEVICE.device_type], NET_DEVICE_ETH
3545	hidnplayr	325	jne .error
		326
		327	and ebx, 0xff
		328	cmp ebx, .number
		329	ja .error
		330	jmp dword [.table + 4*ebx]
		331
		332	.table:
3601	hidnplayr	333	dd .read_mac ; 0
3545	hidnplayr	334	.number = ($ - .table) / 4 - 1
		335
		336	.error:
		337	or eax, -1
		338	ret
		339
		340
		341	.read_mac:
		342	movzx ebx, word [eax + ETH_DEVICE.mac]
		343	mov eax, dword [eax + ETH_DEVICE.mac + 2]
5522	hidnplayr	344	mov [esp+20+4], ebx ; FIXME
3545	hidnplayr	345	ret
		346

Subversion Repositories Kolibri OS

(root)/kernel/trunk/network/ethernet.inc @ 4219 – Rev 9395