forked from KolibriOS/kolibrios
322 lines
7.8 KiB
PHP
322 lines
7.8 KiB
PHP
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
|
;; ;;
|
|
;; Copyright (C) KolibriOS team 2012. All rights reserved. ;;
|
|
;; Distributed under terms of the GNU General Public License ;;
|
|
;; ;;
|
|
;; PPPoE.INC ;;
|
|
;; ;;
|
|
;; Part of the tcp/ip network stack for KolibriOS ;;
|
|
;; ;;
|
|
;; Written by hidnplayr@kolibrios.org ;;
|
|
;; ;;
|
|
;; GNU GENERAL PUBLIC LICENSE ;;
|
|
;; Version 2, June 1991 ;;
|
|
;; ;;
|
|
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
|
|
|
struct PPPoE_frame
|
|
|
|
VersionAndType db ?
|
|
Code db ?
|
|
SessionID dw ?
|
|
Length dw ? ; Length of payload, does NOT include the length PPPoE header.
|
|
Payload rb 0
|
|
|
|
ends
|
|
|
|
|
|
uglobal
|
|
|
|
PPPoE_SID dw ?
|
|
PPPoE_MAC dp ?
|
|
|
|
endg
|
|
|
|
|
|
;-----------------------------------------------------------------
|
|
;
|
|
; PPPoE discovery input
|
|
;
|
|
; Handler of received Ethernet packet with type = Discovery
|
|
;
|
|
;
|
|
; IN: Pointer to buffer in [esp]
|
|
; size of buffer in [esp+4]
|
|
; pointer to device struct in ebx
|
|
; pointer to PPP header in edx
|
|
; size of PPP packet in ecx
|
|
; OUT: /
|
|
;
|
|
;-----------------------------------------------------------------
|
|
align 4
|
|
PPPoE_discovery_input:
|
|
|
|
DEBUGF 2,"PPPoE_discovery_input\n"
|
|
|
|
; First, find open PPPoE socket
|
|
|
|
mov eax, net_sockets
|
|
|
|
.next_socket:
|
|
mov eax, [eax + SOCKET.NextPtr]
|
|
or eax, eax
|
|
jz .dump
|
|
|
|
cmp [eax + SOCKET.Domain], AF_PPP
|
|
jne .next_socket
|
|
|
|
cmp [eax + SOCKET.Protocol], PPP_PROTO_ETHERNET
|
|
jne .next_socket
|
|
|
|
; Now, send it to the this socket
|
|
|
|
mov ecx, [esp + 4]
|
|
mov esi, [esp]
|
|
|
|
jmp SOCKET_input
|
|
|
|
.dump:
|
|
DEBUGF 1,'PPPoE_discovery_input: dumping\n'
|
|
call kernel_free
|
|
add esp, 4
|
|
ret
|
|
|
|
|
|
;--------------------------------------
|
|
;
|
|
; Send discovery packet
|
|
;
|
|
; IN: eax = socket pointer
|
|
; ecx = number of bytes to send
|
|
; esi = pointer to data
|
|
;
|
|
;--------------------------------------
|
|
|
|
align 4
|
|
PPPoE_discovery_output:
|
|
|
|
DEBUGF 2,"PPPoE_discovery_output: socket=%x buffer=%x size=%d\n", eax, esi, ecx
|
|
|
|
; RFC2516: An entire PADI packet (including the PPPoE header) MUST NOT
|
|
; exceed 1484 octets.
|
|
cmp ecx, 1484 + 14
|
|
ja .bad
|
|
|
|
; Check that device exists and is ethernet device
|
|
mov ebx, [eax + SOCKET.device]
|
|
|
|
cmp ebx, MAX_NET_DEVICES
|
|
ja .bad
|
|
|
|
mov ebx, [NET_DRV_LIST + 4*ebx]
|
|
test ebx, ebx
|
|
jz .bad
|
|
|
|
cmp [ebx + NET_DEVICE.type], NET_TYPE_ETH
|
|
jne .bad
|
|
|
|
DEBUGF 2,"PPPoE_discovery_output: device=%x\n", ebx
|
|
|
|
; Create packet.
|
|
push ecx esi
|
|
stdcall kernel_alloc, 1500
|
|
pop esi ecx
|
|
test eax, eax
|
|
jz .bad
|
|
|
|
mov edx, ecx
|
|
mov edi, eax
|
|
rep movsb
|
|
|
|
cmp edx, 60 ; Min ETH size
|
|
ja @f
|
|
mov edx, 60
|
|
@@:
|
|
|
|
push edx eax ; size and packet ptr for driver send proc
|
|
|
|
; Overwrite source MAC and protocol type
|
|
lea edi, [eax + ETH_header.SrcMAC]
|
|
lea esi, [ebx + ETH_DEVICE.mac]
|
|
movsd
|
|
movsw
|
|
mov ax, ETHER_PPP_DISCOVERY
|
|
stosw
|
|
|
|
; And send the packet
|
|
call [ebx + NET_DEVICE.transmit]
|
|
|
|
xor eax, eax
|
|
ret
|
|
|
|
.bad:
|
|
or eax, -1
|
|
ret
|
|
|
|
|
|
;-----------------------------------------------------------------
|
|
;
|
|
; PPPoE session input
|
|
;
|
|
; Handler of received Ethernet packet with type = Session
|
|
;
|
|
;
|
|
; IN: Pointer to buffer in [esp]
|
|
; size of buffer in [esp+4]
|
|
; pointer to device struct in ebx
|
|
; pointer to PPP header in edx
|
|
; size of PPP packet in ecx
|
|
; OUT: /
|
|
;
|
|
;-----------------------------------------------------------------
|
|
align 4
|
|
PPPoE_session_input:
|
|
|
|
cmp [edx + PPPoE_frame.VersionAndType], 0x11
|
|
jne .dump
|
|
|
|
cmp [edx + PPPoE_frame.Code], 0x00
|
|
jne .dump
|
|
|
|
movzx ecx, [edx + PPPoE_frame.Length]
|
|
xchg cl, ch
|
|
|
|
mov ax, [edx + PPPoE_frame.SessionID]
|
|
DEBUGF 2,"PPPoE_input: session ID=%x, length=%u\n", ax, cx
|
|
cmp ax, [PPPoE_SID]
|
|
jne .dump
|
|
|
|
mov ax, word [edx + PPPoE_frame.Payload]
|
|
add edx, PPPoE_frame.Payload + 2
|
|
|
|
cmp ax, PPP_IPv4
|
|
je IPv4_input
|
|
|
|
DEBUGF 2,"PPPoE_input: Unknown protocol=%x\n", ax
|
|
|
|
.dump:
|
|
DEBUGF 2,"PPPoE_input: dumping\n"
|
|
call kernel_free
|
|
add esp, 4
|
|
ret
|
|
|
|
|
|
|
|
|
|
;-----------------------------------------------------------------
|
|
;
|
|
; PPPoE_output
|
|
;
|
|
; IN:
|
|
; ebx = device ptr
|
|
; ecx = packet size
|
|
;
|
|
; di = protocol
|
|
;
|
|
; OUT: edi = 0 on error, pointer to buffer otherwise
|
|
; eax = buffer start
|
|
; ebx = to device structure
|
|
; ecx = unchanged (packet size of embedded data)
|
|
; edx = size of complete buffer
|
|
;
|
|
;-----------------------------------------------------------------
|
|
align 4
|
|
PPPoE_output:
|
|
|
|
DEBUGF 1,"PPPoE_output: size=%u device=%x\n", ecx, ebx
|
|
|
|
pushw di
|
|
pushw [PPPoE_SID]
|
|
|
|
lea eax, [ebx + ETH_DEVICE.mac]
|
|
lea edx, [PPPoE_MAC]
|
|
add ecx, PPPoE_frame.Payload + 2
|
|
mov di, ETHER_PPP_SESSION
|
|
call ETH_output
|
|
jz .eth_error
|
|
|
|
mov [edi + PPPoE_frame.VersionAndType], 0x11
|
|
mov [edi + PPPoE_frame.Code], 0
|
|
popw [edi + PPPoE_frame.SessionID]
|
|
xchg cl, ch
|
|
mov [edi + PPPoE_frame.Length], cx
|
|
xchg cl, ch
|
|
pop word [edi + PPPoE_frame.Payload]
|
|
|
|
sub ecx, PPPoE_frame.Payload + 2
|
|
add edi, PPPoE_frame.Payload + 2
|
|
|
|
DEBUGF 1,"PPPoE_output: success!\n"
|
|
ret
|
|
|
|
|
|
.eth_error:
|
|
add esp, 4
|
|
xor edi, edi
|
|
|
|
ret
|
|
|
|
|
|
|
|
align 4
|
|
PPPoE_start_connection:
|
|
|
|
cmp [PPPoE_SID], 0
|
|
je .fail
|
|
|
|
mov [PPPoE_SID], cx
|
|
mov dword [PPPoE_MAC], edx
|
|
mov word [PPPoE_MAC + 4], si
|
|
|
|
xor eax, eax
|
|
ret
|
|
|
|
.fail:
|
|
or eax, -1
|
|
ret
|
|
|
|
|
|
align 4
|
|
PPPoE_stop_connection:
|
|
|
|
xor eax, eax
|
|
mov [PPPoE_SID], ax
|
|
mov dword [PPPoE_MAC], eax
|
|
mov word [PPPoE_MAC + 4], ax
|
|
|
|
ret
|
|
|
|
|
|
;---------------------------------------------------------------------------
|
|
;
|
|
; PPPoE API
|
|
;
|
|
; This function is called by system function 75
|
|
;
|
|
; IN: subfunction number in bl
|
|
; device number in bh
|
|
; ecx, edx, .. depends on subfunction
|
|
;
|
|
; OUT:
|
|
;
|
|
;---------------------------------------------------------------------------
|
|
align 4
|
|
PPPoE_api:
|
|
|
|
movzx eax, bh
|
|
shl eax, 2
|
|
|
|
and ebx, 0xff
|
|
cmp ebx, .number
|
|
ja .error
|
|
jmp dword [.table + 4*ebx]
|
|
|
|
.table:
|
|
dd PPPoE_start_connection ; 0
|
|
dd PPPoE_stop_connection ; 1
|
|
.number = ($ - .table) / 4 - 1
|
|
|
|
.error:
|
|
mov eax, -1
|
|
ret
|