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

Rev	Author	Line No.	Line
3545	hidnplayr	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		2	;; ;;
3861	hidnplayr	3	;; Copyright (C) KolibriOS team 2012-2013. All rights reserved. ;;
3545	hidnplayr	4	;; Distributed under terms of the GNU General Public License ;;
		5	;; ;;
		6	;; PPPoE.INC ;;
		7	;; ;;
		8	;; Part of the tcp/ip network stack 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: 4850 $
		18
		19
3545	hidnplayr	20	struct PPPoE_frame
		21	VersionAndType db ?
		22	Code db ?
		23	SessionID dw ?
		24	Length dw ? ; Length of payload, does NOT include the length PPPoE header.
		25	Payload rb 0
		26	ends
		27
		28	uglobal
3698	hidnplayr	29	align 4
		30
3545	hidnplayr	31	PPPoE_SID dw ?
		32	PPPoE_MAC dp ?
3698	hidnplayr	33
3545	hidnplayr	34	endg
		35
		36	;-----------------------------------------------------------------
		37	;
		38	; PPPoE_init
		39	;
		40	; This function resets all IP variables
		41	;
		42	;-----------------------------------------------------------------
		43	macro PPPoE_init {
		44
		45	call PPPoE_stop_connection
		46
		47	}
		48
		49
		50	;-----------------------------------------------------------------
		51	;
		52	; PPPoE discovery input
		53	;
		54	; Handler of received Ethernet packet with type = Discovery
		55	;
		56	;
		57	; IN: Pointer to buffer in [esp]
		58	; size of buffer in [esp+4]
		59	; pointer to device struct in ebx
		60	; pointer to PPP header in edx
		61	; size of PPP packet in ecx
		62	; OUT: /
		63	;
		64	;-----------------------------------------------------------------
		65	align 4
		66	PPPoE_discovery_input:
		67
3556	hidnplayr	68	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_discovery_input\n"
3545	hidnplayr	69
		70	; First, find open PPPoE socket
		71
3647	hidnplayr	72	pusha
		73	mov ecx, socket_mutex
		74	call mutex_lock
		75	popa
		76
3545	hidnplayr	77	mov eax, net_sockets
		78
		79	.next_socket:
		80	mov eax, [eax + SOCKET.NextPtr]
		81	or eax, eax
		82	jz .dump
		83
		84	cmp [eax + SOCKET.Domain], AF_PPP
		85	jne .next_socket
		86
		87	cmp [eax + SOCKET.Protocol], PPP_PROTO_ETHERNET
		88	jne .next_socket
		89
3647	hidnplayr	90	pusha
		91	mov ecx, socket_mutex
		92	call mutex_unlock
		93	popa
		94
3545	hidnplayr	95	; Now, send it to the this socket
		96
		97	mov ecx, [esp + 4]
		98	mov esi, [esp]
		99
		100	jmp SOCKET_input
		101
		102	.dump:
3647	hidnplayr	103	pusha
		104	mov ecx, socket_mutex
		105	call mutex_unlock
		106	popa
		107
3556	hidnplayr	108	DEBUGF DEBUG_NETWORK_VERBOSE, 'PPPoE_discovery_input: dumping\n'
3861	hidnplayr	109	call NET_packet_free
3545	hidnplayr	110	add esp, 4
		111	ret
		112
		113
		114	;--------------------------------------
		115	;
		116	; Send discovery packet
		117	;
		118	; IN: eax = socket pointer
		119	; ecx = number of bytes to send
		120	; esi = pointer to data
		121	;
		122	;--------------------------------------
		123
		124	align 4
		125	PPPoE_discovery_output:
		126
3556	hidnplayr	127	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_discovery_output: socket=%x buffer=%x size=%d\n", eax, esi, ecx
3545	hidnplayr	128
		129	; RFC2516: An entire PADI packet (including the PPPoE header) MUST NOT
		130	; exceed 1484 octets.
		131	cmp ecx, 1484 + 14
		132	ja .bad
		133
		134	; Check that device exists and is ethernet device
		135	mov ebx, [eax + SOCKET.device]
		136
