WebSVN – Kolibri OS – Diff – /kernel/branches/net/network/PPPoE.inc

 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 ;;                                                              ;;
-;; Copyright (C) KolibriOS team 2009-2012. All rights reserved. ;;
+;; Copyright (C) KolibriOS team 2012. All rights reserved.      ;;
 ;; Distributed under terms of the GNU General Public License    ;;
 ;;                                                              ;;
+;;  PPPoE.INC                                                   ;;
-;; Clevermouse & hidnplayr                                      ;;
+;;                                                              ;;
+;;  Part of the tcp/ip network stack for KolibriOS              ;;
+;;                                                              ;;
+;;    Written by hidnplayr@kolibrios.org                        ;;
+;;                                                              ;;
+;;          GNU GENERAL PUBLIC LICENSE                          ;;
+;;             Version 2, June 1991                             ;;
 ;;                                                              ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
-struct  PPPoE_header
+struct  PPPoE_frame
         VersionAndType  db ?
         Code            db ?
+        SessionID       dw ?
-        SessionID       dw ?
+        Length          dw ?            ; Length of payload, does NOT include the length PPPoE header.
-        Length          dw ?            ; Length of payload, does NOT include the length PPPoE header.
-ends
-struct  PPPoE_connection
-        next            dd ?            ; pointer to next connection
-        prev            dd ?            ; pointer to previous connection
-        pid             dd ?            ; identifier of base application
+        Payload         rb 0
-        datalen         dd ?            ; length of received data
-        recvbuf         rb 1500         ; buffer for received data
-        sendbuf         rb 1500         ; buffer for data to send
+ends
-ends
-iglobal
-align 4
-        PPPoE.head              dd PPPoE.head
         PPPoE.tail              dd PPPoE.head
+uglobal
+        PPPoE_SID       dw ?
-endg
+        PPPoE_MAC       dp ?
+endg
+;-----------------------------------------------------------------
+;
+; PPPoE discovery input
+;
+; Handler of received Ethernet packet with type = Discovery
+;
+;
-uglobal
+;  IN:  Pointer to buffer in [esp]
-        PPPoE.cur_receiver      dd ?
-        PPPoE.cur_receiver_ptr  dd ?
+;       size of buffer in [esp+4]
-        PPPoE.cur_receiver_len  dd ?
-endg
+;       pointer to device struct in ebx
-; Allocates internal structure for future PPPoE actions.
-align 4
-PPPoE_alloc_connection:
-; 1. Allocate memory in the kernel area.
-        stdcall kernel_alloc, sizeof.PPPoE_connection
+;       pointer to PPP header in edx
-; 1a. If memory allocation failed, return NULL.
-        test    eax, eax
-        jz      .nothing
+;       size of PPP packet in ecx
+;  OUT: /
+;
+;-----------------------------------------------------------------
+align 4
+PPPoE_discovery_input:
-; 2. Copy PID of caller to the structure.
-        mov     edx, [CURRENT_TASK]
+        DEBUGF  2,"PPPoE_discovery_input\n"
-        mov     [eax + PPPoE_connection.pid], edx
-; 3. Insert the structure to the list of all connections.
-        mov     [eax + PPPoE_connection.next], PPPoE.head
-        mov     edx, [PPPoE.tail]
-        mov     [eax + PPPoE_connection.prev], edx
-        mov     [edx + PPPoE_connection.next], eax
-        mov     [PPPoE.tail], eax
-  .nothing:
-        ret
+; First, find open PPPoE socket
-align 4
+        mov     eax, net_sockets
+  .next_socket:
+        mov     eax, [eax + SOCKET.NextPtr]
+        or      eax, eax
+        jz      .dump
-PPPoE_free_connection:
+        cmp     [eax + SOCKET.Domain], AF_PPP
+        jne     .next_socket
+        cmp     [eax + SOCKET.Protocol], PPP_PROTO_ETHERNET
-; 1. Check that the caller is the owner of this connection.
+        jne     .next_socket
-        mov     eax, [CURRENT_TASK]
+; Now, send it to the this socket
-        cmp     [ebx+PPPoE_connection.pid], eax
-        jnz     .nothing
+        mov     ecx, [esp + 4]
+        mov     esi, [esp]
-; 2. Delete the structure from the list of all connections.
-        mov     eax, [ebx+PPPoE_connection.next]
-        mov     edx, [ebx+PPPoE_connection.prev]
-        mov     [eax+PPPoE_connection.prev], edx
         mov     [edx+PPPoE_connection.next], eax
         jmp     SOCKET_input
-; 3. Free the memory.
-        stdcall kernel_free, ebx
   .dump:
-  .nothing:
+        DEBUGF 1,'PPPoE_discovery_input: dumping\n'
-        ret
+        call    kernel_free
+        add     esp, 4
-; Send PADI packet
-; ebx (ecx in app) = size of buffer for PPPoE offers, must be at least 1514
-; ecx (edx in app) = size of tags, 0 means "use default"
-; edx (esi in app) = pointer to buffer for PPPoE offers
-; esi (edi in app) = pointer to tags, ignored if 'size of tags' == 0
-align 4
-PPPoE_send_init:
-; 1. Check length.
-        cmp     ebi, 1514
-        jb      .bad
-; RFC2516: An entire PADI packet (including the PPPoE header) MUST NOT
-; exceed 1484 octets.
-; PPPoE header is 6 bytes long, so maximum length of tags is 1478.
-        cmp     ecx, 1478
-        ja      .bad
-; 2. Check that no one listen for offers.
-        cmp     [PPPoE.cur_receiver], 0
+        ret
-        jnz     .bad
+;--------------------------------------
-; 3. Remember PID and data pointer of current listener.
+;
-        push    [CURRENT_TASK]
+; Send discovery packet
+;
-        pop     [PPPoE.cur_receiver]
+; ebx (ecx in app) = device
-        mov     [PPPoE.cur_receiver_ptr], edx
+; ecx (edx in app) = size packet
-        mov     [PPPoE.cur_receiver_len], ebx
+; edx (esi in app) = pointer to packet
+;
+;--------------------------------------
-        and     dword [edx], 0 ; no offers yet
+align 4
+PPPoE_discovery_output:
+; 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
+        cmp     ebx, MAX_NET_DEVICES
-; 4. Create packet.
+        ja      .bad
-        test    ecx, ecx
-        jnz     @f
+        mov     ebx, [NET_DRV_LIST + 4*ebx]
-        mov     esi, .default_payload
+        test    ebx, ebx
-        mov     ecx, .default_payload_length
+        jz      .bad
        @@:
         cmp     [ebx + NET_DEVICE.type], NET_TYPE_ETH
