Subversion Repositories Kolibri OS

Rev

Rev 3146 | Blame | Last modification | View Log | Download | RSS feed

  1. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  2. ;;                                                                 ;;
  3. ;; Copyright (C) KolibriOS team 2004-2013. All rights reserved.    ;;
  4. ;; Distributed under terms of the GNU General Public License       ;;
  5. ;;                                                                 ;;
  6. ;;  Part of the TCP/IP network stack for KolibriOS                 ;;
  7. ;;                                                                 ;;
  8. ;;   Written by hidnplayr@kolibrios.org                            ;;
  9. ;;                                                                 ;;
  10. ;;    Based on the code of 4.4BSD                                  ;;
  11. ;;                                                                 ;;
  12. ;;          GNU GENERAL PUBLIC LICENSE                             ;;
  13. ;;             Version 2, June 1991                                ;;
  14. ;;                                                                 ;;
  15. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  16.  
  17. $Revision: 3251 $
  18.  
  19. ;-----------------------------------------------------------------
  20. ;
  21. ; TCP_output
  22. ;
  23. ; IN:  eax = socket pointer
  24. ;
  25. ; OUT: /
  26. ;
  27. ;-----------------------------------------------------------------
  28. align 4
  29. TCP_output:
  30.  
  31.         DEBUGF 1,"TCP_output: socket=%x\n", eax
  32.  
  33.         pusha
  34.         lea     ecx, [eax + SOCKET.mutex]
  35.         call    mutex_lock
  36.         popa
  37.  
  38. ; We'll detect the length of the data to be transmitted, and flags to be used
  39. ; If there is some data, or any critical controls to send (SYN / RST), then transmit
  40. ; Otherwise, investigate further
  41.  
  42.         mov     ebx, [eax + TCP_SOCKET.SND_MAX]
  43.         cmp     ebx, [eax + TCP_SOCKET.SND_UNA]
  44.         jbe     .not_idle
  45.  
  46.         mov     ebx, [eax + TCP_SOCKET.t_idle]
  47.         cmp     ebx, [eax + TCP_SOCKET.t_rxtcur]
  48.         jbe     .not_idle
  49.  
  50. ; We have been idle for a while and no ACKS are expected to clock out any data we send..
  51. ; Slow start to get ack "clock" running again.
  52.  
  53.         mov     ebx, [eax + TCP_SOCKET.t_maxseg]
  54.         mov     [eax + TCP_SOCKET.SND_CWND], ebx
  55.  
  56.   .not_idle:
  57.   .again:
  58.         mov     [eax + TCP_SOCKET.temp_bits], 0
  59.  
  60.         mov     ebx, [eax + TCP_SOCKET.SND_NXT]         ; calculate offset (71)
  61.         sub     ebx, [eax + TCP_SOCKET.SND_UNA]         ;
  62.  
  63.         mov     ecx, [eax + TCP_SOCKET.SND_WND]         ; determine window
  64.         cmp     ecx, [eax + TCP_SOCKET.SND_CWND]        ;
  65.         jb      @f                                      ;
  66.         mov     ecx, [eax + TCP_SOCKET.SND_CWND]        ;
  67.        @@:                                              ;
  68.  
  69.         call    TCP_outflags                            ; flags in dl
  70.  
  71. ;------------------------
  72. ; data being forced out ?
  73.  
  74. ; If in persist timeout with window of 0, send 1 byte.
  75. ; Otherwise, if window is small but nonzero, and timer expired,
  76. ; we will send what we can and go to transmit state
  77.  
  78.         cmp     [eax + TCP_SOCKET.t_force], 0
  79.         je      .no_force
  80.  
  81.         DEBUGF 1,"TCP_output: forcing data out\n"
  82.  
  83.         test    ecx, ecx
  84.         jnz     .no_zero_window
  85.  
  86.         cmp     ebx, [eax + STREAM_SOCKET.snd.size]
  87.         jae     @f
  88.  
  89.         and     dl, not (TH_FIN)
  90.  
  91.        @@:
  92.         inc     ecx
  93.         jmp     .no_force
  94.  
  95.   .no_zero_window:
  96.         mov     [eax + TCP_SOCKET.timer_persist], 0
  97.         mov     [eax + TCP_SOCKET.t_rxtshift], 0
  98.  
  99.   .no_force:
  100.  
  101. ;--------------------------------
  102. ; Calculate how much data to send (106)
  103.  
  104.         mov     esi, [eax + STREAM_SOCKET.snd.size]
  105.         cmp     esi, ecx
  106.         jb      @f
  107.         mov     esi, ecx
  108.        @@:
  109.         sub     esi, ebx
  110.  
  111.  
  112. ;------------------------
  113. ; check for window shrink (107)
  114.  
  115. ; If FIN has been set, but not ACKed, but we havent been called to retransmit, esi will be -1
  116. ; Otherwise, window shrank after we sent into it.
  117.  
  118.         jae     .not_persist
  119.  
  120. ; enter persist state
  121.         xor     esi, esi
  122.  
  123. ; If window shrank to 0
  124.         test    ecx, ecx
  125.         jnz     @f
  126.  
  127. ; cancel pending retransmit
  128.         mov     [eax + TCP_SOCKET.timer_retransmission], 0
  129.  
  130. ; pull SND_NXT back to (closed) window, We will enter persist state below.
  131.         push    [eax + TCP_SOCKET.SND_UNA]
  132.         pop     [eax + TCP_SOCKET.SND_NXT]
  133.        @@:
  134.  
  135. ; If window didn't close completely, just wait for an ACK
  136.  
  137.   .not_persist:
  138.  
  139. ;---------------------------
  140. ; Send one segment at a time (124)
  141.  
  142.         cmp     esi, [eax + TCP_SOCKET.t_maxseg]
  143.         jbe     @f
  144.  
  145.         mov     esi, [eax + TCP_SOCKET.t_maxseg]
  146.         or      [eax + TCP_SOCKET.temp_bits], TCP_BIT_SENDALOT
  147.        @@:
  148.  
  149. ;--------------------------------------------
  150. ; Turn of FIN flag if send buffer not emptied (128)
  151.  
  152.         mov     edi, [eax + TCP_SOCKET.SND_NXT]
  153.         add     edi, esi
  154.         sub     edi, [eax + TCP_SOCKET.SND_UNA]
  155.         cmp     edi, [eax + STREAM_SOCKET.snd.size]
  156.         jae     @f
  157.         and     dl, not (TH_FIN)
  158.  
  159.        @@:
  160.  
  161. ;-------------------------------
  162. ; calculate window advertisement (130)
  163.  
  164.         mov     ecx, SOCKET_MAXDATA
  165.         sub     ecx, [eax + STREAM_SOCKET.rcv.size]
  166.  
  167. ;------------------------------
  168. ; Sender silly window avoidance (131)
  169.  
  170.         test    esi, esi
  171.         jz      .len_zero
  172.  
  173.         cmp     esi, [eax + TCP_SOCKET.t_maxseg]
  174.         je      TCP_send
  175.  
  176.         add     ebx, esi                                ; offset + length
  177.         cmp     ebx, [eax + STREAM_SOCKET.snd.size]
  178.         jb      @f
  179.  
  180.         test    [eax + TCP_SOCKET.t_flags], TF_NODELAY
  181.         jnz     TCP_send
  182.  
  183.         mov     ebx, [eax + TCP_SOCKET.SND_MAX]
  184.         cmp     ebx, [eax + TCP_SOCKET.SND_UNA]
  185.         je      TCP_send
  186.        @@:
  187.  
  188.         test    [eax + TCP_SOCKET.t_force], -1  ;;;
  189.         jnz     TCP_send
  190.  
  191.         mov     ebx, [eax + TCP_SOCKET.max_sndwnd]
  192.         shr     ebx, 1
  193.         cmp     esi, ebx
  194.         jae     TCP_send
  195.  
  196.         mov     ebx, [eax + TCP_SOCKET.SND_NXT]
  197.         cmp     ebx, [eax + TCP_SOCKET.SND_MAX]
  198.         jb      TCP_send
  199.  
  200.   .len_zero:
  201.  
  202. ;----------------------------------------
  203. ; Check if a window update should be sent (154)
  204.  
  205.         DEBUGF  1,"TCP_output: window=%d\n", ecx
  206.  
  207. ; Compare available window to amount of window known to peer (as advertised window less next expected input)
  208. ; If the difference is at least two max size segments, or at least 50% of the maximum possible window,
  209. ; Then we want to send a window update to the peer.
  210.  
  211.         test    ecx, ecx
  212.         jz      .no_window
  213.  
  214.         push    ecx
  215.         mov     cl, [eax + TCP_SOCKET.RCV_SCALE]
  216.         mov     ebx, TCP_max_win
  217.         shl     ebx, cl
  218.         pop     ecx
  219.         cmp     ebx, ecx
  220.         jb      @f
  221.         mov     ebx, ecx
  222.        @@:
  223.         sub     ebx, [eax + TCP_SOCKET.RCV_ADV]
  224.         add     ebx, [eax + TCP_SOCKET.RCV_NXT]
  225.  
  226.         mov     edi, [eax + TCP_SOCKET.t_maxseg]
  227.         shl     edi, 1
  228.  
  229. ;        cmp     ebx, edi
  230. ;        jae     TCP_send
  231.  
  232. ;        cmp     ebx, [eax + TCP_SOCKET.]    ;;; TODO: check with receive buffer high water mark
  233. ;        jae     TCP_send
  234.  
  235.   .no_window:
  236.  
  237. ;--------------------------
  238. ; Should a segment be sent? (174)
  239.  
  240.         DEBUGF  1,"TCP_output: 174\n"
  241.  
  242.         test    [eax + TCP_SOCKET.t_flags], TF_ACKNOW   ; we need to ACK
  243.         jnz     TCP_send
  244.  
  245.         test    dl, TH_SYN + TH_RST                     ; we need to send a SYN or RST
  246.         jnz     TCP_send
  247.  
  248.         mov     ebx, [eax + TCP_SOCKET.SND_UP]          ; when urgent pointer is beyond start of send bufer
  249.         cmp     ebx, [eax + TCP_SOCKET.SND_UNA]
  250.         ja      TCP_send
  251.  
  252.         test    dl, TH_FIN
  253.         jz      .enter_persist  ; no reason to send, enter persist state
  254.  
  255. ; FIN was set, only send if not already sent, or on retransmit
  256.  
  257.         test    [eax + TCP_SOCKET.t_flags], TF_SENTFIN
  258.         jz      TCP_send
  259.  
  260.         mov     ebx, [eax + TCP_SOCKET.SND_NXT]
  261.         cmp     ebx, [eax + TCP_SOCKET.SND_UNA]
  262.         je      TCP_send
  263.  
  264. ;--------------------
  265. ; Enter persist state (191)
  266.  
  267.   .enter_persist:
  268.  
  269.         cmp     [eax + STREAM_SOCKET.snd.size], 0       ; Data ready to send?
  270.         jne     @f
  271.         cmp     [eax + TCP_SOCKET.timer_retransmission], 0
  272.         jne     @f
  273.         cmp     [eax + TCP_SOCKET.timer_persist], 0     ; Persist timer already expired?
  274.         jne     @f
  275.  
  276.         DEBUGF  1,"TCP_output: Entering persist state\n"
  277.  
  278.         mov     [eax + TCP_SOCKET.t_rxtshift], 0
  279.         call    TCP_set_persist
  280.        @@:
  281.  
  282. ;----------------------------
  283. ; No reason to send a segment (219)
  284.  
  285.         DEBUGF  1,"TCP_output: No reason to send a segment\n"
  286.  
  287.         pusha
  288.         lea     ecx, [eax + SOCKET.mutex]
  289.         call    mutex_unlock
  290.         popa
  291.  
  292.         ret
  293.  
  294.  
  295.  
  296.  
  297.  
  298.  
  299.  
  300.  
  301.  
  302. ;-----------------------------------------------
  303. ;
  304. ; Send a segment (222)
  305. ;
  306. ; eax = socket pointer
  307. ; esi = data len
  308. ;  dl = flags
  309. ;
  310. ;-----------------------------------------------
  311. align 4
  312. TCP_send:
  313.  
  314.         DEBUGF  1,"TCP_send: socket=%x length=%u flags=%x\n", eax, esi, dl
  315.  
  316.         push    eax                     ; save socket ptr
  317.         push    esi                     ; and data length too
  318.         mov     edi, sizeof.TCP_header  ; edi will contain headersize
  319.  
  320. ;------------------------------------
  321. ; Send options with first SYN segment
  322.  
  323.         test    dl, TH_SYN
  324.         jz      .options_done
  325.  
  326.         push    [eax + TCP_SOCKET.ISS]
  327.         pop     [eax + TCP_SOCKET.SND_NXT]
  328.  
  329.         test    [eax + TCP_SOCKET.t_flags], TF_NOOPT
  330.         jnz     .options_done
  331.  
  332.         mov     ecx, 1460                              ;;;; FIXME: use routing blablabla to determine MSS
  333.         or      ecx, TCP_OPT_MAXSEG shl 24 + 4 shl 16
  334.         bswap   ecx
  335.         push    ecx
  336.         add     di, 4
  337.  
  338.         DEBUGF  1,"TCP_send: added maxseg option\n"
  339.  
  340.         test    [eax + TCP_SOCKET.t_flags], TF_REQ_SCALE
  341.         jz      .no_scale
  342.  
  343.         test    dl, TH_ACK
  344.         jz      .scale_opt
  345.  
  346.         test    [eax + TCP_SOCKET.t_flags], TF_RCVD_SCALE
  347.         jz      .no_scale
  348.  
  349.   .scale_opt:
  350.         mov     cl, [eax + TCP_SOCKET.request_r_scale]
  351.         mov     ch, TCP_OPT_NOP
  352.         pushw   cx
  353.         pushw   TCP_OPT_WINDOW + 3 shl 8
  354.         add     di, 4
  355.  
  356.         DEBUGF  1,"TCP_send: added scale option\n"
  357.  
  358.   .no_scale:
  359.   .no_syn:
  360.  
  361. ;------------------------------------
  362. ; Make the timestamp option if needed
  363.  
  364.         test    [eax + TCP_SOCKET.t_flags], TF_REQ_TSTMP
  365.         jz      .no_timestamp
  366.  
  367.         test    dl, TH_RST
  368.         jnz     .no_timestamp
  369.  
  370.         test    dl, TH_ACK
  371.         jz      .timestamp
  372.  
  373.         test    [eax + TCP_SOCKET.t_flags], TF_RCVD_TSTMP
  374.         jz      .no_timestamp
  375.  
  376.   .timestamp:
  377.         pushd   0
  378.         pushd   [timer_ticks]
  379.         pushd   TCP_OPT_NOP + TCP_OPT_NOP shl 8 + TCP_OPT_TIMESTAMP shl 16 + 10 shl 24
  380.         add     di, 12
  381.  
  382.         DEBUGF  1,"TCP_send: added timestamp\n"
  383.  
  384.   .no_timestamp:
  385.  
  386.         ; <Add additional options here>
  387.  
  388.   .options_done:
  389.  
  390. ; eax = socket ptr
  391. ; edx = flags
  392. ; edi = header size
  393. ; esi = data len
  394.  
  395. ;---------------------------------------------
  396. ; check if we dont exceed the max segment size (270)
  397.  
  398.         add     esi, edi                        ; total TCP segment size
  399.         cmp     esi, [eax + TCP_SOCKET.t_maxseg]
  400.         jbe     .no_overflow
  401.  
  402.         mov     esi, [eax + TCP_SOCKET.t_maxseg]
  403.         or      [eax + TCP_SOCKET.temp_bits], TCP_BIT_SENDALOT
  404.   .no_overflow:
  405.  
  406. ;-----------------------------------------------------------------
  407. ; Start by pushing all TCP header values in reverse order on stack
  408. ; (essentially, creating the tcp header on the stack!)
  409.  
  410.         pushw   0       ;        .UrgentPointer          dw ?
  411.         pushw   0       ;        .Checksum               dw ?
  412.         pushw   0x00a0  ;        .Window                 dw ?    ;;;;;;; FIXME (370)
  413.         shl     edi, 2  ;        .DataOffset             db ?  only 4 left-most bits
  414.         shl     dx, 8
  415.         or      dx, di  ;        .Flags                  db ?
  416.         pushw   dx
  417.         shr     edi, 2  ;        .DataOffset             db ?
  418.  
  419.         push    [eax + TCP_SOCKET.RCV_NXT]      ;        .AckNumber              dd ?
  420.         ntohd   [esp]
  421.  
  422.         push    [eax + TCP_SOCKET.SND_NXT]      ;        .SequenceNumber         dd ?
  423.         ntohd   [esp]
  424.  
  425.         push    [eax + TCP_SOCKET.RemotePort]   ;        .DestinationPort        dw ?
  426.         push    [eax + TCP_SOCKET.LocalPort]    ;        .SourcePort             dw ?
  427.  
  428.         push    edi                     ; header size
  429.  
  430. ;---------------------
  431. ; Create the IP packet
  432.  
  433.         mov     ecx, esi
  434.  
  435.         mov     ebx, [eax + SOCKET.device]
  436.         mov     edx, [eax + IP_SOCKET.LocalIP]  ; source ip
  437.         mov     eax, [eax + IP_SOCKET.RemoteIP] ; dest ip
  438.         mov     di, IP_PROTO_TCP shl 8 + 128
  439.         call    IPv4_output
  440.         jz      .ip_error
  441.  
  442. ;-----------------------------------------
  443. ; Move TCP header from stack to TCP packet
  444.  
  445.         push    ecx
  446.         mov     ecx, [esp + 4]
  447.         lea     esi, [esp + 8]
  448.         shr     ecx, 2                  ; count is in bytes, we will work with dwords
  449.         rep     movsd
  450.         pop     ecx                     ; full TCP packet size
  451.  
  452.         pop     esi                     ; headersize
  453.         add     esp, esi                ; remove it from stack
  454.  
  455.         push    edx                     ; packet size for send proc
  456.         push    eax                     ; packet ptr for send proc
  457.  
  458.         mov     edx, edi                ; begin of data
  459.         sub     edx, esi                ; begin of packet (edi = begin of data)
  460.         push    ecx
  461.         sub     ecx, esi                ; data size
  462.  
  463. ;--------------
  464. ; Copy the data
  465.  
  466. ; eax = ptr to ring struct
  467. ; ecx = buffer size
  468. ; edi = ptr to buffer
  469.  
  470.         mov     eax, [esp + 16]                 ; get socket ptr
  471.  
  472.         push    edx
  473.         push    [eax + TCP_SOCKET.SND_NXT]      ; we'll need this for timing the transmission
  474.         test    ecx, ecx
  475.         jz      .nodata
  476.         mov     edx, [eax + TCP_SOCKET.SND_NXT]
  477.         add     [eax + TCP_SOCKET.SND_NXT], ecx ; update sequence number <<< CHECKME
  478.         sub     edx, [eax + TCP_SOCKET.SND_UNA] ; offset
  479.         add     eax, STREAM_SOCKET.snd
  480.         call    SOCKET_ring_read
  481.   .nodata:
  482.         pop     edi
  483.         pop     esi                             ; begin of data
  484.         pop     ecx                             ; full packet size
  485.         mov     eax, [esp + 12]                 ; socket ptr
  486.  
  487. ;----------------------------------
  488. ; initialize retransmit timer (400)
  489.  
  490. ;TODO: check t_force and persist
  491.  
  492.         test    [esi + TCP_header.Flags], TH_SYN + TH_FIN       ; syn and fin take a sequence number
  493.         jz      @f
  494.         inc     [eax + TCP_SOCKET.SND_NXT]
  495.         test    [esi + TCP_header.Flags], TH_FIN
  496.         jz      @f
  497.         or      [eax + TCP_SOCKET.t_flags], TF_SENTFIN          ; if we sent a fin, set the sentfin flag
  498.        @@:
  499.  
  500.         mov     edx, [eax + TCP_SOCKET.SND_NXT]
  501.         cmp     edx, [eax + TCP_SOCKET.SND_MAX]                 ; is this a retransmission?
  502.         jbe     @f
  503.         mov     [eax + TCP_SOCKET.SND_MAX], edx                 ; [eax + TCP_SOCKET.SND_NXT] from before we updated it
  504.  
  505.         cmp     [eax + TCP_SOCKET.t_rtt], 0                     ; are we currently timing anything?
  506.         je      @f
  507.         mov     [eax + TCP_SOCKET.t_rtt], 1                     ; nope, start transmission timer
  508.         mov     [eax + TCP_SOCKET.t_rtseq], edi
  509. ;TODO: update stats
  510.        @@:
  511.  
  512. ; set retransmission timer if not already set, and not doing an ACK or keepalive probe
  513.  
  514.         cmp     [eax + TCP_SOCKET.timer_retransmission], 0 ;;;; FIXME
  515.         ja      .retransmit_set
  516.  
  517.         cmp     edx, [eax + TCP_SOCKET.SND_UNA]                 ; edx is still [eax + TCP_SOCKET.SND_NXT]
  518.         je      .retransmit_set
  519.  
  520.         mov     edx, [eax + TCP_SOCKET.t_rxtcur]
  521.         mov     [eax + TCP_SOCKET.timer_retransmission], edx
  522.  
  523.         cmp     [eax + TCP_SOCKET.timer_persist], 0
  524.         jne     .retransmit_set
  525.         mov     [eax + TCP_SOCKET.timer_persist], 0
  526.         mov     [eax + TCP_SOCKET.t_rxtshift], 0
  527.  
  528.   .retransmit_set:
  529.  
  530. ;--------------------
  531. ; Create the checksum
  532.  
  533.         TCP_checksum (eax + IP_SOCKET.LocalIP), (eax + IP_SOCKET.RemoteIP)
  534.         mov     [esi + TCP_header.Checksum], dx
  535.  
  536. ; unlock socket
  537.         lea     ecx, [eax + SOCKET.mutex]
  538.         call    mutex_unlock
  539.  
  540. ;----------------
  541. ; Send the packet
  542.  
  543.         DEBUGF  1,"TCP_send: Sending with device %x\n", ebx
  544.         call    [ebx + NET_DEVICE.transmit]
  545.         jnz     .send_error
  546.  
  547. ;---------------
  548. ; Ok, data sent!
  549.  
  550.         pop     ecx
  551.         pop     eax
  552.  
  553.         inc     [TCP_segments_tx]       ; FIXME: correct interface?
  554.  
  555. ; unlock socket
  556.         lea     ecx, [eax + SOCKET.mutex]
  557.         call    mutex_lock
  558.  
  559. ; update advertised receive window
  560.         test    ecx, ecx
  561.         jz      @f
  562.         add     ecx, [eax + TCP_SOCKET.RCV_NXT]
  563.         cmp     ecx, [eax + TCP_SOCKET.RCV_ADV]
  564.         jbe     @f
  565.         mov     [eax + TCP_SOCKET.RCV_ADV], ecx
  566.        @@:
  567.  
  568. ; update last ack sent
  569.         push    [eax + TCP_SOCKET.RCV_NXT]
  570.         pop     [eax + TCP_SOCKET.last_ack_sent]
  571.  
  572. ; and flags
  573.         and     [eax + TCP_SOCKET.t_flags], not (TF_ACKNOW + TF_DELACK)
  574.  
  575.         test    [eax + TCP_SOCKET.temp_bits], TCP_BIT_SENDALOT
  576.         jnz     TCP_output.again
  577.  
  578. ; unlock socket
  579.         lea     ecx, [eax + SOCKET.mutex]
  580.         call    mutex_unlock
  581.  
  582.         DEBUGF 1,"TCP_send: success!\n"
  583.  
  584.         xor     eax, eax
  585.         ret
  586.  
  587.  
  588.   .ip_error:
  589.         pop     ecx
  590.         add     esp, ecx
  591.         add     esp, 4
  592.         pop     eax
  593.  
  594.         mov     [eax + TCP_SOCKET.timer_retransmission], TCP_time_re_min
  595.  
  596. ; unlock socket
  597.         lea     ecx, [eax + SOCKET.mutex]
  598.         call    mutex_unlock
  599.  
  600.         DEBUGF 1,"TCP_send: IP error\n"
  601.  
  602.         or      eax, -1
  603.         ret
  604.  
  605.   .send_error:
  606.         add     esp, 8
  607.  
  608.         DEBUGF 1,"TCP_send: sending failed\n"
  609.  
  610.         or      eax, -2
  611.         ret
  612.  
  613.  
  614.  
  615.  
  616.  
  617.  
  618.