3600	hidnplayr	137	cmp ebx, NET_DEVICES_MAX
3545	hidnplayr	138	ja .bad
		139
		140	mov ebx, [NET_DRV_LIST + 4*ebx]
		141	test ebx, ebx
		142	jz .bad
		143
3600	hidnplayr	144	cmp [ebx + NET_DEVICE.device_type], NET_DEVICE_ETH
3545	hidnplayr	145	jne .bad
		146
3556	hidnplayr	147	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_discovery_output: device=%x\n", ebx
3545	hidnplayr	148
		149	; Create packet.
		150	push ecx esi
		151	stdcall kernel_alloc, 1500
		152	pop esi ecx
		153	test eax, eax
		154	jz .bad
		155
		156	mov edx, ecx
		157	mov edi, eax
3711	clevermous	158	rep movsb
3545	hidnplayr	159
		160	cmp edx, 60 ; Min ETH size
		161	ja @f
		162	mov edx, 60
		163	@@:
		164
		165	push edx eax ; size and packet ptr for driver send proc
		166
		167	; Overwrite source MAC and protocol type
		168	lea edi, [eax + ETH_header.SrcMAC]
		169	lea esi, [ebx + ETH_DEVICE.mac]
		170	movsd
		171	movsw
3600	hidnplayr	172	cmp word[edi], ETHER_PROTO_PPP_SESSION ; Allow only PPP_discovery, or LCP
3545	hidnplayr	173	je @f
3600	hidnplayr	174	mov ax, ETHER_PROTO_PPP_DISCOVERY
3545	hidnplayr	175	stosw
		176	@@:
		177
		178	; And send the packet
		179	call [ebx + NET_DEVICE.transmit]
		180
		181	xor eax, eax
		182	ret
		183
		184	.bad:
		185	or eax, -1
		186	ret
		187
		188
		189	;-----------------------------------------------------------------
		190	;
		191	; PPPoE session input
		192	;
		193	; Handler of received Ethernet packet with type = Session
		194	;
		195	;
		196	; IN: Pointer to buffer in [esp]
		197	; size of buffer in [esp+4]
		198	; pointer to device struct in ebx
		199	; pointer to PPP header in edx
		200	; size of PPP packet in ecx
		201	; OUT: /
		202	;
		203	;-----------------------------------------------------------------
		204	align 4
		205	PPPoE_session_input:
		206
		207	cmp [edx + PPPoE_frame.VersionAndType], 0x11
		208	jne .dump
		209
		210	cmp [edx + PPPoE_frame.Code], 0x00
		211	jne .dump
		212
		213	movzx ecx, [edx + PPPoE_frame.Length]
		214	xchg cl, ch
		215
		216	mov ax, [edx + PPPoE_frame.SessionID]
3556	hidnplayr	217	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_input: session ID=%x, length=%u\n", ax, cx
3545	hidnplayr	218	cmp ax, [PPPoE_SID]
		219	jne .dump
		220
		221	mov ax, word [edx + PPPoE_frame.Payload]
		222	add edx, PPPoE_frame.Payload + 2
		223
3600	hidnplayr	224	cmp ax, PPP_PROTO_IPv4
3545	hidnplayr	225	je IPv4_input
		226
3600	hidnplayr	227	; cmp ax, PPP_PROTO_IPv6
3545	hidnplayr	228	; je IPv6_input
		229
		230	jmp PPPoE_discovery_input ; Send LCP,CHAP,CBCP,... packets to the PPP dialer
3556	hidnplayr	231	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_input: Unknown protocol=%x\n", ax
3545	hidnplayr	232
		233	.dump:
