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 #include <cfg/os.h>
00215 #include <cfg/tcp.h>
00216
00217 #include <sys/thread.h>
00218 #include <sys/heap.h>
00219 #include <sys/event.h>
00220 #include <sys/timer.h>
00221
00222 #include <net/errno.h>
00223 #include <netinet/in.h>
00224 #include <netinet/ip.h>
00225 #include <net/route.h>
00226 #include <sys/socket.h>
00227 #include <netinet/tcputil.h>
00228 #include <netinet/tcp.h>
00229
00230 #ifdef NUTDEBUG
00231 #include <net/netdebug.h>
00232 #endif
00233
00234 #ifndef NUT_THREAD_TCPSMSTACK
00235 #define NUT_THREAD_TCPSMSTACK 512
00236 #endif
00237
00238 extern TCPSOCKET *tcpSocketList;
00239
00244
00245 HANDLE tcp_in_rdy;
00246 NETBUF *volatile tcp_in_nbq;
00247 static u_short tcp_in_cnt;
00248 static HANDLE tcpThread = 0;
00249
00250
00251
00252
00253
00254
00263 static void NutTcpInputOptions(TCPSOCKET * sock, NETBUF * nb)
00264 {
00265 u_char *cp;
00266 u_short s;
00267
00268
00269 if (nb->nb_tp.sz <= sizeof (TCPHDR))
00270 return;
00271
00272
00273 for (cp = ((u_char*) nb->nb_tp.vp) + sizeof(TCPHDR); (*cp != TCPOPT_EOL)
00274 && (cp - (u_char *)nb->nb_tp.vp < (int)nb->nb_tp.sz); )
00275 {
00276 switch (*cp)
00277 {
00278
00279 case TCPOPT_NOP:
00280 cp++;
00281 continue;
00282
00283
00284 case TCPOPT_MAXSEG:
00285 s = ntohs(((u_short)cp[2] << 8) | cp[3]);
00286 if (s < sock->so_mss)
00287 sock->so_mss = s;
00288 cp += TCPOLEN_MAXSEG;
00289 break;
00290
00291 default:
00292 cp += *(u_char*) (cp + 1);
00293 break;
00294 }
00295 }
00296 }
00297
00306 static void NutTcpProcessAppData(TCPSOCKET * sock, NETBUF * nb)
00307 {
00308
00309
00310
00311 if (sock->so_rx_buf) {
00312 NETBUF *nbp = sock->so_rx_buf;
00313
00314 while (nbp->nb_next)
00315 nbp = nbp->nb_next;
00316 nbp->nb_next = nb;
00317 } else
00318 sock->so_rx_buf = nb;
00319
00320
00321
00322
00323
00324 sock->so_rx_cnt += nb->nb_ap.sz;
00325 sock->so_rx_nxt += nb->nb_ap.sz;
00326
00327
00328
00329
00330 if (nb->nb_ap.sz >= sock->so_rx_win)
00331 sock->so_rx_win = 0;
00332 else
00333 sock->so_rx_win -= nb->nb_ap.sz;
00334
00335
00336
00337
00338
00339
00340 sock->so_tx_flags |= SO_ACK;
00341 if (nb->nb_next)
00342 nb->nb_next = 0;
00343 else
00344 sock->so_tx_flags |= SO_FORCE;
00345
00346 NutTcpOutput(sock, 0, 0);
00347 }
00348
00349
00350
00351
00352 static void NutTcpProcessSyn(TCPSOCKET * sock, IPHDR * ih, TCPHDR * th)
00353 {
00354 u_short mss;
00355 NUTDEVICE *dev;
00356 IFNET *nif;
00357
00358 sock->so_local_addr = ih->ip_dst;
00359 sock->so_remote_port = th->th_sport;
00360 sock->so_remote_addr = ih->ip_src;
00361
00362 sock->so_rx_nxt = sock->so_tx_wl1 = sock->so_rx_isn = ntohl(th->th_seq);
00363 sock->so_rx_nxt++;
00364 sock->so_tx_win = ntohs(th->th_win);
00365
00366
00367
00368
00369
00370
00371 if ((dev = NutIpRouteQuery(ih->ip_src, 0)) != 0) {
00372 nif = dev->dev_icb;
00373 mss = nif->if_mtu - sizeof(IPHDR) - sizeof(TCPHDR);
00374 if (sock->so_mss == 0 || sock->so_mss > mss)
00375 sock->so_mss = mss;
00376
00377
00378 if (sock->so_devobsz > sock->so_mss)
00379 sock->so_devobsz = sock->so_mss;
00380 }
00381 }
00382
00390 static int NutTcpProcessAck(TCPSOCKET * sock, TCPHDR * th, u_short length)
00391 {
00392 NETBUF *nb;
00393 u_long h_seq;
00394 u_long h_ack;
00395
00396
00397
00398
00399 h_ack = ntohl(th->th_ack);
00400 if (h_ack > sock->so_tx_nxt) {
00401 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00402 return 0;
00403 }
00404
00405
00406
00407
00408
00409
00410 if (h_ack == sock->so_tx_una) {
00411 h_seq = ntohl(th->th_seq);
00412 if (h_seq > sock->so_tx_wl1 || (h_seq == sock->so_tx_wl1 && h_ack >= sock->so_tx_wl2)) {
00413 sock->so_tx_win = ntohs(th->th_win);
00414 sock->so_tx_wl1 = h_seq;
00415 sock->so_tx_wl2 = h_ack;
00416 }
00417 }
00418
00419
00420
00421
00422
00423 if (h_ack < sock->so_tx_una) {
00424 return 0;
00425 }
00426
00427
00428
00429
00430 if (h_ack == sock->so_tx_una) {
00431
00432
00433
00434
00435 if (sock->so_tx_nbq && length == 0 && (th->th_flags & (TH_SYN | TH_FIN)) == 0) {
00436
00437
00438
00439
00440 if (++sock->so_tx_dup >= 3) {
00441 sock->so_tx_dup = 0;
00442 #ifdef NUTDEBUG
00443 if (__tcp_trf)
00444 NutDumpTcpHeader(__tcp_trs, "RET", sock, sock->so_tx_nbq);
00445 #endif
00446
00447
00448
00449
00450 if (NutTcpStateRetranTimeout(sock))
00451 return -1;
00452 }
00453 }
00454 return 0;
00455 }
00456
00457
00458
00459
00460 sock->so_tx_dup = 0;
00461 sock->so_tx_una = h_ack;
00462
00463
00464
00465
00466
00467
00468 sock->so_tx_win = ntohs(th->th_win);
00469
00470
00471
00472
00473 if (sock->so_rtt_seq && sock->so_rtt_seq < h_ack)
00474 NutTcpCalcRtt (sock);
00475 sock->so_rtt_seq = 0;
00476
00477
00478
00479 while ((nb = sock->so_tx_nbq) != 0) {
00480
00481 h_seq = ntohl(((TCPHDR *) (nb->nb_tp.vp))->th_seq) + nb->nb_ap.sz;
00482 if (((TCPHDR *) (nb->nb_tp.vp))->th_flags & (TH_SYN | TH_FIN)) {
00483 h_seq++;
00484 }
00485
00486 if (h_seq > h_ack) {
00487 break;
00488 }
00489 sock->so_tx_nbq = nb->nb_next;
00490 NutNetBufFree(nb);
00491 }
00492
00493
00494
00495
00496 if (sock->so_tx_nbq) {
00497 sock->so_retran_time = (u_short) NutGetMillis();
00498 } else {
00499 sock->so_retran_time = 0;
00500 }
00501 sock->so_retransmits = 0;
00502
00503 return 0;
00504 }
00505
00506
00507
00508
00509
00510
00511
00520 static int NutTcpStateChange(TCPSOCKET * sock, u_char state)
00521 {
00522 int rc = 0;
00523 ureg_t txf = 0;
00524
00525 switch (sock->so_state) {
00526
00527 case TCPS_ESTABLISHED:
00528 switch (state) {
00529 case TCPS_FIN_WAIT_1:
00530
00531
00532
00533 sock->so_tx_flags |= SO_FIN | SO_ACK;
00534 txf = 1;
00535
00536 #ifdef RTLCONNECTHACK
00537
00538
00539
00540
00541
00542
00543
00544
00545
00546 NutDelay(5);
00547 #endif
00548 break;
00549 case TCPS_CLOSE_WAIT:
00550
00551
00552
00553 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00554 txf = 1;
00555 break;
00556 default:
00557 rc = -1;
00558 break;
00559 }
00560 break;
00561
00562 case TCPS_LISTEN:
00563
00564
00565
00566 if (state == TCPS_SYN_RECEIVED) {
00567 sock->so_tx_flags |= SO_SYN | SO_ACK;
00568 txf = 1;
00569 #ifdef RTLCONNECTHACK
00570
00571
00572
00573
00574
00575
00576
00577
00578
00579 NutDelay(5);
00580 #endif
00581 } else
00582 rc = -1;
00583 break;
00584
00585 case TCPS_SYN_SENT:
00586 switch (state) {
00587 case TCPS_LISTEN:
00588
00589
00590
00591 break;
00592 case TCPS_SYN_RECEIVED:
00593
00594
00595
00596 sock->so_tx_flags |= SO_SYN | SO_ACK;
00597 txf = 1;
00598 break;
00599 case TCPS_ESTABLISHED:
00600
00601
00602
00603 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00604 txf = 1;
00605 break;
00606 default:
00607 rc = -1;
00608 break;
00609 }
00610 break;
00611
00612 case TCPS_SYN_RECEIVED:
00613 switch (state) {
00614 case TCPS_LISTEN:
00615
00616
00617
00618 break;
00619 case TCPS_ESTABLISHED:
00620
00621
00622
00623 break;
00624 case TCPS_FIN_WAIT_1:
00625
00626
00627
00628 sock->so_tx_flags |= SO_FIN;
00629 txf = 1;
00630 break;
00631 case TCPS_CLOSE_WAIT:
00632
00633
00634
00635 sock->so_tx_flags |= SO_FIN | SO_ACK;
00636 txf = 1;
00637 break;
00638 default:
00639 rc = -1;
00640 break;
00641 }
00642 break;
00643
00644 case TCPS_FIN_WAIT_1:
00645 switch (state) {
00646 case TCPS_FIN_WAIT_1:
00647 case TCPS_FIN_WAIT_2:
00648
00649
00650
00651 break;
00652 case TCPS_CLOSING:
00653
00654
00655
00656 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00657 txf = 1;
00658 break;
00659 case TCPS_TIME_WAIT:
00660
00661
00662
00663 break;
00664 default:
00665 rc = -1;
00666 break;
00667 }
00668 break;
00669
00670 case TCPS_FIN_WAIT_2:
00671
00672
00673
00674 if (state != TCPS_TIME_WAIT)
00675 rc = -1;
00676 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00677 txf = 1;
00678 break;
00679
00680 case TCPS_CLOSE_WAIT:
00681
00682
00683
00684 if (state == TCPS_LAST_ACK) {
00685 sock->so_tx_flags |= SO_FIN | SO_ACK;
00686 txf = 1;
00687 } else
00688 rc = -1;
00689 break;
00690
00691 case TCPS_CLOSING:
00692
00693
00694
00695 if (state != TCPS_TIME_WAIT)
00696 rc = -1;
00697 break;
00698
00699 case TCPS_LAST_ACK:
00700 rc = -1;
00701 break;
00702
00703 case TCPS_TIME_WAIT:
00704 rc = -1;
00705 break;
00706
00707 case TCPS_CLOSED:
00708 switch (state) {
00709 case TCPS_LISTEN:
00710
00711
00712
00713 break;
00714 case TCPS_SYN_SENT:
00715
00716
00717
00718 sock->so_tx_flags |= SO_SYN;
00719 txf = 1;
00720 break;
00721 default:
00722 rc = -1;
00723 break;
00724 }
00725 break;
00726 }
00727 #ifdef NUTDEBUG
00728 if (__tcp_trf) {
00729 fprintf(__tcp_trs, " %04x-", (u_int) sock);
00730 if (rc)
00731 NutDumpSockState(__tcp_trs, sock->so_state, "**ERR ", "**>");
00732 NutDumpSockState(__tcp_trs, state, "[>", "]");
00733 }
00734 #endif
00735
00736 if (rc == 0) {
00737 sock->so_state = state;
00738 if (txf && NutTcpOutput(sock, 0, 0)) {
00739 if (state == TCPS_SYN_SENT) {
00740 rc = -1;
00741 sock->so_last_error = EHOSTDOWN;
00742 NutEventPostAsync(&sock->so_ac_tq);
00743 }
00744 }
00745 if (state == TCPS_CLOSE_WAIT) {
00746
00747
00748
00749 NutEventBroadcast(&sock->so_rx_tq);
00750 NutEventBroadcast(&sock->so_pc_tq);
00751 NutEventBroadcast(&sock->so_ac_tq);
00752 }
00753 }
00754 return rc;
00755 }
00756
00757
00758
00759
00760
00769 int NutTcpStatePassiveOpenEvent(TCPSOCKET * sock)
00770 {
00771 if (sock->so_state != TCPS_CLOSED)
00772 return (sock->so_last_error = EISCONN);
00773
00774 NutTcpStateChange(sock, TCPS_LISTEN);
00775
00776
00777
00778
00779 NutEventWait(&sock->so_pc_tq, 0);
00780
00781 return 0;
00782 }
00783
00794 int NutTcpStateActiveOpenEvent(TCPSOCKET * sock)
00795 {
00796
00797
00798
00799
00800 NutTcpStateChange(sock, TCPS_SYN_SENT);
00801
00802
00803
00804
00805 if(sock->so_state == TCPS_SYN_SENT)
00806 NutEventWait(&sock->so_ac_tq, 0);
00807
00808 if (sock->so_state != TCPS_ESTABLISHED)
00809 return -1;
00810
00811 return 0;
00812 }
00813
00826 int NutTcpStateCloseEvent(TCPSOCKET * sock)
00827 {
00828 if (sock == 0)
00829 return -1;
00830
00831 NutThreadYield();
00832
00833 switch (sock->so_state) {
00834 case TCPS_LISTEN:
00835 case TCPS_SYN_SENT:
00836 case TCPS_CLOSED:
00837
00838
00839
00840 NutTcpDestroySocket(sock);
00841 break;
00842
00843 case TCPS_SYN_RECEIVED:
00844 case TCPS_ESTABLISHED:
00845
00846
00847
00848
00849 NutTcpStateChange(sock, TCPS_FIN_WAIT_1);
00850 break;
00851
00852 case TCPS_CLOSE_WAIT:
00853
00854
00855
00856
00857 NutTcpStateChange(sock, TCPS_LAST_ACK);
00858 break;
00859
00860 case TCPS_FIN_WAIT_1:
00861 case TCPS_FIN_WAIT_2:
00862 case TCPS_CLOSING:
00863 case TCPS_LAST_ACK:
00864 case TCPS_TIME_WAIT:
00865 sock->so_last_error = EALREADY;
00866 return -1;
00867
00868 default:
00869 sock->so_last_error = ENOTCONN;
00870 return -1;
00871 }
00872 return 0;
00873 }
00874
00881 int NutTcpStateWindowEvent(TCPSOCKET * sock)
00882 {
00883 if (sock == 0)
00884 return -1;
00885 sock->so_tx_flags |= SO_ACK | SO_FORCE;
00886 NutTcpOutput(sock, 0, 0);
00887
00888 return 0;
00889 }
00890
00891
00892
00893
00894
00906 int NutTcpStateRetranTimeout(TCPSOCKET * sock)
00907 {
00908 NETBUF *so_tx_next;
00909 if (sock->so_retransmits++ > 7)
00910 {
00911
00912 NutTcpAbortSocket(sock, ETIMEDOUT);
00913 return -1;
00914 } else {
00915 #ifdef NUTDEBUG
00916 if (__tcp_trf)
00917 NutDumpTcpHeader(__tcp_trs, "RET", sock, sock->so_tx_nbq);
00918 #endif
00919
00920
00921
00922
00923 so_tx_next = sock->so_tx_nbq->nb_next;
00924 if (NutIpOutput(IPPROTO_TCP, sock->so_remote_addr, sock->so_tx_nbq)) {
00925
00926 sock->so_tx_nbq = so_tx_next;
00927
00928 NutTcpAbortSocket(sock, ENETDOWN);
00929 return -1;
00930 } else {
00931
00932 sock->so_retran_time = (u_short) NutGetMillis();
00933 return 0;
00934 }
00935 }
00936 }
00937
00938
00939
00940
00941
00942
00952 static void NutTcpStateListen(TCPSOCKET * sock, u_char flags, TCPHDR * th, NETBUF * nb)
00953 {
00954
00955
00956
00957
00958 if ((flags & (TH_SYN | TH_ACK | TH_RST)) == TH_SYN) {
00959 NutTcpProcessSyn(sock, nb->nb_nw.vp, th);
00960 NutTcpStateChange(sock, TCPS_SYN_RECEIVED);
00961 NutNetBufFree(nb);
00962 } else
00963 NutTcpReject(nb);
00964 }
00965
00966
00975 static void NutTcpStateSynSent(TCPSOCKET * sock, u_char flags, TCPHDR * th, NETBUF * nb)
00976 {
00977
00978
00979
00980 if (flags & TH_ACK) {
00981 if (!IsInLimits(ntohl(th->th_ack), sock->so_tx_isn + 1, sock->so_tx_nxt)) {
00982 NutTcpReject(nb);
00983 return;
00984 }
00985 }
00986
00987
00988
00989
00990
00991
00992 if (flags & TH_RST) {
00993 if (flags & TH_ACK) {
00994
00995
00996
00997 NutTcpAbortSocket(sock, ECONNREFUSED);
00998 }
00999 NutNetBufFree(nb);
01000 return;
01001 }
01002
01003
01004
01005
01006
01007
01008 if (flags & TH_SYN) {
01009 NutTcpProcessSyn(sock, nb->nb_nw.vp, th);
01010 if (flags & TH_ACK) {
01011 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01012 NutTcpStateChange(sock, TCPS_ESTABLISHED);
01013
01014 NutEventPost(&sock->so_ac_tq);
01015 } else {
01016 NutTcpStateChange(sock, TCPS_SYN_RECEIVED);
01017 }
01018 }
01019 NutNetBufFree(nb);
01020 }
01021
01022
01023
01024
01025
01026
01027
01028
01029
01030
01031
01032
01033 static void NutTcpStateSynReceived(TCPSOCKET * sock, u_char flags, TCPHDR * th, NETBUF * nb)
01034 {
01035
01036
01037
01038
01039 if (flags & TH_RST) {
01040 if (sock->so_pc_tq)
01041 NutTcpStateChange(sock, TCPS_LISTEN);
01042 else
01043 NutTcpAbortSocket(sock, ECONNREFUSED);
01044 NutNetBufFree(nb);
01045 sock->so_retran_time = 0;
01046 NutTcpDiscardBuffers(sock);
01047 return;
01048 }
01049
01050
01051
01052
01053 if (flags & TH_SYN) {
01054 NutTcpReject(nb);
01055 return;
01056 }
01057
01058
01059
01060
01061 if ((flags & TH_ACK) == 0) {
01062 NutNetBufFree(nb);
01063 return;
01064 }
01065
01066
01067
01068
01069 if (!IsInLimits(ntohl(th->th_ack), sock->so_tx_una + 1, sock->so_tx_nxt)) {
01070 NutTcpReject(nb);
01071 return;
01072 }
01073
01074
01075 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01076
01077
01078
01079
01080
01081
01082
01083 if (nb->nb_ap.sz)
01084 NutTcpProcessAppData(sock, nb);
01085 else
01086 NutNetBufFree(nb);
01087
01088
01089
01090
01091 if (flags & TH_FIN) {
01092 sock->so_rx_nxt++;
01093 NutTcpStateChange(sock, TCPS_CLOSE_WAIT);
01094 } else {
01095 NutTcpStateChange(sock, TCPS_ESTABLISHED);
01096 NutEventPost(&sock->so_pc_tq);
01097 NutEventPost(&sock->so_ac_tq);
01098 }
01099 }
01100
01101
01102
01103
01104
01105
01106
01107
01108
01109
01110
01111
01112
01113
01114
01115 static void NutTcpStateEstablished(TCPSOCKET * sock, u_char flags, TCPHDR * th, NETBUF * nb)
01116 {
01117 if (flags & TH_RST) {
01118 NutNetBufFree(nb);
01119 NutTcpAbortSocket(sock, ECONNRESET);
01120 return;
01121 }
01122
01123
01124
01125
01126
01127 if (flags & TH_SYN) {
01128 if (htonl(th->th_seq) != sock->so_rx_isn)
01129 NutTcpReject(nb);
01130 else
01131 NutNetBufFree(nb);
01132 return;
01133 }
01134
01135
01136
01137
01138 if ((flags & TH_ACK) == 0) {
01139 NutNetBufFree(nb);
01140 return;
01141 }
01142
01143 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01144
01145
01146
01147
01148
01149
01150
01151 if (htonl(th->th_seq) > sock->so_rx_nxt) {
01152 NETBUF *nbq;
01153 NETBUF **nbqp;
01154 TCPHDR *thq;
01155 u_long th_seq;
01156 u_long thq_seq;
01157
01158 if (nb->nb_ap.sz) {
01159 nbq = sock->so_rx_nbq;
01160 nbqp = &sock->so_rx_nbq;
01161 while (nbq) {
01162 thq = (TCPHDR *) (nbq->nb_tp.vp);
01163 th_seq = htonl(th->th_seq);
01164 thq_seq = htonl(thq->th_seq);
01165 if (th_seq < thq_seq) {
01166 *nbqp = nb;
01167 nb->nb_next = nbq;
01168 break;
01169 }
01170 if (th_seq == thq_seq) {
01171 NutNetBufFree(nb);
01172 sock->so_tx_flags |= SO_ACK | SO_FORCE;
01173 NutTcpOutput(sock, 0, 0);
01174 return;
01175 }
01176 nbqp = &nbq->nb_next;
01177 nbq = nbq->nb_next;
01178 }
01179 if (nbq == 0) {
01180 *nbqp = nb;
01181 nb->nb_next = 0;
01182 }
01183 } else
01184 NutNetBufFree(nb);
01185
01186 sock->so_tx_flags |= SO_ACK | SO_FORCE;
01187 NutTcpOutput(sock, 0, 0);
01188 return;
01189 }
01190
01191
01192
01193
01194
01195
01196
01197
01198 if (htonl(th->th_seq) != sock->so_rx_nxt) {
01199 sock->so_tx_flags |= SO_ACK | SO_FORCE;
01200
01201 sock->so_oos_drop++;
01202 NutNetBufFree(nb);
01203 NutTcpOutput(sock, 0, 0);
01204 }
01205
01206
01207
01208
01209 else if (nb->nb_ap.sz) {
01210 NutTcpProcessAppData(sock, nb);
01211
01212
01213
01214 while ((nb = sock->so_rx_nbq) != 0) {
01215 th = (TCPHDR *) (nb->nb_tp.vp);
01216 if (htonl(th->th_seq) > sock->so_rx_nxt)
01217 break;
01218 sock->so_rx_nbq = nb->nb_next;
01219 if (htonl(th->th_seq) == sock->so_rx_nxt) {
01220 NutTcpProcessAppData(sock, nb);
01221 flags |= th->th_flags;
01222 } else
01223 NutNetBufFree(nb);
01224 }
01225
01226 NutEventPost(&sock->so_rx_tq);
01227 } else {
01228 NutNetBufFree(nb);
01229
01230
01231 }
01232 if (flags & TH_FIN) {
01233
01234 sock->so_rx_nxt++;
01235 NutTcpStateChange(sock, TCPS_CLOSE_WAIT);
01236 }
01237 }
01238
01239
01240
01241
01242
01243
01244
01245
01246
01247
01248
01249
01250
01251
01252
01253
01254 static void NutTcpStateFinWait1(TCPSOCKET * sock, u_char flags, TCPHDR * th, NETBUF * nb)
01255 {
01256
01257 if (flags & TH_RST) {
01258 NutNetBufFree(nb);
01259 NutTcpDestroySocket(sock);
01260 return;
01261 }
01262
01263
01264
01265
01266 if (flags & TH_SYN) {
01267 NutTcpReject(nb);
01268 return;
01269 }
01270
01271
01272
01273
01274 if ((flags & TH_ACK) == 0) {
01275 NutNetBufFree(nb);
01276 return;
01277 }
01278
01279
01280
01281
01282
01283 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01284
01285
01286
01287
01288
01289 if (sock->so_tx_nxt == sock->so_tx_una) {
01290
01291 NutTcpStateChange(sock, TCPS_FIN_WAIT_2);
01292 }
01293
01294
01295
01296
01297
01298 if (nb->nb_ap.sz) {
01299 NutTcpProcessAppData(sock, nb);
01300
01301 NutEventPost(&sock->so_rx_tq);
01302 }
01303 else
01304 NutNetBufFree(nb);
01305
01306 if (flags & TH_FIN) {
01307 sock->so_rx_nxt++;
01308
01309
01310
01311 sock->so_time_wait = 0;
01312
01313 if (sock->so_state == TCPS_FIN_WAIT_2)
01314 NutTcpStateChange(sock, TCPS_TIME_WAIT);
01315 else
01316 NutTcpStateChange(sock, TCPS_CLOSING);
01317 }
01318 }
01319
01320
01321
01322
01323
01324
01325
01326
01327
01328
01329
01330
01331
01332
01333 static void NutTcpStateFinWait2(TCPSOCKET * sock, u_char flags, TCPHDR * th, NETBUF * nb)
01334 {
01335
01336 if (flags & TH_RST) {
01337 NutNetBufFree(nb);
01338 NutTcpDestroySocket(sock);
01339 return;
01340 }
01341
01342
01343
01344
01345 if (flags & TH_SYN) {
01346 NutTcpReject(nb);
01347 return;
01348 }
01349
01350
01351
01352
01353 if ((flags & TH_ACK) == 0) {
01354 NutNetBufFree(nb);
01355 return;
01356 }
01357
01358
01359
01360
01361
01362
01363 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
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 sock->so_time_wait = 0;
01378
01379 NutTcpStateChange(sock, TCPS_TIME_WAIT);
01380 }
01381 }
01382
01383
01384
01385
01386
01387
01388
01389
01390
01391
01392
01393 static void NutTcpStateCloseWait(TCPSOCKET * sock, u_char flags, TCPHDR * th, NETBUF * nb)
01394 {
01395
01396 if (flags & TH_RST) {
01397 NutNetBufFree(nb);
01398 NutTcpAbortSocket(sock, ECONNRESET);
01399 return;
01400 }
01401
01402
01403
01404
01405 if (flags & TH_SYN) {
01406 NutTcpReject(nb);
01407 return;
01408 }
01409
01410
01411
01412
01413 if ((flags & TH_ACK) == 0) {
01414 NutNetBufFree(nb);
01415 return;
01416 }
01417
01418 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01419
01420 NutNetBufFree(nb);
01421 }
01422
01423
01424
01425
01426
01427
01428
01429
01430
01431
01432
01433
01434
01435 static void NutTcpStateClosing(TCPSOCKET * sock, u_char flags, TCPHDR * th, NETBUF * nb)
01436 {
01437
01438 if (flags & TH_RST) {
01439 NutNetBufFree(nb);
01440 NutTcpDestroySocket(sock);
01441 return;
01442 }
01443
01444
01445
01446
01447 if (flags & TH_SYN) {
01448 NutTcpReject(nb);
01449 return;
01450 }
01451
01452
01453
01454
01455 if ((flags & TH_ACK) == 0) {
01456 NutNetBufFree(nb);
01457 return;
01458 }
01459
01460 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01461
01462
01463
01464
01465 if (sock->so_tx_nxt == sock->so_tx_una) {
01466 sock->so_time_wait = 0;
01467 NutTcpStateChange(sock, TCPS_TIME_WAIT);
01468
01469 }
01470
01471
01472 NutNetBufFree(nb);
01473 }
01474
01489 static void NutTcpStateLastAck(TCPSOCKET * sock, u_char flags, TCPHDR * th, NETBUF * nb)
01490 {
01491
01492 if (flags & TH_RST) {
01493 NutNetBufFree(nb);
01494 NutTcpDestroySocket(sock);
01495 return;
01496 }
01497
01498
01499
01500
01501 if (flags & TH_SYN) {
01502 NutTcpReject(nb);
01503 return;
01504 }
01505
01506
01507
01508
01509 if ((flags & TH_ACK) == 0) {
01510 NutNetBufFree(nb);
01511 return;
01512 }
01513
01514 NutTcpProcessAck(sock, th, nb->nb_ap.sz);
01515 NutNetBufFree(nb);
01516
01517 if (sock->so_tx_nxt == sock->so_tx_una)
01518 NutTcpDestroySocket(sock);
01519
01520 }
01521
01532 static void NutTcpStateProcess(TCPSOCKET * sock, NETBUF * nb)
01533 {
01534 u_long tx_win;
01535 u_long tx_una;
01536 TCPHDR *th = (TCPHDR *) nb->nb_tp.vp;
01537 u_char flags = th->th_flags;
01538
01539 #ifdef NUTDEBUG
01540 if (__tcp_trf) {
01541 fprintf(__tcp_trs, " %04x-", (u_int) sock);
01542 NutDumpSockState(__tcp_trs, sock->so_state, "[", ">]");
01543 }
01544 #endif
01545 switch (sock->so_state) {
01546
01547 case TCPS_ESTABLISHED:
01548 tx_win = sock->so_tx_win;
01549 tx_una = sock->so_tx_una;
01550 NutTcpStateEstablished(sock, flags, th, nb);
01551
01552 if(sock->so_state != TCPS_ESTABLISHED ||
01553 sock->so_tx_win > tx_win ||
01554 sock->so_tx_una > tx_una) {
01555 NutEventBroadcast(&sock->so_tx_tq);
01556 }
01557 break;
01558 case TCPS_LISTEN:
01559 NutTcpStateListen(sock, flags, th, nb);
01560 break;
01561 case TCPS_SYN_SENT:
01562 NutTcpStateSynSent(sock, flags, th, nb);
01563 break;
01564 case TCPS_SYN_RECEIVED:
01565 NutTcpStateSynReceived(sock, flags, th, nb);
01566 break;
01567 case TCPS_FIN_WAIT_1:
01568 NutTcpStateFinWait1(sock, flags, th, nb);
01569 break;
01570 case TCPS_FIN_WAIT_2:
01571 NutTcpStateFinWait2(sock, flags, th, nb);
01572 break;
01573 case TCPS_CLOSE_WAIT:
01574 NutTcpStateCloseWait(sock, flags, th, nb);
01575 break;
01576 case TCPS_CLOSING:
01577 NutTcpStateClosing(sock, flags, th, nb);
01578 break;
01579 case TCPS_LAST_ACK:
01580 NutTcpStateLastAck(sock, flags, th, nb);
01581 break;
01582 case TCPS_TIME_WAIT:
01583
01584
01585
01586 NutNetBufFree(nb);
01587 break;
01588 case TCPS_CLOSED:
01589
01590
01591
01592 NutTcpReject(nb);
01593 break;
01594 default:
01595 NutNetBufFree(nb);
01596 break;
01597 }
01598 }
01599
01606 THREAD(NutTcpSm, arg)
01607 {
01608 NETBUF *nb;
01609 NETBUF *nbx;
01610 TCPHDR *th;
01611 IPHDR *ih;
01612 TCPSOCKET *sock;
01613 u_char tac = 0;
01614
01615
01616
01617
01618
01619 NutThreadSetPriority (32);
01620
01621 for (;;) {
01622 if (++tac > 3 || NutEventWait(&tcp_in_rdy, 200)) {
01623 tac = 0;
01624 for (sock = tcpSocketList; sock; sock = sock->so_next) {
01625
01626
01627
01628
01629 if (sock->so_tx_flags & SO_ACK) {
01630 sock->so_tx_flags |= SO_FORCE;
01631 NutTcpOutput(sock, 0, 0);
01632 }
01633
01634
01635
01636
01637 if (sock->so_tx_nbq && sock->so_retran_time) {
01638 if ((u_short)((u_short)NutGetMillis() - sock->so_retran_time) > sock->so_rtto) {
01639 NutTcpStateRetranTimeout(sock);
01640 }
01641 }
01642
01643
01644
01645
01646 if (sock->so_state == TCPS_TIME_WAIT || sock->so_state == TCPS_FIN_WAIT_2) {
01647 if (sock->so_time_wait++ >= 9) {
01648 NutTcpDestroySocket(sock);
01649 break;
01650 }
01651 }
01652
01653
01654
01655
01656 else if (sock->so_state == TCPS_SYN_RECEIVED) {
01657 if (sock->so_time_wait++ >= 45) {
01658 sock->so_state = TCPS_LISTEN;
01659 sock->so_time_wait = 0;
01660 }
01661 }
01662 }
01663 } else {
01664 nb = tcp_in_nbq;
01665 tcp_in_nbq = 0;
01666 tcp_in_cnt = 0;
01667 while (nb) {
01668 ih = (IPHDR *) nb->nb_nw.vp;
01669 th = (TCPHDR *) nb->nb_tp.vp;
01670 sock = NutTcpFindSocket(th->th_dport, th->th_sport, ih->ip_src);
01671 #ifdef NUTDEBUG
01672 if (__tcp_trf)
01673 NutDumpTcpHeader(__tcp_trs, " IN", sock, nb);
01674 #endif
01675 nbx = nb->nb_next;
01676 if (sock) {
01677 NutTcpInputOptions(sock, nb);
01678 NutTcpStateProcess(sock, nb);
01679 }
01680
01681
01682
01683
01684 else
01685 NutTcpReject(nb);
01686 nb = nbx;
01687 }
01688 }
01689 }
01690 }
01691
01703 void NutTcpStateMachine(NETBUF * nb)
01704 {
01705 NETBUF *nbp;
01706 u_short size;
01707
01708 nb->nb_next = 0;
01709
01710
01711
01712
01713
01714
01715
01716 if (tcpThread == 0) {
01717 NutTcpReject(nb);
01718 return;
01719 }
01720
01721 if ((nbp = tcp_in_nbq) == 0) {
01722 tcp_in_nbq = nb;
01723 NutEventPost(&tcp_in_rdy);
01724 } else {
01725 size = nb->nb_nw.sz + nb->nb_tp.sz + nb->nb_ap.sz;
01726 if (tcp_in_cnt + size + 2048 < NutHeapAvailable()) {
01727 tcp_in_cnt += size;
01728 while (nbp->nb_next)
01729 nbp = nbp->nb_next;
01730 nbp->nb_next = nb;
01731 NutEventPost(&tcp_in_rdy);
01732 } else
01733 NutNetBufFree(nb);
01734 }
01735 }
01736
01745 int NutTcpInitStateMachine(void)
01746 {
01747 if (tcpThread == 0 && (tcpThread = NutThreadCreate("tcpsm", NutTcpSm, NULL, NUT_THREAD_TCPSMSTACK)) == 0)
01748 return -1;
01749 return 0;
01750 }
01751
01765 int NutTcpAbortSocket(TCPSOCKET * sock, u_short last_error)
01766 {
01767 sock->so_last_error = last_error;
01768 sock->so_retran_time = 0;
01769 sock->so_time_wait = 0;
01770
01771
01772
01773
01774
01775 if (sock->so_state >= TCPS_FIN_WAIT_1)
01776 sock->so_state = TCPS_TIME_WAIT;
01777 else
01778 sock->so_state = TCPS_CLOSED;
01779 NutTcpDiscardBuffers(sock);
01780 NutEventBroadcast(&sock->so_rx_tq);
01781 NutEventBroadcast(&sock->so_tx_tq);
01782 NutEventBroadcast(&sock->so_pc_tq);
01783 NutEventBroadcast(&sock->so_ac_tq);
01784 return 0;
01785 }
01786