00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054
00055
00056
00057
00058
00059
00060
00061
00062
00063
00064
00065
00066
00067
00068
00069
00070
00071
00072
00073
00074
00075
00076
00077
00078
00079
00080
00081
00082
00083
00084
00085
00086
00087
00088
00089
00090
00091
00092
00093
00094
00095
00096
00097
00098
00099
00100
00101
00102
00103
00104
00105
00106
00107
00108
00109
00110
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125
00126
00127
00128
00129
00130
00131
00132
00133
00134
00135
00136
00137
00138
00139
00140
00141
00142
00143
00144
00145
00146
00147
00148
00149
00150
00151
00152
00153
00154
00155
00156
00157
00158
00159
00160
00161
00162
00163
00164
00165
00166
00167
00168
00169
00170
00171
00172
00173
00174
00175
00176
00177
00178
00179
00180
00181
00182
00183
00184
00185
00186
00187
00188
00189
00190
00191
00192
00193
00194
00195
00196
00197
00198
00199
00200
00201
00202
00203
00204
00205
00206
00207
00208
00209
00210
00211
00212
00213
00214
00215
00216
00217
00218
00219
00220
00221
00222
00223
00224
00225
00226
00227
00228
00229
00230
00231
00232
00233
00234
00235
00236 #include <cfg/os.h>
00237 #include <cfg/tcp.h>
00238
00239 #include <sys/thread.h>
00240 #include <sys/heap.h>
00241 #include <sys/event.h>
00242 #include <sys/timer.h>
00243
00244 #include <errno.h>
00245 #include <netinet/in.h>
00246 #include <netinet/ip.h>
00247 #include <net/route.h>
00248 #include <sys/socket.h>
00249 #include <netinet/tcputil.h>
00250 #include <netinet/tcp.h>
00251
00252 #ifdef NUTDEBUG
00253 #include <net/netdebug.h>
00254 #endif
00255
00256 #ifndef NUT_THREAD_TCPSMSTACK
00257 #if defined(__AVR__)
00258 #if defined(__GNUC__)
00259
00260 #define NUT_THREAD_TCPSMSTACK 256
00261 #else
00262
00263 #define NUT_THREAD_TCPSMSTACK 512
00264 #endif
00265 #else
00266
00267 #define NUT_THREAD_TCPSMSTACK 384
00268 #endif
00269 #endif
00270
00271 #ifndef TCP_RETRIES_MAX
00272 #define TCP_RETRIES_MAX 7
00273 #endif
00274
00275 extern TCPSOCKET *tcpSocketList;
00276
00281
00282 HANDLE tcp_in_rdy;
00283 NETBUF *volatile tcp_in_nbq;
00284 static uint16_t tcp_in_cnt;
00285 static HANDLE tcpThread = 0;
00286
00287 static size_t tcp_adv_cnt;
00288 static size_t tcp_adv_max = TCP_WINSIZE;
00289
00290
00291
00292
00293
00294
00295
00304 static void NutTcpInputOptions(TCPSOCKET * sock, NETBUF * nb)
00305 {
00306 uint8_t *cp;
00307 uint16_t s;
00308
00309
00310 if (nb->nb_tp.sz <= sizeof (TCPHDR))
00311 return;
00312
00313
00314 for (cp = ((uint8_t*) nb->nb_tp.vp) + sizeof(TCPHDR); (*cp != TCPOPT_EOL)
00315 && (cp - (uint8_t *)nb->nb_tp.vp < (int)nb->nb_tp.sz); )
00316 {
00317 switch (*cp)
00318 {
00319
00320 case TCPOPT_NOP:
00321 cp++;
00322 continue;
00323
00324
00325 case TCPOPT_MAXSEG:
00326 s = ntohs(((uint16_t)cp[2] << 8) | cp[3]);
00327 if (s < sock->so_mss)
00328 sock->so_mss = s;
00329 cp += TCPOLEN_MAXSEG;
00330 break;
00331
00332 default:
00333 cp += *(uint8_t*) (cp + 1);
00334 break;
00335 }
00336 }
00337 }
00338
00347 static void NutTcpProcessAppData(TCPSOCKET * sock, NETBUF * nb)
00348 {
00349
00350
00351
00352 if (sock->so_rx_buf) {
00353 NETBUF *nbp = sock->so_rx_buf;
00354
00355 while (nbp->nb_next)
00356 nbp = nbp->nb_next;
00357 nbp->nb_next = nb;
00358 } else
00359 sock->so_rx_buf = nb;
00360
00361
00362
00363
00364
00365 sock->so_rx_cnt += nb->nb_ap.sz;
00366 sock->so_rx_nxt += nb->nb_ap.sz;
00367
00368
00369
00370
00371 if (nb->nb_ap.sz >= sock->so_rx_win)
00372 sock->so_rx_win = 0;
00373 else
00374 sock->so_rx_win -= nb->nb_ap.sz;
00375
00376
00377
00378
00379
00380
00381 sock->so_tx_flags |= SO_ACK;
00382 if (nb->nb_next)
00383 nb->nb_next = 0;
00384 else
00385 sock->so_tx_flags |= SO_FORCE;
00386
00387 if (++sock->so_rx_apc > 8) {
00388 NETBUF *nbq;
00389 int_fast8_t apc = sock->so_rx_apc;
00390 int cnt = sock->so_rx_cnt;
00391
00392 for (nbq = sock->so_rx_buf; nbq; nbq = nbq->nb_next) {
00393 if (nbq->nb_ap.sz < 256) {
00394 sock->so_rx_apc -= NutNetBufCollect(nbq, cnt);
00395 break;
00396 }
00397 if (--apc < 8) {
00398 break;
00399 }
00400 cnt -= nbq->nb_ap.sz;
00401 }
00402 }
00403 NutTcpOutput(sock, 0, 0);
00404 }
00405
00406
00407
00408
00409 static void NutTcpProcessSyn(TCPSOCKET * sock, IPHDR * ih, TCPHDR * th)
00410 {
00411 uint16_t mss;
00412 NUTDEVICE *dev;
00413 IFNET *nif;
00414
00415 sock->so_local_addr = ih->ip_dst;
00416 sock->so_remote_port = th->th_sport;
00417 sock->so_remote_addr = ih->ip_src;
00418
00419 sock->so_rx_nxt = sock->so_tx_wl1 = sock->so_rx_isn = ntohl(th->th_seq);
00420 sock->so_rx_nxt++;
00421 sock->so_tx_win = ntohs(th->th_win);
00422
00423
00424
00425
00426
00427
00428 if ((dev = NutIpRouteQuery(ih->ip_src, 0)) != 0) {
00429 nif = dev->dev_icb;
00430 mss = nif->if_mtu - sizeof(IPHDR) - sizeof(TCPHDR);
00431 if (sock->so_mss == 0 || sock->so_mss > mss)
00432 sock->so_mss = mss;
00433
00434
00435 if (sock->so_devobsz > sock->so_mss)
00436 sock->so_devobsz = sock->so_mss;
00437 }
00438 }
00439
00447 static int NutTcpProcessAck(TCPSOCKET * sock, TCPHDR * th, uint16_t length)
00448 {
00449 NETBUF *nb;
00450 uint32_t h_seq;
00451 uint32_t h_ack;
00452
00453
00454
00455
00456 h_ack = ntohl(th->th_ack);
00457 if (h_ack > sock->so_tx_nxt) {
00458 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00459 return 0;
00460 }
00461
00462
00463
00464
00465
00466
00467 if (h_ack == sock->so_tx_una) {
00468 h_seq = ntohl(th->th_seq);
00469 if (h_seq > sock->so_tx_wl1 || (h_seq == sock->so_tx_wl1 && h_ack >= sock->so_tx_wl2)) {
00470 sock->so_tx_win = ntohs(th->th_win);
00471 sock->so_tx_wl1 = h_seq;
00472 sock->so_tx_wl2 = h_ack;
00473 }
00474 }
00475
00476
00477
00478
00479
00480 if (h_ack < sock->so_tx_una) {
00481 return 0;
00482 }
00483
00484
00485
00486
00487 if (h_ack == sock->so_tx_una) {
00488
00489
00490
00491
00492 if (sock->so_tx_nbq && length == 0 && (th->th_flags & (TH_SYN | TH_FIN)) == 0) {
00493
00494
00495
00496
00497 if (++sock->so_tx_dup >= 3) {
00498 sock->so_tx_dup = 0;
00499 #ifdef NUTDEBUG
00500 if (__tcp_trf)
00501 NutDumpTcpHeader(__tcp_trs, "RET", sock, sock->so_tx_nbq);
00502 #endif
00503
00504
00505
00506
00507 if (NutTcpStateRetranTimeout(sock))
00508 return -1;
00509 }
00510 }
00511 return 0;
00512 }
00513
00514
00515
00516
00517 sock->so_tx_dup = 0;
00518 sock->so_tx_una = h_ack;
00519
00520
00521
00522
00523
00524
00525 sock->so_tx_win = ntohs(th->th_win);
00526
00527
00528
00529
00530 if (sock->so_rtt_seq && sock->so_rtt_seq < h_ack)
00531 NutTcpCalcRtt (sock);
00532 sock->so_rtt_seq = 0;
00533
00534
00535
00536 while ((nb = sock->so_tx_nbq) != 0) {
00537
00538 h_seq = ntohl(((TCPHDR *) (nb->nb_tp.vp))->th_seq) + nb->nb_ap.sz;
00539 if (((TCPHDR *) (nb->nb_tp.vp))->th_flags & (TH_SYN | TH_FIN)) {
00540 h_seq++;
00541 }
00542
00543 if (h_seq > h_ack) {
00544 break;
00545 }
00546 sock->so_tx_nbq = nb->nb_next;
00547 NutNetBufFree(nb);
00548 }
00549
00550
00551
00552
00553 if (sock->so_tx_nbq) {
00554 sock->so_retran_time = (uint16_t) NutGetMillis() | 1;
00555 } else {
00556 sock->so_retran_time = 0;
00557 }
00558 sock->so_retransmits = 0;
00559
00560 return 0;
00561 }
00562
00563
00564
00565
00566
00567
00568
00577 static int NutTcpStateChange(TCPSOCKET * sock, uint8_t state)
00578 {
00579 int rc = 0;
00580 ureg_t txf = 0;
00581
00582 switch (sock->so_state) {
00583
00584 case TCPS_ESTABLISHED:
00585 switch (state) {
00586 case TCPS_FIN_WAIT_1:
00587
00588
00589
00590 sock->so_tx_flags |= SO_FIN | SO_ACK;
00591 txf = 1;
00592
00593 #ifdef RTLCONNECTHACK
00594
00595
00596
00597
00598
00599
00600
00601
00602
00603 NutDelay(5);
00604 #endif
00605 break;
00606 case TCPS_CLOSE_WAIT:
00607
00608
00609
00610 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00611 txf = 1;
00612 break;
00613 default:
00614 rc = -1;
00615 break;
00616 }
00617 break;
00618
00619 case TCPS_LISTEN:
00620
00621
00622
00623 if (state == TCPS_SYN_RECEIVED) {
00624 sock->so_tx_flags |= SO_SYN | SO_ACK;
00625 txf = 1;
00626 #ifdef RTLCONNECTHACK
00627
00628
00629
00630
00631
00632
00633
00634
00635
00636 NutDelay(5);
00637 #endif
00638 } else
00639 rc = -1;
00640 break;
00641
00642 case TCPS_SYN_SENT:
00643 switch (state) {
00644 case TCPS_LISTEN:
00645
00646
00647
00648 break;
00649 case TCPS_SYN_RECEIVED:
00650
00651
00652
00653 sock->so_tx_flags |= SO_SYN | SO_ACK;
00654 txf = 1;
00655 break;
00656 case TCPS_ESTABLISHED:
00657
00658
00659
00660 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00661 txf = 1;
00662 break;
00663 default:
00664 rc = -1;
00665 break;
00666 }
00667 break;
00668
00669 case TCPS_SYN_RECEIVED:
00670 switch (state) {
00671 case TCPS_LISTEN:
00672
00673
00674
00675 break;
00676 case TCPS_ESTABLISHED:
00677
00678
00679
00680 break;
00681 case TCPS_FIN_WAIT_1:
00682
00683
00684
00685 sock->so_tx_flags |= SO_FIN;
00686 txf = 1;
00687 break;
00688 case TCPS_CLOSE_WAIT:
00689
00690
00691
00692 sock->so_tx_flags |= SO_FIN | SO_ACK;
00693 txf = 1;
00694 break;
00695 default:
00696 rc = -1;
00697 break;
00698 }
00699 break;
00700
00701 case TCPS_FIN_WAIT_1:
00702 switch (state) {
00703 case TCPS_FIN_WAIT_1:
00704 case TCPS_FIN_WAIT_2:
00705
00706
00707
00708 break;
00709 case TCPS_CLOSING:
00710
00711
00712
00713 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00714 txf = 1;
00715 break;
00716 case TCPS_TIME_WAIT:
00717
00718
00719
00720 break;
00721 default:
00722 rc = -1;
00723 break;
00724 }
00725 break;
00726
00727 case TCPS_FIN_WAIT_2:
00728
00729
00730
00731 if (state != TCPS_TIME_WAIT)
00732 rc = -1;
00733 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00734 txf = 1;
00735 break;
00736
00737 case TCPS_CLOSE_WAIT:
00738
00739
00740
00741 if (state == TCPS_LAST_ACK) {
00742 sock->so_tx_flags |= SO_FIN | SO_ACK;
00743 txf = 1;
00744 } else
00745 rc = -1;
00746 break;
00747
00748 case TCPS_CLOSING:
00749
00750
00751
00752 if (state != TCPS_TIME_WAIT)
00753 rc = -1;
00754 break;
00755
00756 case TCPS_LAST_ACK:
00757 rc = -1;
00758 break;
00759
00760 case TCPS_TIME_WAIT:
00761 rc = -1;
00762 break;
00763
00764 case TCPS_CLOSED:
00765 switch (state) {
00766 case TCPS_LISTEN:
00767
00768
00769
00770 break;
00771 case TCPS_SYN_SENT:
00772
00773
00774
00775 sock->so_tx_flags |= SO_SYN;
00776 txf = 1;
00777 break;
00778 default:
00779 rc = -1;
00780 break;
00781 }
00782 break;
00783 }
00784 #ifdef NUTDEBUG
00785 if (__tcp_trf) {
00786 fprintf(__tcp_trs, " %04x-", (unsigned int) sock);
00787 if (rc)
00788 NutDumpSockState(__tcp_trs, sock->so_state, "**ERR ", "**>");
00789 NutDumpSockState(__tcp_trs, state, "[>", "]");
00790 }
00791 #endif
00792
00793 if (rc == 0) {
00794 sock->so_state = state;
00795 if (txf && NutTcpOutput(sock, 0, 0)) {
00796 if (state == TCPS_SYN_SENT) {
00797 rc = -1;
00798 sock->so_last_error = EHOSTDOWN;
00799 NutEventPostAsync(&sock->so_ac_tq);
00800 }
00801 }
00802 if (state == TCPS_CLOSE_WAIT) {
00803
00804
00805
00806 NutEventBroadcast(&sock->so_rx_tq);
00807 NutEventBroadcast(&sock->so_pc_tq);
00808 NutEventBroadcast(&sock->so_ac_tq);
00809 }
00810 }
00811 return rc;
00812 }
00813
00814
00815
00816
00817
00826 int NutTcpStatePassiveOpenEvent(TCPSOCKET * sock)
00827 {
00828 if (sock->so_state != TCPS_CLOSED)
00829 return (sock->so_last_error = EISCONN);
00830
00831 NutTcpStateChange(sock, TCPS_LISTEN);
00832
00833
00834
00835
00836 NutEventWait(&sock->so_pc_tq, 0);
00837
00838 return 0;
00839 }
00840
00851 int NutTcpStateActiveOpenEvent(TCPSOCKET * sock)
00852 {
00853
00854
00855
00856
00857 NutTcpStateChange(sock, TCPS_SYN_SENT);
00858
00859
00860
00861
00862 if(sock->so_state == TCPS_SYN_SENT)
00863 NutEventWait(&sock->so_ac_tq, 0);
00864
00865 if (sock->so_state != TCPS_ESTABLISHED)
00866 return -1;
00867
00868 return 0;
00869 }
00870
00883 int NutTcpStateCloseEvent(TCPSOCKET * sock)
00884 {
00885 if (sock == 0)
00886 return -1;
00887
00888 NutThreadYield();
00889
00890 switch (sock->so_state) {
00891 case TCPS_LISTEN:
00892 case TCPS_SYN_SENT:
00893 case TCPS_CLOSED:
00894
00895
00896
00897 NutTcpDestroySocket(sock);
00898 break;
00899
00900 case TCPS_SYN_RECEIVED:
00901 case TCPS_ESTABLISHED:
00902
00903
00904
00905
00906 NutTcpStateChange(sock, TCPS_FIN_WAIT_1);
00907 break;
00908
00909 case TCPS_CLOSE_WAIT:
00910
00911
00912
00913
00914 NutTcpStateChange(sock, TCPS_LAST_ACK);
00915 break;
00916
00917 case TCPS_FIN_WAIT_1:
00918 case TCPS_FIN_WAIT_2:
00919 case TCPS_CLOSING:
00920 case TCPS_LAST_ACK:
00921 case TCPS_TIME_WAIT:
00922 sock->so_last_error = EALREADY;
00923 return -1;
00924
00925 default:
00926 sock->so_last_error = ENOTCONN;
00927 return -1;
00928 }
00929 return 0;
00930 }
00931
00938 int NutTcpStateWindowEvent(TCPSOCKET * sock)
00939 {
00940 if (sock == 0)
00941 return -1;
00942 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00943 NutTcpOutput(sock, 0, 0);
00944
00945 return 0;
00946 }
00947
00948
00949
00950
00951
00963 int NutTcpStateRetranTimeout(TCPSOCKET * sock)
00964 {
00965 NETBUF *so_tx_next;
00966 if (sock->so_retransmits++ > TCP_RETRIES_MAX)
00967 {
00968
00969 NutTcpAbortSocket(sock, ETIMEDOUT);
00970 return -1;
00971 } else {
00972 #ifdef NUTDEBUG
00973 if (__tcp_trf)
00974 NutDumpTcpHeader(__tcp_trs, "RET", sock, sock->so_tx_nbq);
00975 #endif
00976
00977
00978
00979
00980 so_tx_next = sock->so_tx_nbq->nb_next;
00981 if (NutIpOutput(IPPROTO_TCP, sock->so_remote_addr, sock->so_tx_nbq)) {
00982
00983 sock->so_tx_nbq = so_tx_next;
00984
00985 NutTcpAbortSocket(sock, ENETDOWN);
00986 return -1;
00987 } else {
00988
00989 sock->so_retran_time = (uint16_t) NutGetMillis() | 1;
00990 return 0;
00991 }
00992 }
00993 }
00994
00995
00996
00997
00998
00999
01009 static void NutTcpStateListen(TCPSOCKET * sock, uint8_t flags, TCPHDR * th, NETBUF * nb)
01010 {
01011
01012
01013
01014
01015 if ((flags & (TH_SYN | TH_ACK | TH_RST)) == TH_SYN) {
01016 NutTcpProcessSyn(sock, nb->nb_nw.vp, th);
01017 NutTcpStateChange(sock, TCPS_SYN_RECEIVED);
01018 NutNetBufFree(nb);
01019 } else
01020 NutTcpReject(nb);
01021 }
01022
01023
01032 static void NutTcpStateSynSent(TCPSOCKET * sock, uint8_t flags, TCPHDR * th, NETBUF * nb)
01033 {
01034
01035
01036
01037 if (flags & TH_ACK) {
01038 if (!IsInLimits(ntohl(th->th_ack), sock->so_tx_isn + 1, sock->so_tx_nxt)) {
01039 NutTcpReject(nb);
01040 return;
01041 }
01042 }
01043
01044
01045
01046
01047
01048
01049 if (flags & TH_RST) {
01050 if (flags & TH_ACK) {
01051
01052
01053
01054 NutTcpAbortSocket(sock, ECONNREFUSED);
01055 }
01056 NutNetBufFree(nb);
01057 return;
01058 }
01059
01060
01061
01062
01063
01064
01065 if (flags & TH_SYN) {
01066 NutTcpProcessSyn(sock, nb->nb_nw.vp, th);
01067 if (flags & TH_ACK) {
01068 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01069 NutTcpStateChange(sock, TCPS_ESTABLISHED);
01070
01071 NutEventPost(&sock->so_ac_tq);
01072 } else {
01073 NutTcpStateChange(sock, TCPS_SYN_RECEIVED);
01074 }
01075 }
01076 NutNetBufFree(nb);
01077 }
01078
01079
01080
01081
01082
01083
01084
01085
01086
01087
01088
01089
01090 static void NutTcpStateSynReceived(TCPSOCKET * sock, uint8_t flags, TCPHDR * th, NETBUF * nb)
01091 {
01092
01093
01094
01095
01096 if (flags & TH_RST) {
01097 if (sock->so_pc_tq)
01098 NutTcpStateChange(sock, TCPS_LISTEN);
01099 else
01100 NutTcpAbortSocket(sock, ECONNREFUSED);
01101 NutNetBufFree(nb);
01102 sock->so_retran_time = 0;
01103 NutTcpDiscardBuffers(sock);
01104 return;
01105 }
01106
01107
01108
01109
01110 if (flags & TH_SYN) {
01111 NutTcpReject(nb);
01112 return;
01113 }
01114
01115
01116
01117
01118 if ((flags & TH_ACK) == 0) {
01119 NutNetBufFree(nb);
01120 return;
01121 }
01122
01123
01124
01125
01126 if (!IsInLimits(ntohl(th->th_ack), sock->so_tx_una + 1, sock->so_tx_nxt)) {
01127 NutTcpReject(nb);
01128 return;
01129 }
01130
01131
01132 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01133
01134
01135
01136
01137
01138
01139
01140 if (nb->nb_ap.sz)
01141 NutTcpProcessAppData(sock, nb);
01142 else
01143 NutNetBufFree(nb);
01144
01145
01146
01147
01148 if (flags & TH_FIN) {
01149 sock->so_rx_nxt++;
01150 NutTcpStateChange(sock, TCPS_CLOSE_WAIT);
01151 } else {
01152 NutTcpStateChange(sock, TCPS_ESTABLISHED);
01153 NutEventPost(&sock->so_pc_tq);
01154 NutEventPost(&sock->so_ac_tq);
01155 }
01156 }
01157
01158
01159
01160
01161
01162
01163
01164
01165
01166
01167
01168
01169
01170
01171
01172 static void NutTcpStateEstablished(TCPSOCKET * sock, uint8_t flags, TCPHDR * th, NETBUF * nb)
01173 {
01174 if (flags & TH_RST) {
01175 NutNetBufFree(nb);
01176 NutTcpAbortSocket(sock, ECONNRESET);
01177 return;
01178 }
01179
01180
01181
01182
01183
01184 if (flags & TH_SYN) {
01185 if (htonl(th->th_seq) != sock->so_rx_isn)
01186 NutTcpReject(nb);
01187 else
01188 NutNetBufFree(nb);
01189 return;
01190 }
01191
01192
01193
01194
01195 if ((flags & TH_ACK) == 0) {
01196 NutNetBufFree(nb);
01197 return;
01198 }
01199
01200 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01201
01202
01203
01204
01205
01206
01207
01208 if (htonl(th->th_seq) > sock->so_rx_nxt) {
01209 NETBUF *nbq;
01210 NETBUF **nbqp;
01211 TCPHDR *thq;
01212 uint32_t th_seq;
01213 uint32_t thq_seq;
01214
01215 if (nb->nb_ap.sz) {
01216
01217
01218 tcp_adv_cnt += nb->nb_dl.sz + sizeof(IPHDR) + sizeof (TCPHDR) + nb->nb_ap.sz;
01219 if (tcp_adv_cnt > tcp_adv_max) {
01220
01221 NutNetBufFree(nb);
01222 tcp_adv_cnt -= nb->nb_dl.sz + sizeof(IPHDR) + sizeof (TCPHDR) + nb->nb_ap.sz;
01223 } else {
01224 nbq = sock->so_rx_nbq;
01225 nbqp = &sock->so_rx_nbq;
01226 while (nbq) {
01227 thq = (TCPHDR *) (nbq->nb_tp.vp);
01228 th_seq = htonl(th->th_seq);
01229 thq_seq = htonl(thq->th_seq);
01230 if (th_seq < thq_seq) {
01231 *nbqp = nb;
01232 nb->nb_next = nbq;
01233 break;
01234 }
01235 if (th_seq == thq_seq) {
01236 NutNetBufFree(nb);
01237 sock->so_tx_flags |= SO_ACK | SO_FORCE;
01238 NutTcpOutput(sock, 0, 0);
01239 return;
01240 }
01241 nbqp = &nbq->nb_next;
01242 nbq = nbq->nb_next;
01243 }
01244 if (nbq == 0) {
01245 *nbqp = nb;
01246 nb->nb_next = 0;
01247 }
01248 }
01249 } else
01250 NutNetBufFree(nb);
01251
01252 sock->so_tx_flags |= SO_ACK | SO_FORCE;
01253 NutTcpOutput(sock, 0, 0);
01254 return;
01255 }
01256
01257
01258
01259
01260
01261
01262
01263
01264 if (htonl(th->th_seq) != sock->so_rx_nxt) {
01265 sock->so_tx_flags |= SO_ACK | SO_FORCE;
01266
01267 sock->so_oos_drop++;
01268 NutNetBufFree(nb);
01269 NutTcpOutput(sock, 0, 0);
01270 }
01271
01272
01273
01274
01275 else if (nb->nb_ap.sz) {
01276 NutTcpProcessAppData(sock, nb);
01277
01278
01279
01280 while ((nb = sock->so_rx_nbq) != 0) {
01281 th = (TCPHDR *) (nb->nb_tp.vp);
01282 if (htonl(th->th_seq) > sock->so_rx_nxt)
01283 break;
01284 sock->so_rx_nbq = nb->nb_next;
01285
01286
01287 tcp_adv_cnt -= nb->nb_dl.sz + sizeof(IPHDR) + sizeof (TCPHDR) + nb->nb_ap.sz;
01288 if (htonl(th->th_seq) == sock->so_rx_nxt) {
01289 NutTcpProcessAppData(sock, nb);
01290 flags |= th->th_flags;
01291 } else
01292 NutNetBufFree(nb);
01293 }
01294
01295 NutEventPost(&sock->so_rx_tq);
01296 } else {
01297 NutNetBufFree(nb);
01298
01299
01300 }
01301 if (flags & TH_FIN) {
01302
01303 sock->so_rx_nxt++;
01304 NutTcpStateChange(sock, TCPS_CLOSE_WAIT);
01305 }
01306 }
01307
01308
01309
01310
01311
01312
01313
01314
01315
01316
01317
01318
01319
01320
01321
01322
01323 static void NutTcpStateFinWait1(TCPSOCKET * sock, uint8_t flags, TCPHDR * th, NETBUF * nb)
01324 {
01325
01326 if (flags & TH_RST) {
01327 NutNetBufFree(nb);
01328 NutTcpDestroySocket(sock);
01329 return;
01330 }
01331
01332
01333
01334
01335 if (flags & TH_SYN) {
01336 NutTcpReject(nb);
01337 return;
01338 }
01339
01340
01341
01342
01343 if ((flags & TH_ACK) == 0) {
01344 NutNetBufFree(nb);
01345 return;
01346 }
01347
01348
01349
01350
01351
01352 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01353
01354
01355
01356
01357
01358 if (sock->so_tx_nxt == sock->so_tx_una) {
01359
01360 NutTcpStateChange(sock, TCPS_FIN_WAIT_2);
01361 }
01362
01363
01364
01365
01366
01367 if (nb->nb_ap.sz) {
01368 NutTcpProcessAppData(sock, nb);
01369
01370 NutEventPost(&sock->so_rx_tq);
01371 }
01372 else
01373 NutNetBufFree(nb);
01374
01375 if (flags & TH_FIN) {
01376 sock->so_rx_nxt++;
01377
01378
01379
01380 sock->so_time_wait = 0;
01381
01382 if (sock->so_state == TCPS_FIN_WAIT_2)
01383 NutTcpStateChange(sock, TCPS_TIME_WAIT);
01384 else
01385 NutTcpStateChange(sock, TCPS_CLOSING);
01386 }
01387 }
01388
01389
01390
01391
01392
01393
01394
01395
01396
01397
01398
01399
01400
01401
01402 static void NutTcpStateFinWait2(TCPSOCKET * sock, uint8_t flags, TCPHDR * th, NETBUF * nb)
01403 {
01404
01405 if (flags & TH_RST) {
01406 NutNetBufFree(nb);
01407 NutTcpDestroySocket(sock);
01408 return;
01409 }
01410
01411
01412
01413
01414 if (flags & TH_SYN) {
01415 NutTcpReject(nb);
01416 return;
01417 }
01418
01419
01420
01421
01422 if ((flags & TH_ACK) == 0) {
01423 NutNetBufFree(nb);
01424 return;
01425 }
01426
01427
01428
01429
01430
01431
01432 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01433
01434
01435
01436 if (nb->nb_ap.sz) {
01437 NutTcpProcessAppData(sock, nb);
01438
01439 NutEventPost(&sock->so_rx_tq);
01440 }
01441 else
01442 NutNetBufFree(nb);
01443
01444 if (flags & TH_FIN) {
01445 sock->so_rx_nxt++;
01446 sock->so_time_wait = 0;
01447
01448 NutTcpStateChange(sock, TCPS_TIME_WAIT);
01449 }
01450 }
01451
01452
01453
01454
01455
01456
01457
01458
01459
01460
01461
01462 static void NutTcpStateCloseWait(TCPSOCKET * sock, uint8_t flags, TCPHDR * th, NETBUF * nb)
01463 {
01464
01465 if (flags & TH_RST) {
01466 NutNetBufFree(nb);
01467 NutTcpAbortSocket(sock, ECONNRESET);
01468 return;
01469 }
01470
01471
01472
01473
01474 if (flags & TH_SYN) {
01475 NutTcpReject(nb);
01476 return;
01477 }
01478
01479
01480
01481
01482 if ((flags & TH_ACK) == 0) {
01483 NutNetBufFree(nb);
01484 return;
01485 }
01486
01487 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01488
01489 NutNetBufFree(nb);
01490 }
01491
01492
01493
01494
01495
01496
01497
01498
01499
01500
01501
01502
01503
01504 static void NutTcpStateClosing(TCPSOCKET * sock, uint8_t flags, TCPHDR * th, NETBUF * nb)
01505 {
01506
01507 if (flags & TH_RST) {
01508 NutNetBufFree(nb);
01509 NutTcpDestroySocket(sock);
01510 return;
01511 }
01512
01513
01514
01515
01516 if (flags & TH_SYN) {
01517 NutTcpReject(nb);
01518 return;
01519 }
01520
01521
01522
01523
01524 if ((flags & TH_ACK) == 0) {
01525 NutNetBufFree(nb);
01526 return;
01527 }
01528
01529 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01530
01531
01532
01533
01534 if (sock->so_tx_nxt == sock->so_tx_una) {
01535 sock->so_time_wait = 0;
01536 NutTcpStateChange(sock, TCPS_TIME_WAIT);
01537
01538 }
01539
01540
01541 NutNetBufFree(nb);
01542 }
01543
01558 static void NutTcpStateLastAck(TCPSOCKET * sock, uint8_t flags, TCPHDR * th, NETBUF * nb)
01559 {
01560
01561 if (flags & TH_RST) {
01562 NutNetBufFree(nb);
01563 NutTcpDestroySocket(sock);
01564 return;
01565 }
01566
01567
01568
01569
01570 if (flags & TH_SYN) {
01571 NutTcpReject(nb);
01572 return;
01573 }
01574
01575
01576
01577
01578 if ((flags & TH_ACK) == 0) {
01579 NutNetBufFree(nb);
01580 return;
01581 }
01582
01583 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01584 NutNetBufFree(nb);
01585
01586 if (sock->so_tx_nxt == sock->so_tx_una)
01587 NutTcpDestroySocket(sock);
01588
01589 }
01590
01601 static void NutTcpStateProcess(TCPSOCKET * sock, NETBUF * nb)
01602 {
01603 uint32_t tx_win;
01604 uint32_t tx_una;
01605 TCPHDR *th = (TCPHDR *) nb->nb_tp.vp;
01606 uint8_t flags = th->th_flags;
01607
01608 #ifdef NUTDEBUG
01609 if (__tcp_trf) {
01610 fprintf(__tcp_trs, " %04x-", (unsigned int) sock);
01611 NutDumpSockState(__tcp_trs, sock->so_state, "[", ">]");
01612 }
01613 #endif
01614 switch (sock->so_state) {
01615
01616 case TCPS_ESTABLISHED:
01617 tx_win = sock->so_tx_win;
01618 tx_una = sock->so_tx_una;
01619 NutTcpStateEstablished(sock, flags, th, nb);
01620
01621 if(sock->so_state != TCPS_ESTABLISHED ||
01622 sock->so_tx_win > tx_win ||
01623 sock->so_tx_una > tx_una) {
01624 NutEventBroadcast(&sock->so_tx_tq);
01625 }
01626 break;
01627 case TCPS_LISTEN:
01628 NutTcpStateListen(sock, flags, th, nb);
01629 break;
01630 case TCPS_SYN_SENT:
01631 NutTcpStateSynSent(sock, flags, th, nb);
01632 break;
01633 case TCPS_SYN_RECEIVED:
01634 NutTcpStateSynReceived(sock, flags, th, nb);
01635 break;
01636 case TCPS_FIN_WAIT_1:
01637 NutTcpStateFinWait1(sock, flags, th, nb);
01638 break;
01639 case TCPS_FIN_WAIT_2:
01640 NutTcpStateFinWait2(sock, flags, th, nb);
01641 break;
01642 case TCPS_CLOSE_WAIT:
01643 NutTcpStateCloseWait(sock, flags, th, nb);
01644 break;
01645 case TCPS_CLOSING:
01646 NutTcpStateClosing(sock, flags, th, nb);
01647 break;
01648 case TCPS_LAST_ACK:
01649 NutTcpStateLastAck(sock, flags, th, nb);
01650 break;
01651 case TCPS_TIME_WAIT:
01652
01653
01654
01655 NutNetBufFree(nb);
01656 break;
01657 case TCPS_CLOSED:
01658
01659
01660
01661 NutTcpReject(nb);
01662 break;
01663 default:
01664 NutNetBufFree(nb);
01665 break;
01666 }
01667 }
01668
01675 THREAD(NutTcpSm, arg)
01676 {
01677 NETBUF *nb;
01678 NETBUF *nbx;
01679 TCPHDR *th;
01680 IPHDR *ih;
01681 TCPSOCKET *sock;
01682 uint8_t tac = 0;
01683
01684
01685
01686
01687
01688 NutThreadSetPriority (32);
01689
01690 for (;;) {
01691 if (++tac > 3 || NutEventWait(&tcp_in_rdy, 200)) {
01692 tac = 0;
01693 for (sock = tcpSocketList; sock; sock = sock->so_next) {
01694
01695
01696
01697
01698 if (sock->so_tx_flags & SO_ACK) {
01699 sock->so_tx_flags |= SO_FORCE;
01700 NutTcpOutput(sock, 0, 0);
01701 }
01702
01703
01704
01705
01706 if (sock->so_tx_nbq && sock->so_retran_time) {
01707 if ((uint16_t)NutGetMillis() - (sock->so_retran_time & ~1) >= sock->so_rtto) {
01708 NutTcpStateRetranTimeout(sock);
01709 }
01710 }
01711
01712
01713
01714
01715 if (sock->so_state == TCPS_TIME_WAIT || sock->so_state == TCPS_FIN_WAIT_2) {
01716 if (sock->so_time_wait++ >= 9) {
01717 NutTcpDestroySocket(sock);
01718 break;
01719 }
01720 }
01721
01722
01723
01724
01725 else if (sock->so_state == TCPS_SYN_RECEIVED) {
01726 if (sock->so_time_wait++ >= 45) {
01727 sock->so_state = TCPS_LISTEN;
01728 sock->so_time_wait = 0;
01729 }
01730 }
01731 }
01732 } else {
01733 nb = tcp_in_nbq;
01734 tcp_in_nbq = 0;
01735 tcp_in_cnt = 0;
01736 while (nb) {
01737 ih = (IPHDR *) nb->nb_nw.vp;
01738 th = (TCPHDR *) nb->nb_tp.vp;
01739 sock = NutTcpFindSocket(th->th_dport, th->th_sport, ih->ip_src);
01740 #ifdef NUTDEBUG
01741 if (__tcp_trf)
01742 NutDumpTcpHeader(__tcp_trs, " IN", sock, nb);
01743 #endif
01744 nbx = nb->nb_next;
01745 if (sock) {
01746 NutTcpInputOptions(sock, nb);
01747 NutTcpStateProcess(sock, nb);
01748 }
01749
01750
01751
01752
01753 else
01754 NutTcpReject(nb);
01755 nb = nbx;
01756 }
01757 }
01758 }
01759 }
01760
01772 void NutTcpStateMachine(NETBUF * nb)
01773 {
01774 NETBUF *nbp;
01775 uint16_t size;
01776
01777 nb->nb_next = 0;
01778
01779
01780
01781
01782
01783
01784
01785 if (tcpThread == 0) {
01786 NutTcpReject(nb);
01787 return;
01788 }
01789
01790 if ((nbp = tcp_in_nbq) == 0) {
01791 tcp_in_nbq = nb;
01792 NutEventPost(&tcp_in_rdy);
01793 } else {
01794 size = nb->nb_nw.sz + nb->nb_tp.sz + nb->nb_ap.sz;
01795 if (tcp_in_cnt + size + 2048 < NutHeapAvailable()) {
01796 tcp_in_cnt += size;
01797 while (nbp->nb_next)
01798 nbp = nbp->nb_next;
01799 nbp->nb_next = nb;
01800 NutEventPost(&tcp_in_rdy);
01801 } else
01802 NutNetBufFree(nb);
01803 }
01804 }
01805
01814 int NutTcpInitStateMachine(void)
01815 {
01816 if (tcpThread == 0 && (tcpThread = NutThreadCreate("tcpsm", NutTcpSm, NULL,
01817 (NUT_THREAD_TCPSMSTACK * NUT_THREAD_STACK_MULT) + NUT_THREAD_STACK_ADD)) == 0)
01818 return -1;
01819 return 0;
01820 }
01821
01835 int NutTcpAbortSocket(TCPSOCKET * sock, uint16_t last_error)
01836 {
01837 sock->so_last_error = last_error;
01838 sock->so_retran_time = 0;
01839 sock->so_time_wait = 0;
01840
01841
01842
01843
01844
01845 if (sock->so_state >= TCPS_FIN_WAIT_1)
01846 sock->so_state = TCPS_TIME_WAIT;
01847 else
01848 sock->so_state = TCPS_CLOSED;
01849 NutTcpDiscardBuffers(sock);
01850 NutEventBroadcast(&sock->so_rx_tq);
01851 NutEventBroadcast(&sock->so_tx_tq);
01852 NutEventBroadcast(&sock->so_pc_tq);
01853 NutEventBroadcast(&sock->so_ac_tq);
01854 return 0;
01855 }
01856