3556	hidnplayr	234	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_input: dumping\n"
3861	hidnplayr	235	call NET_packet_free
3545	hidnplayr	236	add esp, 4
		237	ret
		238
		239
		240
		241
		242	;-----------------------------------------------------------------
		243	;
		244	; PPPoE_output
		245	;
		246	; IN:
		247	; ebx = device ptr
		248	; ecx = packet size
		249	;
		250	; di = protocol
		251	;
		252	; OUT: edi = 0 on error, pointer to buffer otherwise
		253	; eax = buffer start
		254	; ebx = to device structure
		255	; ecx = unchanged (packet size of embedded data)
		256	; edx = size of complete buffer
		257	;
		258	;-----------------------------------------------------------------
		259	align 4
		260	PPPoE_output:
		261
3556	hidnplayr	262	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_output: size=%u device=%x\n", ecx, ebx
3545	hidnplayr	263
		264	pushw di
		265	pushw [PPPoE_SID]
		266
		267	lea eax, [ebx + ETH_DEVICE.mac]
		268	lea edx, [PPPoE_MAC]
		269	add ecx, PPPoE_frame.Payload + 2
3600	hidnplayr	270	mov di, ETHER_PROTO_PPP_SESSION
3545	hidnplayr	271	call ETH_output
		272	jz .eth_error
		273
		274	sub ecx, PPPoE_frame.Payload
		275	mov [edi + PPPoE_frame.VersionAndType], 0x11
		276	mov [edi + PPPoE_frame.Code], 0
		277	popw [edi + PPPoE_frame.SessionID]
		278	xchg cl, ch
		279	mov [edi + PPPoE_frame.Length], cx
		280	xchg cl, ch
		281
		282	pop word [edi + PPPoE_frame.Payload]
		283
		284	sub ecx, 2
		285	add edi, PPPoE_frame.Payload + 2
		286
3556	hidnplayr	287	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_output: success!\n"
3545	hidnplayr	288	ret
		289
		290
		291	.eth_error:
		292	add esp, 4
		293	xor edi, edi
		294
		295	ret
		296
		297
		298	PPPoE_start_connection:
		299
3556	hidnplayr	300	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_start_connection: %x\n", cx
3545	hidnplayr	301
		302	cmp [PPPoE_SID], 0
		303	jne .fail
		304
		305	mov [PPPoE_SID], cx
		306	mov dword [PPPoE_MAC], edx
		307	mov word [PPPoE_MAC + 4], si
		308
		309	xor eax, eax
		310	ret
		311
		312	.fail:
		313	or eax, -1
		314	ret
		315
		316
		317	align 4
		318	PPPoE_stop_connection:
		319
3556	hidnplayr	320	DEBUGF DEBUG_NETWORK_VERBOSE, "PPPoE_stop_connection\n"
3545	hidnplayr	321
		322	xor eax, eax
		323	mov [PPPoE_SID], ax
		324	mov dword [PPPoE_MAC], eax
		325	mov word [PPPoE_MAC + 4], ax
		326
		327	ret
		328
		329
		330	;---------------------------------------------------------------------------
		331	;
		332	; PPPoE API
		333	;
		334	; This function is called by system function 75
		335	;
		336	; IN: subfunction number in bl
		337	; device number in bh
		338	; ecx, edx, .. depends on subfunction
		339	;
		340	; OUT:
		341	;
		342	;---------------------------------------------------------------------------
		343	align 4
		344	PPPoE_api:
		345
		346	movzx eax, bh
		347	shl eax, 2
		348
		349	and ebx, 0xff
		350	cmp ebx, .number
		351	ja .error
		352	jmp dword [.table + 4*ebx]
		353
		354	.table:
		355	dd PPPoE_start_connection ; 0
		356	dd PPPoE_stop_connection ; 1
		357	.number = ($ - .table) / 4 - 1
		358
		359	.error:
		360	mov eax, -1
		361	ret

Subversion Repositories Kolibri OS

(root)/kernel/trunk/network/PPPoE.inc – Rev 4850