-        mov     edx, [NET_DRV_LIST]     ;;;; FIXME
-        lea     eax, [ebx + ETH_DEVICE.mac]     ; Source Address
-        mov     edx, ETH_BROADCAST              ; Destination Address
-        add     ecx, sizeof.PPPoE_header        ; Data size
-        mov     di, ETHER_PPP_DISCOVERY         ; Protocol
+        jne     .bad
+; Create packet.
+        stdcall kernel_alloc, 1500
+        test    eax, eax
+        jz      .bad
+        push    ecx eax
+        mov     edi, eax
+        rep     movsb
-        call    ETH_output
+; Overwrite source MAC and protocol type
+        lea     edi, [eax + ETH_header.SrcMAC]
+        lea     esi, [ebx + ETH_DEVICE.mac]
-        jz      .eth_error
+        movsd
+        movsw
-        push    edx eax
-; 4b. Set ver=1, type=1 (=> first byte 0x11), code=9 (PADI packet), session=0
+        mov     ax, ETHER_PPP_DISCOVERY
-        mov     dword [edi], (0x09 shl 8) + 0x11
+        stosw
-; 4c. Set payload length.
-        mov     [edi+4], ch
-        mov     [edi+5], cl
-; 4e. Copy given tags.
-        rep     movsb
+; And send the packet
+        call    [ebx + NET_DEVICE.transmit]
-; 5. Send packet.
-        call    [ebx + NET_DEVICE.transmit]
-; 6. Return.
+        xor     eax, eax
+        ret
+  .bad:
+        or      eax, -1
+        ret
+;-----------------------------------------------------------------
+;
+; PPPoE session input
-        xor     eax, eax
+;
+; Handler of received Ethernet packet with type = Session
-        ret
+;
+;
+;  IN:  Pointer to buffer in [esp]
+;       size of buffer in [esp+4]
-  .bad:
+;       pointer to device struct in ebx
+;       pointer to PPP header in edx
-        or      eax, -1
+;       size of PPP packet in ecx
-        ret
+;  OUT: /
+;
-  .default_payload:
+;-----------------------------------------------------------------
+align 4
+PPPoE_session_input:
-; Service-Name tag with zero length
-        dw      0x0101, 0x0000
+        cmp     [edx + PPPoE_frame.VersionAndType], 0x11
+        jne     .dump
   .default_payload_length = $ - .default_payload
+        cmp     [edx + PPPoE_frame.Code], 0x00
+        jne     .dump
-; Stop receiving PADO packets
-align 4
+        movzx   ecx, [edx + PPPoE_frame.Length]
-PPPoE_stop_offers:
+        xchg    cl, ch
 ; Only the listener can stop listen.    ;;; TODO: make sure this function is called when process gets terminated
-        mov     eax, [CURRENT_TASK]
+        mov     ax, [edx + PPPoE_frame.SessionID]
-        cmp     [PPPoE.cur_receiver], eax
+        DEBUGF  2,"PPPoE_input: session ID=%x, length=%u\n", ax, cx
-        jnz     .bad
+        cmp     ax, [PPPoE_SID]
-        xor     eax, eax
-        mov     [PPPoE.cur_receiver_ptr], eax
-        mov     [PPPoE.cur_receiver], eax
-        ret
-  .bad:
+        jne     .dump
-        or      eax, -1
-        ret
-; Send PPPoE data in Discovery stage
-align 4
-PPPoE_send_discovery:
-        ret
-; Receive PPPoE data in Discovery stage
-align 4
-PPPoE_receive_discovery:
-        ret
+        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 discovery input
+;
+; PPPoE_output
+;
+; IN:
+;     ebx = device ptr
+;     ecx = packet size
-;
-; Handler of received Ethernet packet with type = Discovery
-;
-;
 ;  IN:  Pointer to buffer in [esp]
+;      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
-;       size of buffer in [esp+4]
+        mov     [edi + PPPoE_frame.Length], cx
-;       pointer to device struct in ebx
+        xchg    cl, ch
-;       pointer to PPP header in edx
+        pop     word [edi + PPPoE_frame.Payload]
 ;       size of PPP packet in ecx
         cmp     ebx, .number
         ja      .error
         jmp     dword [.table + 4*ebx]
-  .table:
-        dd      PPPoE_send_init         ; 0
-        dd      PPPoE_stop_offers       ; 1
+  .table:
-        dd      PPPoE_alloc_connection  ; 3
+        dd      PPPoE_start_connection  ; 0
-        dd      PPPoE_free_connection   ; 4
-        dd      PPPoE_send_discovery    ; 5
-        dd      PPPoE_receive_discovery ; 6
+        dd      PPPoE_stop_connection   ; 1
   .number = ($ - .table) / 4 - 1
   .error:

Subversion Repositories Kolibri OS

(root)/kernel/branches/net/network/PPPoE.inc – Rev 2614 → 2931