Subversion Repositories Kolibri OS

Rev

Rev 7680 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  2. ;;                                                                 ;;
  3. ;; Copyright (C) KolibriOS team 2004-2020. 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: 7974 $
  18.  
  19. align 4
  20. iglobal
  21.         TCP_backoff     db 0,1,2,3,4,5,6,6,6,6,6,6,6
  22. endg
  23.  
  24. macro   tcp_checksum IP1, IP2 {
  25.  
  26. ;-------------
  27. ; Pseudoheader
  28.  
  29.         ; protocol type
  30.         mov     edx, IP_PROTO_TCP
  31.  
  32.         ; source address
  33.         add     dl, byte [IP1+1]
  34.         adc     dh, byte [IP1+0]
  35.         adc     dl, byte [IP1+3]
  36.         adc     dh, byte [IP1+2]
  37.  
  38.         ; destination address
  39.         adc     dl, byte [IP2+1]
  40.         adc     dh, byte [IP2+0]
  41.         adc     dl, byte [IP2+3]
  42.         adc     dh, byte [IP2+2]
  43.  
  44.         ; size
  45.         adc     dl, cl
  46.         adc     dh, ch
  47.  
  48.         adc     edx, 0
  49.  
  50. ;---------------------
  51. ; Real header and data
  52.  
  53.         push    esi
  54.         call    checksum_1
  55.         call    checksum_2
  56.         pop     esi
  57.  
  58. }       ; returns in dx only
  59.  
  60.  
  61.  
  62.  
  63. macro   tcp_sendseqinit ptr {
  64.  
  65.         push    edi                     ;;;; FIXME: i dont like this static use of edi
  66.         mov     edi, [ptr + TCP_SOCKET.ISS]
  67.         mov     [ptr + TCP_SOCKET.SND_UP], edi
  68.         mov     [ptr + TCP_SOCKET.SND_MAX], edi
  69.         mov     [ptr + TCP_SOCKET.SND_NXT], edi
  70.         mov     [ptr + TCP_SOCKET.SND_UNA], edi
  71.         pop     edi
  72.  
  73. }
  74.  
  75.  
  76.  
  77. macro   tcp_rcvseqinit ptr {
  78.  
  79.         push    edi
  80.         mov     edi, [ptr + TCP_SOCKET.IRS]
  81.         inc     edi                             ; SYN ocupies a sequence number
  82.         mov     [ptr + TCP_SOCKET.RCV_NXT], edi
  83.         mov     [ptr + TCP_SOCKET.RCV_ADV], edi
  84.         pop     edi
  85.  
  86. }
  87.  
  88.  
  89.  
  90. macro   tcp_init_socket socket {
  91.  
  92. ; new tcp control block
  93.  
  94.         mov     [socket + TCP_SOCKET.t_maxseg], TCP_mss_default
  95.         mov     [socket + TCP_SOCKET.t_flags], TF_REQ_SCALE or TF_REQ_TSTMP
  96.  
  97.         mov     [socket + TCP_SOCKET.t_srtt], TCP_time_srtt_default
  98.         mov     [socket + TCP_SOCKET.t_rttvar], TCP_time_rtt_default * 4
  99.         mov     [socket + TCP_SOCKET.t_rttmin], TCP_time_re_min
  100. ;;; TODO: TCP_time_rangeset
  101.  
  102.         mov     [socket + TCP_SOCKET.SND_CWND], TCP_max_win shl TCP_max_winshift
  103.         mov     [socket + TCP_SOCKET.SND_SSTHRESH], TCP_max_win shl TCP_max_winshift
  104.  
  105.         mov     [socket + TCP_SOCKET.RCV_SCALE], 0
  106.         mov     [socket + TCP_SOCKET.SND_SCALE], 0
  107.  
  108. }
  109.  
  110.  
  111. ;-----------------------------------------------------------------;
  112. ;                                                                 ;
  113. ; tcp_pull_out_of_band                                            ;
  114. ;                                                                 ;
  115. ;  IN:  eax = ?                                                   ;
  116. ;       ebx = socket ptr                                          ;
  117. ;       edx = tcp packet ptr                                      ;
  118. ;                                                                 ;
  119. ; OUT:  /                                                         ;
  120. ;                                                                 ;
  121. ;-----------------------------------------------------------------;
  122. align 4
  123. tcp_pull_out_of_band:
  124.  
  125.         DEBUGF  DEBUG_NETWORK_VERBOSE, "tcp_pull_out_of_band\n"
  126.  
  127.         ;;;; 1282-1305
  128.  
  129.         ret
  130.  
  131.  
  132.  
  133. ;-----------------------------------------------------------------;
  134. ;                                                                 ;
  135. ; tcp_drop                                                        ;
  136. ;                                                                 ;
  137. ;  IN:  eax = socket ptr                                          ;
  138. ;       ebx = error number                                        ;
  139. ;                                                                 ;
  140. ;  OUT: eax = socket ptr                                          ;
  141. ;                                                                 ;
  142. ;-----------------------------------------------------------------;
  143. align 4
  144. tcp_drop:
  145.  
  146. ;;; TODO: check if error code is "Connection timed out' and handle accordingly
  147.  
  148.         DEBUGF  DEBUG_NETWORK_VERBOSE, "tcp_drop: %x\n", eax
  149.  
  150.         cmp     [eax + TCP_SOCKET.t_state], TCPS_SYN_RECEIVED
  151.         jb      .no_syn_received
  152.  
  153.         mov     [eax + TCP_SOCKET.t_state], TCPS_CLOSED
  154.  
  155.         push    eax
  156.         call    tcp_output
  157.         pop     eax
  158.  
  159.         inc     [TCPS_drops]
  160.  
  161.         mov     [eax + SOCKET.errorcode], ebx
  162.         jmp     tcp_close
  163.  
  164.   .no_syn_received:
  165.         inc     [TCPS_conndrops]
  166.  
  167.         mov     [eax + SOCKET.errorcode], ebx
  168.         jmp     tcp_close
  169.  
  170.  
  171. ;-----------------------------------------------------------------;
  172. ;                                                                 ;
  173. ; tcp_disconnect                                                  ;
  174. ;                                                                 ;
  175. ;  IN:  eax = socket ptr                                          ;
  176. ;                                                                 ;
  177. ;  OUT: eax = socket ptr / 0                                      ;
  178. ;                                                                 ;
  179. ;-----------------------------------------------------------------;
  180. align 4
  181. tcp_disconnect:
  182.  
  183.         DEBUGF  DEBUG_NETWORK_VERBOSE, "TCP_disconnect: %x\n", eax
  184.  
  185.         cmp     [eax + TCP_SOCKET.t_state], TCPS_ESTABLISHED
  186.         jb      tcp_close       ; Connection not yet synchronised, just get rid of the socket
  187.  
  188. ; TODO: implement LINGER
  189.  
  190.         call    socket_is_disconnecting
  191.         call    tcp_usrclosed
  192.  
  193.         test    eax, eax
  194.         jz      @f
  195.         push    eax
  196.         call    tcp_output
  197.         pop     eax
  198.   @@:
  199.         ret
  200.  
  201.  
  202. ;-----------------------------------------------------------------;
  203. ;                                                                 ;
  204. ; tcp_close                                                       ;
  205. ;                                                                 ;
  206. ;  IN:  eax = socket ptr                                          ;
  207. ;                                                                 ;
  208. ;  OUT: /                                                         ;
  209. ;                                                                 ;
  210. ;-----------------------------------------------------------------;
  211. align 4
  212. tcp_close:
  213.  
  214.         DEBUGF  DEBUG_NETWORK_VERBOSE, "TCP_close: %x\n", eax
  215.  
  216. ;;; TODO: update RTT and mean deviation
  217. ;;; TODO: update slow start threshold
  218.  
  219.         call    socket_is_disconnected
  220.         call    socket_free
  221.  
  222.         inc     [TCPS_closed]
  223.  
  224.         xor     eax, eax
  225.         ret
  226.  
  227.  
  228.  
  229. ;-----------------------------------------------------------------;
  230. ;                                                                 ;
  231. ; tcp_outflags                                                    ;
  232. ;                                                                 ;
  233. ;  IN:  eax = socket ptr                                          ;
  234. ;                                                                 ;
  235. ;  OUT: edx = flags                                               ;
  236. ;                                                                 ;
  237. ;-----------------------------------------------------------------;
  238. align 4
  239. tcp_outflags:
  240.  
  241.         mov     edx, [eax + TCP_SOCKET.t_state]
  242.         movzx   edx, byte[edx + .flaglist]
  243.  
  244.         DEBUGF  DEBUG_NETWORK_VERBOSE, "TCP_outflags: socket=%x flags=%x\n", eax, dl
  245.  
  246.         ret
  247.  
  248.   .flaglist:
  249.         db      TH_RST + TH_ACK         ; TCPS_CLOSED
  250.         db      0                       ; TCPS_LISTEN
  251.         db      TH_SYN                  ; TCPS_SYN_SENT
  252.         db      TH_SYN + TH_ACK         ; TCPS_SYN_RECEIVED
  253.         db               TH_ACK         ; TCPS_ESTABLISHED
  254.         db               TH_ACK         ; TCPS_CLOSE_WAIT
  255.         db      TH_FIN + TH_ACK         ; TCPS_FIN_WAIT_1
  256.         db      TH_FIN + TH_ACK         ; TCPS_CLOSING
  257.         db      TH_FIN + TH_ACK         ; TCPS_LAST_ACK
  258.         db               TH_ACK         ; TCPS_FIN_WAIT_2
  259.         db               TH_ACK         ; TCPS_TIME_WAIT
  260.  
  261.  
  262. ;-----------------------------------------------------------------;
  263. ;                                                                 ;
  264. ; TCP_respond: Fast way to send an ACK/RST/keepalive segment.     ;
  265. ;                                                                 ;
  266. ;  IN:  ebx = socket ptr                                          ;
  267. ;        cl = flags                                               ;
  268. ;                                                                 ;
  269. ; OUT:  /                                                         ;
  270. ;                                                                 ;
  271. ;-----------------------------------------------------------------;
  272. align 4
  273. tcp_respond:
  274.  
  275.         DEBUGF  DEBUG_NETWORK_VERBOSE, "TCP_respond_socket: socket=%x flags=%x\n", ebx, cl
  276.  
  277. ;---------------------
  278. ; Create the IP packet
  279.  
  280.         push    cx ebx
  281.         mov     edx, [ebx + IP_SOCKET.LocalIP]
  282.         mov     edi, [ebx + IP_SOCKET.RemoteIP]
  283.         mov     al, [ebx + IP_SOCKET.ttl]
  284.         mov     ah, IP_PROTO_TCP
  285.         mov     ecx, sizeof.TCP_header
  286.         mov     ebx, [ebx + IP_SOCKET.device]
  287.         call    ipv4_output
  288.         jz      .error
  289.         pop     esi cx
  290.         push    eax
  291.  
  292. ;-----------------------------------------------
  293. ; Fill in the TCP header by using the socket ptr
  294.  
  295.         mov     ax, [esi + TCP_SOCKET.LocalPort]
  296.         stosw
  297.         mov     ax, [esi + TCP_SOCKET.RemotePort]
  298.         stosw
  299.         mov     eax, [esi + TCP_SOCKET.SND_NXT]
  300.         bswap   eax
  301.         stosd
  302.         mov     eax, [esi + TCP_SOCKET.RCV_NXT]
  303.         bswap   eax
  304.         stosd
  305.         mov     al, 0x50        ; Dataoffset: 20 bytes (TCP_header.DataOffset)
  306.         stosb
  307.         mov     al, cl
  308.         stosb
  309.         mov     eax, SOCKET_BUFFER_SIZE
  310.         sub     eax, [esi + STREAM_SOCKET.rcv.size]
  311.         cmp     eax, TCP_max_win
  312.         jbe     .lessthanmax
  313.         mov     eax, TCP_max_win
  314. .lessthanmax:
  315.         mov     cl, [esi + TCP_SOCKET.RCV_SCALE]
  316.         shr     eax, cl
  317.  
  318.         xchg    al, ah
  319.         stosw                   ; window
  320.         xor     eax, eax
  321.         stosd                   ; checksum + urgentpointer
  322.  
  323. ;---------------------
  324. ; Fill in the checksum
  325.  
  326.   .checksum:
  327.         sub     edi, sizeof.TCP_header
  328.         mov     ecx, sizeof.TCP_header
  329.         xchg    esi, edi
  330.         tcp_checksum (edi + IP_SOCKET.LocalIP), (edi + IP_SOCKET.RemoteIP)
  331.         mov     [esi+TCP_header.Checksum], dx
  332.  
  333. ;--------------------
  334. ; And send the segment
  335.  
  336.         call    [ebx + NET_DEVICE.transmit]
  337.         test    eax, eax
  338.         jnz     @f
  339.         call    net_ptr_to_num4
  340.         inc     [TCP_segments_tx + edi]
  341.        @@:
  342.         ret
  343.  
  344.   .error:
  345.         DEBUGF  DEBUG_NETWORK_VERBOSE, "TCP_respond_socket: failed\n"
  346.         add     esp, 2 + 4
  347.  
  348.         ret
  349.  
  350.  
  351. ;-----------------------------------------------------------------;
  352. ;                                                                 ;
  353. ; tcp_respond_segment                                             ;
  354. ;                                                                 ;
  355. ;  IN:  ebx = device ptr                                          ;
  356. ;       edx = segment ptr (a previously received segment)         ;
  357. ;       edi = ptr to IPv4 header                                  ;
  358. ;        cl = flags                                               ;
  359. ;                                                                 ;
  360. ;  OUT: /                                                         ;
  361. ;                                                                 ;
  362. ;-----------------------------------------------------------------;
  363. align 4
  364. tcp_respond_segment:
  365.  
  366.         DEBUGF  DEBUG_NETWORK_VERBOSE, "TCP_respond_segment: frame=%x flags=%x\n", edx, cl
  367.  
  368. ;---------------------
  369. ; Create the IP packet
  370.  
  371.         push    cx edx
  372.         mov     edx, [edi + IPv4_header.DestinationAddress]
  373.         mov     edi, [edi + IPv4_header.SourceAddress]
  374.         mov     ecx, sizeof.TCP_header
  375.         mov     ax, IP_PROTO_TCP shl 8 + 128
  376.         call    ipv4_output
  377.         jz      .error
  378.         pop     esi cx
  379.  
  380.         push    eax
  381.  
  382. ;---------------------------------------------------
  383. ; Fill in the TCP header by using a received segment
  384.  
  385.         mov     ax, [esi + TCP_header.DestinationPort]
  386.         stosw
  387.         mov     ax, [esi + TCP_header.SourcePort]
  388.         stosw
  389.         mov     eax, [esi + TCP_header.AckNumber]
  390.         bswap   eax
  391.         stosd
  392.         xor     eax, eax
  393.         stosd
  394.         mov     al, 0x50        ; Dataoffset: 20 bytes (sizeof.TCP_header/4 shl 4)
  395.         stosb
  396.         mov     al, cl
  397.         stosb
  398.         mov     ax, 1280
  399.         rol     ax, 8
  400.         stosw                   ; window
  401.         xor     eax, eax
  402.         stosd                   ; checksum + urgentpointer
  403.  
  404. ;---------------------
  405. ; Fill in the checksum
  406.  
  407.         lea     esi, [edi - sizeof.TCP_header]
  408.         mov     ecx, sizeof.TCP_header
  409.         tcp_checksum (esi - sizeof.IPv4_header + IPv4_header.DestinationAddress),\      ; FIXME
  410.                      (esi - sizeof.IPv4_header + IPv4_header.SourceAddress)
  411.         mov     [esi + TCP_header.Checksum], dx
  412.  
  413. ;--------------------
  414. ; And send the segment
  415.  
  416.         call    [ebx + NET_DEVICE.transmit]
  417.         test    eax, eax
  418.         jnz     @f
  419.         call    net_ptr_to_num4
  420.         inc     [TCP_segments_tx + edi]
  421.        @@:
  422.         ret
  423.  
  424.   .error:
  425.         DEBUGF  DEBUG_NETWORK_VERBOSE, "TCP_respond_segment: failed\n"
  426.         add     esp, 2+4
  427.  
  428.         ret
  429.  
  430.  
  431. macro   tcpt_rangeset   timer, value, min, max {
  432.  
  433. local   .min
  434. local   .max
  435. local   .done
  436.  
  437.         cmp     value, min
  438.         jb      .min
  439.         cmp     value, max
  440.         ja      .max
  441.         mov     timer, value
  442.         jmp     .done
  443.   .min:
  444.         mov     timer, min
  445.         jmp     .done
  446.   .max:
  447.         mov     timer, max
  448.   .done:
  449. }
  450.  
  451. ;-----------------------------------------------------------------;
  452. ;                                                                 ;
  453. ; tcp_set_persist                                                 ;
  454. ;                                                                 ;
  455. ;-----------------------------------------------------------------;
  456. align 4
  457. tcp_set_persist:
  458.  
  459.         DEBUGF  DEBUG_NETWORK_VERBOSE, "TCP_set_persist\n"
  460.  
  461. ; First, check if retransmit timer is not set, retransmit and persist are mutually exclusive
  462.  
  463.         test    [eax + TCP_SOCKET.timer_flags], timer_flag_retransmission
  464.         jnz     .exit
  465.  
  466. ; calculate RTO
  467.         push    ebx
  468.         mov     ebx, [eax + TCP_SOCKET.t_srtt]
  469.         shr     ebx, 2
  470.         add     ebx, [eax + TCP_SOCKET.t_rttvar]
  471.         shr     ebx, 1
  472.  
  473.         mov     cl, [eax + TCP_SOCKET.t_rxtshift]
  474.         shl     ebx, cl
  475.  
  476. ; Start/restart persistance timer.
  477.  
  478.         tcpt_rangeset [eax + TCP_SOCKET.timer_persist], ebx, TCP_time_pers_min, TCP_time_pers_max
  479.         or      [ebx + TCP_SOCKET.timer_flags], timer_flag_persist
  480.         pop     ebx
  481.  
  482.         cmp     [eax + TCP_SOCKET.t_rxtshift], TCP_max_rxtshift
  483.         jae     @f
  484.         inc     [eax + TCP_SOCKET.t_rxtshift]
  485.       @@:
  486.   .exit:
  487.  
  488.         ret
  489.  
  490.  
  491.  
  492. ;-----------------------------------------------------------------;
  493. ;                                                                 ;
  494. ; tcp_xmit_timer: Calculate new smoothed RTT.                     ;
  495. ;                                                                 ;
  496. ;   IN: eax = rtt                                                 ;
  497. ;       ebx = socket ptr                                          ;
  498. ;                                                                 ;
  499. ;  OUT: /                                                         ;
  500. ;                                                                 ;
  501. ;-----------------------------------------------------------------;
  502. align 4
  503. tcp_xmit_timer:
  504.  
  505.         DEBUGF  DEBUG_NETWORK_VERBOSE, "TCP_xmit_timer: socket=0x%x rtt=%d0ms\n", ebx, eax
  506.  
  507.         inc     [TCPS_rttupdated]
  508.  
  509.         cmp     [ebx + TCP_SOCKET.t_rtt], 0
  510.         je      .no_rtt_yet
  511.  
  512. ; srtt is stored as a fixed point with 3 bits after the binary point.
  513. ; The following magic is equivalent of the smoothing algorithm in rfc793 with an alpha of .875
  514. ; (srtt = rtt/8 + srtt*7/8 in fixed point)
  515. ; Adjust rtt to origin 0.
  516.  
  517.         push    ecx
  518.         mov     ecx, [ebx + TCP_SOCKET.t_srtt]
  519.         shr     ecx, TCP_RTT_SHIFT
  520.         sub     eax, ecx
  521.         dec     eax
  522.         pop     ecx
  523.  
  524.         add     [ebx + TCP_SOCKET.t_srtt], eax
  525.         ja      @f
  526.         mov     [ebx + TCP_SOCKET.t_srtt], 1
  527.   @@:
  528.  
  529. ; We accumulate a smoothed rtt variance (actually, a smoothed mean difference),
  530. ; then set the retransmit timer to smoothed rtt + 4 times the smoothed variance.
  531. ; rttvar is stored as fixed point with 2 bits after the binary point.
  532. ; The following is equivalent to rfc793 smoothing with an alpha of .75
  533. ; (rttvar = rttvar*3/4 + delta/4) (delta = eax)
  534.  
  535. ; get abs(eax)
  536.         push    edx
  537.         cdq
  538.         xor     eax, edx
  539.         sub     eax, edx
  540.  
  541.         mov     edx, [ebx + TCP_SOCKET.t_rttvar]
  542.         shr     edx, TCP_RTTVAR_SHIFT
  543.         sub     eax, edx
  544.         pop     edx
  545.  
  546.         add     [ebx + TCP_SOCKET.t_rttvar], eax
  547.         ja      @f
  548.         mov     [ebx + TCP_SOCKET.t_rttvar], 1
  549.   @@:
  550.         ret
  551.  
  552.  
  553.   .no_rtt_yet:
  554.         push    ecx
  555.         mov     ecx, eax
  556.         shl     ecx, TCP_RTT_SHIFT
  557.         mov     [ebx + TCP_SOCKET.t_srtt], ecx
  558.  
  559.         shl     eax, TCP_RTTVAR_SHIFT - 1
  560.         mov     [ebx + TCP_SOCKET.t_rttvar], eax
  561.         pop     ecx
  562.  
  563.         ret
  564.  
  565.  
  566. ;-----------------------------------------------------------------;
  567. ;                                                                 ;
  568. ; tcp_mss: Update maximum segment size                            ;
  569. ;                                                                 ;
  570. ;  IN:  eax = max segment size                                    ;
  571. ;       ebx = socket ptr                                          ;
  572. ;                                                                 ;
  573. ;  OUT: /                                                         ;
  574. ;                                                                 ;
  575. ;-----------------------------------------------------------------;
  576. align 4
  577. tcp_mss:
  578.  
  579.         cmp     eax, 1420       ; FIXME
  580.         jbe     @f
  581.         mov     eax, 1420
  582.   @@:
  583.         mov     [ebx + TCP_SOCKET.t_maxseg], eax
  584.  
  585.  
  586.         ret
  587.  
  588.  
  589.  
  590. ;-----------------------------------------------------------------;
  591. ;                                                                 ;
  592. ; tcp_reassemble                                                  ;
  593. ;                                                                 ;
  594. ;   IN: ebx = socket ptr                                          ;
  595. ;       edx = segment ptr                                         ;
  596. ;                                                                 ;
  597. ;  OUT: /                                                         ;
  598. ;                                                                 ;
  599. ;-----------------------------------------------------------------;
  600. align 4
  601. tcp_reassemble:
  602.  
  603.         ;;;;; TODO
  604.  
  605.         ret
  606.  
  607.