18,7 → 18,6 |
$Revision$ |
|
|
; TCP TCB states |
TCB_LISTEN equ 1 |
TCB_SYN_SENT equ 2 |
TCB_SYN_RECEIVED equ 3 |
31,20 → 30,21 |
TCB_TIMED_WAIT equ 10 |
TCB_CLOSED equ 11 |
|
TH_FIN equ 0x01 |
TH_SYN equ 0x02 |
TH_RST equ 0x04 |
TH_PUSH equ 0x08 |
TH_ACK equ 0x10 |
TH_URG equ 0x20 |
TH_FIN equ 1 shl 0 |
TH_SYN equ 1 shl 1 |
TH_RST equ 1 shl 2 |
TH_PUSH equ 1 shl 3 |
TH_ACK equ 1 shl 4 |
TH_URG equ 1 shl 5 |
|
TWOMSL equ 10 ; # of secs to wait before closing socket |
|
TCP_RETRIES equ 5 ; Number of times to resend a Packet |
TCP_TIMEOUT equ 10 ; resend if not replied to in x hs |
TCP_TIMEOUT equ 10 ; resend if not replied to in 1/100 s |
|
TCP_QUEUE_SIZE equ 16 |
|
|
struct TCP_Packet |
.SourcePort dw ? |
.DestinationPort dw ? |
65,14 → 65,55 |
TCP_PACKETS_TX rd MAX_IP |
TCP_PACKETS_RX rd MAX_IP |
|
TCP_IN_QUEUE rd 3*TCP_QUEUE_SIZE+3 |
TCP_OUT_QUEUE rd 3*TCP_QUEUE_SIZE+3 |
TCP_IN_QUEUE rd (tcp_in_queue_entry.size*TCP_QUEUE_SIZE+queue.data)/4 |
TCP_OUT_QUEUE dd ? |
rd (tcp_out_queue_entry.size*TCP_QUEUE_SIZE)/4 |
endg |
|
align 4 |
iglobal |
|
TCBStateHandler: |
|
dd stateTCB_LISTEN |
dd stateTCB_SYN_SENT |
dd stateTCB_SYN_RECEIVED |
dd stateTCB_ESTABLISHED |
dd stateTCB_FIN_WAIT_1 |
dd stateTCB_FIN_WAIT_2 |
dd stateTCB_CLOSE_WAIT |
dd stateTCB_CLOSING |
dd stateTCB_LAST_ACK |
dd stateTCB_TIME_WAIT |
dd stateTCB_CLOSED |
|
endg |
|
|
macro inc_INET reg { |
|
inc byte [reg + 0] |
adc byte [reg + 1], 0 |
adc byte [reg + 2], 0 |
adc byte [reg + 3], 0 |
|
} |
|
|
macro add_INET reg { |
|
rol ecx, 16 |
adc byte [reg + 0], ch |
adc byte [reg + 1], cl |
rol ecx, 16 |
adc byte [reg + 2], ch |
adc byte [reg + 3], cl |
|
} |
|
|
|
|
;----------------------------------------------------------------- |
; |
; TCP_init |
92,58 → 133,55 |
mov ecx, 2*MAX_IP |
rep stosd |
|
mov dword [TCP_IN_QUEUE], TCP_QUEUE_SIZE |
mov dword [TCP_IN_QUEUE+4], TCP_IN_QUEUE + queue.data |
mov dword [TCP_IN_QUEUE+8], TCP_IN_QUEUE + queue.data |
init_queue TCP_IN_QUEUE |
init_queue TCP_OUT_QUEUE |
|
mov dword [TCP_OUT_QUEUE], TCP_QUEUE_SIZE |
mov dword [TCP_OUT_QUEUE+4], TCP_OUT_QUEUE + queue.data |
mov dword [TCP_OUT_QUEUE+8], TCP_OUT_QUEUE + queue.data |
|
ret |
|
|
;----------------------------------------------------------------- |
; |
; tcp_tcb_handler |
; TCP_decrease_socket_ttls |
; |
; Handles sockets in the timewait state, closing them |
; when the TCB timer expires |
; IN: / |
; OUT: / |
; |
;----------------------------------------------------------------- |
|
align 4 |
tcp_tcb_handler: |
TCP_decrease_socket_ttls: |
; scan through all the sockets, decrementing active timers |
|
mov ebx, net_sockets |
|
cmp [ebx + SOCKET.NextPtr], 0 |
cmp [ebx + SOCKET_head.NextPtr], 0 |
je .exit |
DEBUGF 1, "K : sockets:\n" |
|
.next_socket: |
mov ebx, [ebx + SOCKET.NextPtr] |
mov ebx, [ebx + SOCKET_head.NextPtr] |
or ebx, ebx |
jz .exit |
|
cmp [ebx + SOCKET_head.Type], IP_PROTO_TCP |
jne .next_socket |
|
; DEBUGF 1, "K : %x-%x: %x-%x-%x-%u\n", [ebx + SOCKET.PID]:2, [ebx + SOCKET.Number]:2, [ebx + SOCKET.LocalPort]:4, [ebx + SOCKET.RemoteIP], [ebx + SOCKET.RemotePort]:4, [ebx + SOCKET.TCBState] |
|
cmp [ebx + SOCKET.TCBTimer], 0 |
cmp [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBTimer], 0 |
jne .decrement_tcb |
cmp [ebx + SOCKET.wndsizeTimer], 0 |
cmp [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.wndsizeTimer], 0 |
jne .decrement_wnd |
jmp .next_socket |
|
.decrement_tcb: |
; decrement it, delete socket if TCB timer = 0 & socket in timewait state |
dec [ebx + SOCKET.TCBTimer] |
dec [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBTimer] |
jnz .next_socket |
|
cmp [ebx + SOCKET.TCBState], TCB_TIMED_WAIT |
cmp [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_TIMED_WAIT |
jne .next_socket |
|
push [ebx + SOCKET.PrevPtr] |
push [ebx + SOCKET_head.PrevPtr] |
stdcall net_socket_free, ebx |
pop ebx |
jmp .next_socket |
150,7 → 188,7 |
|
.decrement_wnd: |
; TODO - prove it works! |
dec [ebx + SOCKET.wndsizeTimer] |
dec [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.wndsizeTimer] |
jmp .next_socket |
|
.exit: |
157,120 → 195,124 |
ret |
|
|
;*************************************************************************** |
; Function |
; tcp_tx_handler |
|
;----------------------------------------------------------------- |
; |
; Description |
; Handles queued TCP data |
; This is a kernel function, called by stack_handler |
; TCP_send_queued: |
; |
;*************************************************************************** |
; Decreases 'ttl' of tcp packets queued. |
; if 'ttl' reaches 0, resend the packet and decrease 'retries' |
; if 'retries' reaches zero, remove the queued packet |
; |
; IN: / |
; OUT: / |
; |
;----------------------------------------------------------------- |
|
align 4 |
tcp_tx_handler: |
; decrement all resend buffers timers. If they |
; expire, queue them for sending, and restart the timer. |
; If the retries counter reach 0, delete the entry |
TCP_send_queued: |
|
mov esi, resendQ |
mov ecx, 0 |
cmp [TCP_OUT_QUEUE], 0 |
je .exit |
|
.next_resendq: |
; cmp ecx, NUMRESENDENTRIES |
je .exit ; None left |
cmp dword[esi + 4], 0 |
jne @f ; found one |
inc ecx |
add esi, 8 |
jmp .next_resendq |
mov eax, TCP_QUEUE_SIZE |
mov ecx, [TCP_OUT_QUEUE] |
mov esi, TCP_OUT_QUEUE+4 |
|
@@: ; we have one. decrement it's timer by 1 |
dec word[esi + 2] |
jz @f |
inc ecx |
add esi, 8 |
jmp .next_resendq ; Timer not zero, so move on |
.loop: |
cmp [esi + tcp_out_queue_entry.data_ptr], 0 |
jnz .found_one |
add esi, tcp_out_queue_entry.size |
loop .loop |
.exit: |
ret |
|
@@: |
xor ebx, ebx |
; restart timer, and decrement retries |
; After the first resend, back of on next, by a factor of 5 |
mov [esi + 2], word TCP_TIMEOUT * 5 |
dec byte[esi + 1] |
jnz @f |
.found_one: |
dec [esi + tcp_out_queue_entry.ttl] |
jz .send_it |
.find_next: |
dec eax |
jz .exit |
jmp .loop |
|
; retries now 0, so delete from queue |
xchg [esi + 4], ebx |
.send_it: |
push eax ecx esi |
|
@@: ; resend Packet |
pushad |
push [esi + tcp_out_queue_entry.data_size] |
push [esi + tcp_out_queue_entry.data_ptr] |
mov ebx, [esi + tcp_out_queue_entry.owner] |
|
; mov eax, EMPTY_QUEUE |
; call dequeue |
; cmp ax, NO_BUFFER |
jne .tth004z |
call [esi + tcp_out_queue_entry.sendproc] |
|
; TODO - try again in 10ms. |
test ebx, ebx |
jnz @f |
mov [esi + 4], ebx |
pop esi ecx eax |
|
@@: ; Mark it to expire in 10ms - 1 tick |
mov byte[esi + 1], 1 |
mov word[esi + 2], 1 |
jmp .tth005 |
dec [esi + tcp_out_queue_entry.retries] |
jz .remove_it |
mov [esi + tcp_out_queue_entry.ttl], TCP_TIMEOUT |
jmp .find_next |
|
.tth004z: |
; we have a buffer # in ax |
; push eax ecx |
; mov ecx, IPBUFFSIZE |
; mul ecx |
; add eax, IPbuffs |
.remove_it: |
push [esi + tcp_out_queue_entry.data_ptr] |
mov [esi + tcp_out_queue_entry.data_ptr], 0 |
dec [TCP_OUT_QUEUE] |
call kernel_free |
jmp .find_next |
|
; we have the buffer address in eax |
mov edi, eax |
pop ecx |
; Now get buffer location, and copy buffer across. argh! more copying,, |
; mov esi, resendBuffer |
; @@: add esi, IPBUFFSIZE |
loop @b |
|
; we have resend buffer location in esi |
; mov ecx, IPBUFFSIZE |
|
; copy data across |
push edi |
cld |
rep movsb |
pop edi |
;----------------------------------------------------------------- |
; |
; TCP_add_to_queue: |
; |
; Queue a TCP packet for sending |
; |
; IN: [esp] pointer to buffer |
; [esp + 4] size of buffer |
; ebx = driver struct |
; esi = sender proc |
; edx = acknum |
; OUT: / |
; |
;----------------------------------------------------------------- |
|
; queue Packet |
; mov eax, NET1OUT_QUEUE |
; mov edx, [IP_LIST] |
; cmp edx, [edi + IP_Packet.DestinationAddress] |
; jne .not_local |
; mov eax, IPIN_QUEUE |
align 4 |
TCP_add_to_queue: |
|
.not_local: |
pop ebx |
; call queue |
cmp [TCP_OUT_QUEUE], TCP_QUEUE_SIZE |
jge .full |
|
.tth005: |
popad |
mov ecx, TCP_QUEUE_SIZE |
mov eax, TCP_OUT_QUEUE+4 |
|
inc ecx |
add esi, 8 |
jmp .next_resendq |
.loop: |
cmp [eax + tcp_out_queue_entry.data_ptr], 0 |
je .found_it |
add eax, tcp_out_queue_entry.size |
loop .loop |
|
.exit: |
.full: ; silently discard the packet |
call kernel_free |
add esp, 4 |
|
ret |
|
.found_it: ; eax point to empty queue entry |
|
pop [eax + tcp_out_queue_entry.data_ptr] |
pop [eax + tcp_out_queue_entry.data_size] |
mov [eax + tcp_out_queue_entry.ttl], 1 ; send immediately |
mov [eax + tcp_out_queue_entry.retries], TCP_RETRIES |
mov [eax + tcp_out_queue_entry.owner], ebx |
mov [eax + tcp_out_queue_entry.sendproc], esi |
mov [eax + tcp_out_queue_entry.ack_num], edx |
|
|
ret |
|
|
;----------------------------------------------------------------- |
; |
; TCP_Handler: |
; TCP_handler: |
; |
; Called by IPv4_handler, |
; this procedure will inject the tcp data diagrams in the application sockets. |
285,136 → 327,104 |
; |
;----------------------------------------------------------------- |
|
TCP_Handler : |
align 4 |
TCP_handler : |
|
|
DEBUGF 1,"TCP_Handler\n" |
|
jmp .exit ;;;; |
|
; Look for a socket where |
; IP Packet TCP Destination Port = local Port |
; IP Packet SA = Remote IP |
; IP Packet TCP Source Port = remote Port |
; IP Packet SA = Remote IP OR = 0 |
; IP Packet TCP Source Port = remote Port OR = 0 |
|
mov ebx, net_sockets |
|
.next_socket.1: |
mov ebx, [ebx + SOCKET.NextPtr] |
.socket_loop: |
mov ebx, [ebx + SOCKET_head.NextPtr] |
or ebx, ebx |
jz .next_socket.1.exit |
jz .dump |
|
; DEBUGF 1, "K : tcp_rx - 1.dport: %x - %x\n", [edx + 20 + TCP_Packet.DestinationPort]:4, [ebx + SOCKET.LocalPort]:4 |
mov ax, [edx + TCP_Packet.DestinationPort] |
cmp [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.LocalPort], ax |
jne .socket_loop |
|
mov ax, [edx + TCP_Packet.DestinationPort] ; get the dest. port from the TCP hdr |
cmp [ebx + SOCKET.LocalPort], ax ; get the dest. port from the TCP hdr |
jne .next_socket.1 ; different - try next socket |
mov eax, [ebx + SOCKET_head.end + IPv4_SOCKET.RemoteIP] |
cmp eax, esi |
je @f |
test eax, eax |
jne .socket_loop |
@@: |
|
; DEBUGF 1, "K : tcp_rx - 1.addr: %x - %x\n", [edx + IP_Packet.SourceAddress], [ebx + SOCKET.RemoteIP] |
mov ax, [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RemotePort] |
cmp [edx + TCP_Packet.SourcePort] , ax |
je .change_state |
test ax, ax |
jne .socket_loop |
|
mov eax, esi ;[edx + IP_Packet.SourceAddress] ; get the source IP Addr from the IP hdr |
cmp [ebx + SOCKET.RemoteIP], eax ; compare with socket's remote IP |
jne .next_socket.1 ; different - try next socket |
.change_state: |
|
; DEBUGF 1, "K : tcp_rx - 1.sport: %x - %x\n", [edx + 20 + TCP_Packet.SourcePort]:4, [ebx + SOCKET.RemotePort]:4 |
push ebx |
lea ebx, [ebx + SOCKET_head.lock] |
call wait_mutex |
pop ebx |
|
mov ax, [edx + TCP_Packet.SourcePort] ; get the source port from the TCP hdr |
cmp [ebx + SOCKET.RemotePort], ax ; compare with socket's remote port |
jne .next_socket.1 ; different - try next socket |
;---------------------------------- |
; ebx is pointer to socket |
; ecx is size of tcp packet |
; edx is pointer to tcp packet |
|
; We have a complete match - use this socket |
jmp .change_state |
; as a Packet has been received, update the TCB timer |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBTimer], TWOMSL |
|
.next_socket.1.exit: |
; If the received Packet has an ACK bit set, remove any Packets in the resend queue that this received Packet acknowledges |
test [edx + TCP_Packet.Flags], TH_ACK |
jz .call_handler ; No ACK, so no data yet |
|
; If we got here, there was no match |
; Look for a socket where |
; IP Packet TCP Destination Port = local Port |
; IP Packet SA = Remote IP |
; socket remote Port = 0 |
mov eax, [edx + TCP_Packet.SequenceNumber] ; Calculate sequencenumber in eax |
bswap eax ; |
add eax, ecx ; |
|
mov ebx, net_sockets |
cmp [TCP_OUT_QUEUE], 0 |
je .call_handler |
|
.next_socket.2: |
mov ebx, [ebx + SOCKET.NextPtr] |
or ebx, ebx |
jz .next_socket.2.exit |
push ecx |
mov ecx, TCP_QUEUE_SIZE |
mov esi, TCP_OUT_QUEUE+4 |
|
; DEBUGF 1, "K : tcp_rx - 2.dport: %x - %x\n", [edx + 20 + TCP_Packet.DestinationPort]:4, [ebx + SOCKET.LocalPort]:4 |
.loop: |
cmp [esi + tcp_out_queue_entry.data_ptr], 0 |
jne .maybe_next |
cmp [esi + tcp_out_queue_entry.ack_num], eax |
jg .maybe_next |
|
mov ax, [edx + TCP_Packet.DestinationPort] ; get the dest. port from the TCP hdr |
cmp [ebx + SOCKET.LocalPort], ax ; compare with socket's local port |
jne .next_socket.2 ; different - try next socket |
push [esi + tcp_out_queue_entry.data_ptr] |
mov [esi + tcp_out_queue_entry.data_ptr], 0 |
dec [TCP_OUT_QUEUE] |
call kernel_free |
|
; DEBUGF 1, "K : tcp_rx - 2.addr: %x - %x\n", [edx + IP_Packet.SourceAddress], [ebx + SOCKET.RemoteIP] |
.maybe_next: |
add esi, tcp_out_queue_entry.size |
loop .loop |
pop ecx |
|
; mov eax, esi ;[edx + IP_Packet.SourceAddress] ; get the source IP Addr from the IP hdr |
cmp [ebx + SOCKET.RemoteIP], esi ; compare with socket's remote IP |
jne .next_socket.2 ; different - try next socket |
.call_handler: |
; Call handler for given TCB state |
mov eax, [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState] |
cmp eax, TCB_LISTEN |
jb .exit |
cmp eax, TCB_CLOSED |
ja .exit |
|
; DEBUGF 1, "K : tcp_rx - 2.sport: 0000 - %x\n", [ebx + SOCKET.RemotePort]:4 |
shl eax, 2 |
add eax, TCBStateHandler - 4 |
|
cmp [ebx + SOCKET.RemotePort], 0 ; only match a remote socket of 0 |
jne .next_socket.2 ; different - try next socket |
push .exit |
jmp eax |
|
; We have a complete match - use this socket |
jmp .change_state |
|
.next_socket.2.exit: |
|
; If we got here, there was no match |
; Look for a socket where |
; IP Packet TCP Destination Port = local Port |
; socket Remote IP = 0 |
; socket remote Port = 0 |
|
mov ebx, net_sockets |
|
.next_socket.3: |
mov ebx, [ebx + SOCKET.NextPtr] |
or ebx, ebx |
jz .next_socket.3.exit |
|
; DEBUGF 1, "K : tcp_rx - 3.dport: %x - %x\n", [edx + 20 + TCP_Packet.DestinationPort]:4, [ebx + SOCKET.LocalPort]:4 |
|
mov ax, [edx + TCP_Packet.DestinationPort] ; get destination port from the TCP hdr |
cmp [ebx + SOCKET.LocalPort], ax ; compare with socket's local port |
jne .next_socket.3 ; different - try next socket |
|
; DEBUGF 1, "K : tcp_rx - 3.addr: 00000000 - %x\n", [ebx + SOCKET.RemoteIP] |
|
cmp [ebx + SOCKET.RemoteIP], 0 ; only match a socket remote IP of 0 |
jne .next_socket.3 ; different - try next socket |
|
; DEBUGF 1, "K : tcp_rx - 3.sport: 0000 - %x\n", [ebx + SOCKET.RemotePort]:4 |
|
cmp [ebx + SOCKET.RemotePort], 0 ; only match a remote socket of 0 |
jne .next_socket.3 ; different - try next socket |
|
; We have a complete match - use this socket |
jmp .change_state |
|
.next_socket.3.exit: |
|
; If we got here, we need to reject the Packet |
|
DEBUGF 1, "K : tcp_rx - dumped\n" |
; DEBUGF 1, "K : --------: %x-%x-%x (flags: %x)\n", [edx + 20 + TCP_Packet.DestinationPort]:4, [edx + IP_Packet.SourceAddress], [edx + 20 + TCP_Packet.SourcePort]:4, [edx + 20 + TCP_Packet.Flags]:2 |
|
; inc [dumped_rx_count] |
jmp .exit |
|
.change_state: |
|
; We have a valid socket/TCB, so call the TCB State Machine for that skt. |
; socket is pointed to by ebx |
; IP Packet is pointed to by edx |
; IP buffer number is on stack ( it will be popped at the end) |
|
stdcall tcpStateMachine, ebx |
|
.exit: |
mov [ebx + SOCKET_head.lock], 0 |
|
.dump: |
DEBUGF 1,"Dumping TCP packet\n" |
call kernel_free |
add esp, 4 ; pop (balance stack) |
|
424,370 → 434,223 |
|
;----------------------------------------------------------------- |
; |
; IN: eax = dest ip |
; ebx = source ip |
; ecx = data length |
; edx = remote port shl 16 + local port |
; esi = data offset |
; TCP_socket_send |
; |
; IN: eax = socket pointer |
; ecx = number of bytes to send |
; esi = pointer to data |
; |
;----------------------------------------------------------------- |
|
TCP_create_Packet: |
align 4 |
TCP_socket_send: |
|
DEBUGF 1,"Create TCP Packet\n" |
;*************************************************************************** |
; Function |
; buildTCPPacket |
; |
; Description |
; builds an IP Packet with TCP data fully populated for transmission |
; You may destroy any and all registers |
; TCP control flags specified in bl |
; This TCB is in [sktAddr] |
; User data pointed to by esi |
; Data length in ecx |
; Transmit buffer number in eax |
; |
;*************************************************************************** |
DEBUGF 1,"Creating TCP Packet\n" |
|
push ecx ; Save data length |
mov di , IP_PROTO_TCP |
|
add ecx, UDP_Packet.Data |
mov di , IP_PROTO_UDP |
; Create an IPv4 Packet of the correct size |
push eax |
mov ebx, [eax + SOCKET_head.end + IPv4_SOCKET.LocalIP] |
mov eax, [eax + SOCKET_head.end + IPv4_SOCKET.RemoteIP] |
|
; dx = fragment id |
|
call IPv4_create_Packet ; TODO: figure out a way to choose between IPv4 and IPv6 |
cmp edi, -1 |
je .exit |
|
mov [edi + TCP_Packet.Flags], bl ; TCP flags |
|
; mov ebx, [sockAddr];---------------------------------------------------------- eof |
|
; So, ebx holds the socket ptr, edx holds the IPbuffer ptr |
|
; Fill in the IP header ( some data is in the socket descriptor) |
mov eax, [ebx + SOCKET.LocalIP] |
; mov [edx + IP_Packet.SourceAddress], eax |
mov eax, [ebx + SOCKET.RemoteIP] |
; mov [edx + IP_Packet.DestinationAddress], eax |
|
; mov [edx + IP_Packet.VersionAndIHL], 0x45 |
; mov [edx + IP_Packet.TypeOfService], 0 |
|
pop eax ; Get the TCP data length |
; meanwhile, create the pseudoheader in stack, |
; (now that we still have all the variables that are needed.) |
push cx |
push di |
push eax |
push ebx |
|
add eax, 20 + 20 ; add IP header and TCP header lengths |
rol ax, 8 |
; mov [edx + IP_Packet.TotalLength], ax |
; mov [edx + IP_Packet.Identification], 0 |
; mov [edx + IP_Packet.FlagsAndFragmentOffset], 0x0040 |
; mov [edx + IP_Packet.TimeToLive], 0x20 |
; mov [edx + IP_Packet.Protocol], PROTOCOL_TCP |
|
; Checksum left unfilled |
; mov [edx + IP_Packet.HeaderChecksum], 0 |
push ecx esi eax ; save some variables for later |
add ecx, TCP_Packet.Data |
call IPv4_create_packet |
cmp edi, -1 |
je .fail |
|
; Fill in the TCP header (some data is in the socket descriptor) |
mov ax, [ebx + SOCKET.LocalPort] |
mov [edx + 20 + TCP_Packet.SourcePort], ax ; Local Port |
pop esi |
|
mov ax, [ebx + SOCKET.RemotePort] |
mov [edx + 20 + TCP_Packet.DestinationPort], ax ; desitination Port |
; Now add the TCP header to the IPv4 packet |
|
; Checksum left unfilled |
mov [edx + 20 + TCP_Packet.Checksum], 0 |
push [esi + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.SND_NXT] |
pop [edi + TCP_Packet.SequenceNumber] |
|
; sequence number |
mov eax, [ebx + SOCKET.SND_NXT] |
mov [edx + 20 + TCP_Packet.SequenceNumber], eax |
push dword [esi + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.LocalPort] |
pop dword [edi + TCP_Packet.SourcePort] |
|
; ack number |
mov eax, [ebx + SOCKET.RCV_NXT] |
mov [edx + 20 + TCP_Packet.AckNumber], eax |
|
; window ( 0x2000 is default ).I could accept 4KB, fa0, ( skt buffer size) |
; 768 bytes seems better |
mov [edx + 20 + TCP_Packet.Window], 0x0003 |
push [esi + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.SND_NXT] |
pop [edi + TCP_Packet.AckNumber] |
|
; Urgent pointer (0) |
mov [edx + 20 + TCP_Packet.UrgentPointer], 0 |
mov al, [eax + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.flags] |
mov [edi + TCP_Packet.Flags], al |
|
; data offset ( 0x50 ) |
mov [edx + 20 + TCP_Packet.DataOffset], 0x50 |
mov [edi + TCP_Packet.Window], 0x0005 ; 1280 bytes ;;; TODO: read RFC ! |
mov [edi + TCP_Packet.UrgentPointer], 0 |
mov [edi + TCP_Packet.DataOffset], 0x50 |
mov [edi + TCP_Packet.Checksum], 0 |
|
pop ecx ; count of bytes to send |
mov ebx, ecx ; need the length later |
; Copy the data |
mov esi, [esp] |
mov ecx, [esp+4] |
add edi, TCP_Packet.Data |
|
cmp ebx, 0 |
jz @f |
shr ecx, 1 |
jnc .nb |
movsb |
.nb: shr ecx, 1 |
jnc .nw |
movsw |
.nw: rep movsd |
|
mov edi, edx |
add edi, 40 |
cld |
rep movsb ; copy the data across |
; Now, calculate the checksum for pseudoheader |
xor edx, edx |
mov ecx, 12 |
mov esi, esp |
call checksum_1 |
add esp, 12 ; remove the pseudoheader from stack |
; And that of the data |
pop esi |
pop ecx |
call checksum_1 |
; Now create the final checksum and store it in TCP header |
call checksum_2 |
mov [edi + TCP_Packet.Checksum], dx |
|
@@: ; we have edx as IPbuffer ptr. |
; Fill in the TCP checksum |
; First, fill in pseudoheader |
; mov eax, [edx + IP_Packet.SourceAddress] |
; mov [pseudoHeader], eax |
; mov eax, [edx + IP_Packet.DestinationAddress] |
; mov [pseudoHeader + 4], eax |
; mov word[pseudoHeader + 8], PROTOCOL_TCP shl 8 + 0 |
; add ebx, 20 |
; mov [pseudoHeader + 10], bh |
; mov [pseudoHeader + 11], bl |
; |
; mov eax, pseudoHeader |
; mov [checkAdd1], eax |
; mov word[checkSize1], 12 |
; mov eax, edx |
; add eax, 20 |
; mov [checkAdd2], eax |
; mov eax, ebx |
; mov [checkSize2], ax |
; |
; call checksum |
; And now, send it! |
DEBUGF 1,"Sending TCP Packet to device %x\n", ebx |
mov esi, ETH_sender |
mov edx, [edi + TCP_Packet.AckNumber] |
jmp TCP_add_to_queue |
|
; store it in the TCP checksum ( in the correct order! ) |
; mov ax, [checkResult] |
; rol ax, 8 |
; mov [edx + 20 + TCP_Packet.Checksum], ax |
|
; Fill in the IP header checksum |
; movzx eax, byte [edx + IP_Packet.VersionAndIHL] ; Calculate Header length by using IHL field |
; and eax, 0x0000000F ; |
; shl eax, 2 ; |
; |
stdcall checksum_jb, edx, eax ; buf_ptr, buf_size |
rol ax, 8 |
; mov [edx + IP_Packet.HeaderChecksum], ax |
|
|
.exit: |
|
call kernel_free |
add esp, 4 ; pop (balance stack) |
|
.fail: |
add esp, 12+4 |
ret |
;endp |
|
|
; Increments the 32 bit value pointed to by esi in internet order |
proc inc_inet_esi stdcall |
; push eax |
; mov eax, [esi] |
; bswap eax |
; inc eax |
; bswap eax |
; mov [esi], eax |
; pop eax |
; ret |
inc byte[esi+0] |
adc byte[esi+1],0 |
adc byte[esi+2],0 |
adc byte[esi+3],0 |
endp |
|
|
; Increments the 32 bit value pointed to by esi in internet order |
; by the value in ecx |
proc add_inet_esi stdcall |
push eax |
mov eax, [esi] |
bswap eax |
add eax, ecx |
bswap eax |
mov [esi], eax |
pop eax |
ret |
endp |
|
|
iglobal |
TCBStateHandler dd \ |
stateTCB_LISTEN, \ |
stateTCB_SYN_SENT, \ |
stateTCB_SYN_RECEIVED, \ |
stateTCB_ESTABLISHED, \ |
stateTCB_FIN_WAIT_1, \ |
stateTCB_FIN_WAIT_2, \ |
stateTCB_CLOSE_WAIT, \ |
stateTCB_CLOSING, \ |
stateTCB_LAST_ACK, \ |
stateTCB_TIME_WAIT, \ |
stateTCB_CLOSED |
endg |
|
|
;*************************************************************************** |
; Function |
; tcpStateMachine |
;----------------------------------------------------------------- |
; |
; Description |
; TCP state machine |
; This is a kernel function, called by tcp_rx |
; TCP_send_ack |
; |
; IP buffer address given in edx |
; Socket/TCB address in ebx |
; IN: eax = socket pointer |
; bl = flags |
; |
; The IP buffer will be released by the caller |
;*************************************************************************** |
;----------------------------------------------------------------- |
|
proc tcpStateMachine stdcall, sockAddr:DWORD |
; as a Packet has been received, update the TCB timer |
mov [ebx + SOCKET.TCBTimer], TWOMSL |
align 4 |
TCP_send_ack: |
|
; If the received Packet has an ACK bit set, |
; remove any Packets in the resend queue that this |
; received Packet acknowledges |
pushad |
test [edx + 20 + TCP_Packet.Flags], TH_ACK |
jz .call_handler ; No ACK, so no data yet |
DEBUGF 1,"Creating TCP ACK\n" |
|
; get skt number in eax |
stdcall net_socket_addr_to_num, ebx |
mov di , IP_PROTO_TCP |
mov cx , TCP_Packet.Data |
|
; The ack number is in [edx + 28], inet format |
; skt in eax |
push bx eax |
|
mov esi, resendQ |
xor ecx, ecx |
; Create an IPv4 Packet of the correct size |
mov ebx, [eax + SOCKET_head.end + IPv4_SOCKET.LocalIP] |
mov eax, [eax + SOCKET_head.end + IPv4_SOCKET.RemoteIP] |
|
.next_resendq: |
; cmp ecx, NUMRESENDENTRIES |
je .call_handler ; None left |
cmp [esi + 4], eax |
je @f ; found one |
inc ecx |
add esi, 8 |
jmp .next_resendq |
call IPv4_create_packet |
cmp edi, -1 |
je .fail |
|
@@: ; Can we delete this buffer? |
; Fill in the TCP header |
pop esi |
|
; If yes, goto @@. No, goto .next_resendq |
; Get Packet data address |
push [esi + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.SND_NXT] |
pop [edi + TCP_Packet.SequenceNumber] |
|
push ecx |
; Now get buffer location, and copy buffer across. argh! more copying,, |
; imul edi, ecx, IPBUFFSIZE |
; add edi, resendBuffer |
push dword [esi + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.LocalPort] |
pop dword [edi + TCP_Packet.SourcePort] |
|
; we have dest buffer location in edi. incoming Packet in edx. |
; Get this Packets sequence number |
; preserve al, ecx, esi, edx |
mov ecx, [edi + 20 + TCP_Packet.SequenceNumber] |
bswap ecx |
movzx ebx, word[edi + 2] |
xchg bl, bh |
sub ebx, 40 |
add ecx, ebx ; ecx is now seq# of last byte +1, intel format |
push [esi + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.SND_NXT] |
pop [edi + TCP_Packet.AckNumber] |
|
; get recievd ack #, in intel format |
mov ebx, [edx + 20 + TCP_Packet.AckNumber] |
bswap ebx |
pop cx |
mov [edi + TCP_Packet.Flags], cl |
mov [edi + TCP_Packet.Window], 0x0005 ; 1280 bytes |
mov [edi + TCP_Packet.UrgentPointer], 0 |
mov [edi + TCP_Packet.DataOffset], 0x50 |
|
cmp ebx, ecx ; Finally. ecx = rx'ed ack. ebx = last byte in que |
; DANGER! need to handle case that we have just |
; passed the 2**32, and wrapped round! |
pop ecx |
jae @f ; if rx > old, delete old |
push eax edx |
|
inc ecx |
add esi, 8 |
jmp .next_resendq |
push word TCP_Packet.Data shl 8 |
push IP_PROTO_TCP |
push [esi + SOCKET_head.end + SOCKET_head.end + IPv4_SOCKET.RemoteIP] |
push [esi + SOCKET_head.end + SOCKET_head.end + IPv4_SOCKET.LocalIP] |
|
@@: mov dword[esi + 4], 0 |
inc ecx |
add esi, 8 |
jmp .next_resendq |
; Now, calculate the checksum for pseudoheader |
xor edx, edx |
mov ecx, 12 |
mov esi, esp |
call checksum_1 |
add esp, 12 ; remove the pseudoheader from stack |
; Now create the final checksum and store it in TCP header |
call checksum_2 |
mov [edi + TCP_Packet.Checksum], dx |
|
.call_handler: |
popad |
; And now, send it! |
DEBUGF 1,"Sending TCP Packet to device %x\n", ebx |
mov esi, ETH_sender |
mov edx, [edi + TCP_Packet.AckNumber] |
jmp TCP_add_to_queue |
|
; Call handler for given TCB state |
.fail: |
add esp, 12+4 |
ret |
|
mov eax, [ebx + SOCKET.TCBState] |
cmp eax, TCB_LISTEN |
jb .exit |
cmp eax, TCB_CLOSED |
ja .exit |
|
stdcall [TCBStateHandler + (eax - 1) * 4], [sockAddr] |
|
.exit: |
ret |
endp |
|
|
proc stateTCB_LISTEN stdcall, sockAddr:DWORD |
align 4 |
stateTCB_LISTEN: |
; In this case, we are expecting a SYN Packet |
; For now, if the Packet is a SYN, process it, and send a response |
; If not, ignore it |
|
; Look at control flags |
test [edx + 20 + TCP_Packet.Flags], TH_SYN |
test [edx + TCP_Packet.Flags], TH_SYN |
jz .exit |
|
; We have a SYN. update the socket with this IP Packets details, |
; And send a response |
|
; mov eax, [edx + IP_Packet.SourceAddress] |
; mov [ebx + SOCKET.RemoteIP], eax |
; mov ax, [edx + 20 + TCP_Packet.SourcePort] |
; mov [ebx + SOCKET.RemotePort], ax |
; mov eax, [edx + 20 + TCP_Packet.SequenceNumber] |
; mov [ebx + SOCKET.IRS], eax |
; mov [ebx + SOCKET.RCV_NXT], eax |
; lea esi, [ebx + SOCKET.RCV_NXT] |
; call inc_inet_esi ; RCV.NXT |
; mov eax, [ebx + SOCKET.ISS] |
; mov [ebx + SOCKET.SND_NXT], eax |
; |
; Now construct the response, and queue for sending by IP |
; mov eax, EMPTY_QUEUE |
; call dequeue |
; cmp ax, NO_BUFFER |
; je .exit |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.RemoteIP], esi ; IP source address |
mov ax, [edx + TCP_Packet.SourcePort] |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RemotePort], ax |
mov eax, [edx + TCP_Packet.SequenceNumber] |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.IRS], eax |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RCV_NXT], eax |
lea esi, [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RCV_NXT] |
inc_INET esi ; RCV.NXT |
mov eax, [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.ISS] |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.SND_NXT], eax |
|
push eax |
; Now construct the response |
mov bl, TH_SYN + TH_ACK |
xor ecx, ecx |
xor esi, esi |
; stdcall build_tcp_Packet, [sockAddr] |
call TCP_send_ack |
|
; mov eax, NET1OUT_QUEUE |
;;; mov edx, [stack_ip] |
mov ecx, [sockAddr] |
cmp edx, [ecx + SOCKET.RemoteIP] |
jne .not_local |
; mov eax, IPIN_QUEUE |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_SYN_RECEIVED |
|
.not_local: |
; Send it. |
pop ebx |
;;; call queue |
|
mov esi, [sockAddr] |
mov [esi + SOCKET.TCBState], TCB_SYN_RECEIVED |
|
; increment SND.NXT in socket |
add esi, SOCKET.SND_NXT |
call inc_inet_esi |
lea esi, [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.SND_NXT] |
inc_INET esi |
|
.exit: |
ret |
endp |
|
|
proc stateTCB_SYN_SENT stdcall, sockAddr:DWORD |
align 4 |
stateTCB_SYN_SENT: |
; We are awaiting an ACK to our SYN, with a SYM |
; Look at control flags - expecting an ACK |
|
mov al, [edx + 20 + TCP_Packet.Flags] |
mov al, [edx + TCP_Packet.Flags] |
and al, TH_SYN + TH_ACK |
cmp al, TH_SYN + TH_ACK |
je .syn_ack |
795,139 → 658,89 |
test al, TH_SYN |
jz .exit |
|
mov [ebx + SOCKET.TCBState], TCB_SYN_RECEIVED |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_SYN_RECEIVED |
push TH_SYN + TH_ACK |
jmp .send |
|
.syn_ack: |
mov [ebx + SOCKET.TCBState], TCB_ESTABLISHED |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_ESTABLISHED |
push TH_ACK |
|
.send: |
; Store the recv.nxt field |
mov eax, [edx + 20 + TCP_Packet.SequenceNumber] |
mov eax, [edx + TCP_Packet.SequenceNumber] |
|
; Update our recv.nxt field |
mov [ebx + SOCKET.RCV_NXT], eax |
lea esi, [ebx + SOCKET.RCV_NXT] |
call inc_inet_esi |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RCV_NXT], eax |
lea esi, [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RCV_NXT] |
inc_INET esi |
|
; Send an ACK |
; Now construct the response, and queue for sending by IP |
; mov eax, EMPTY_QUEUE |
; call dequeue |
; cmp ax, NO_BUFFER |
pop ebx |
je .exit |
call TCP_send_ack |
|
push eax |
|
xor ecx, ecx |
xor esi, esi |
; stdcall build_tcp_Packet, [sockAddr] |
|
; mov eax, NET1OUT_QUEUE |
;;; mov edx, [stack_ip] |
; mov ecx, [sockAddr] |
; cmp edx, [ecx + SOCKET.RemoteIP] |
; jne .not_local |
; mov eax, IPIN_QUEUE |
|
.not_local: |
; Send it. |
pop ebx |
;;; call queue |
|
.exit: |
ret |
endp |
|
|
proc stateTCB_SYN_RECEIVED stdcall, sockAddr:DWORD |
|
align 4 |
stateTCB_SYN_RECEIVED: |
; In this case, we are expecting an ACK Packet |
; For now, if the Packet is an ACK, process it, |
; If not, ignore it |
|
test [edx + 20 + TCP_Packet.Flags], TH_RST |
test [edx + TCP_Packet.Flags], TH_RST |
jz .check_ack |
|
push [ebx + SOCKET.OrigRemotePort] [ebx + SOCKET.OrigRemoteIP] |
pop [ebx + SOCKET.RemoteIP] [ebx + SOCKET.RemotePort] |
push [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.OrigRemotePort] |
pop [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RemotePort] |
push [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.OrigRemoteIP] |
pop [ebx + SOCKET_head.end + IPv4_SOCKET.RemoteIP] |
|
mov [ebx + SOCKET.TCBState], TCB_LISTEN |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_LISTEN |
jmp .exit |
|
.check_ack: |
; Look at control flags - expecting an ACK |
test [edx + 20 + TCP_Packet.Flags], TH_ACK |
test [edx + TCP_Packet.Flags], TH_ACK |
jz .exit |
|
mov [ebx + SOCKET.TCBState], TCB_ESTABLISHED |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_ESTABLISHED |
|
.exit: |
ret |
endp |
|
|
proc stateTCB_ESTABLISHED stdcall, sockAddr:DWORD |
|
align 4 |
stateTCB_ESTABLISHED: |
; Here we are expecting data, or a request to close |
; OR both... |
|
; Did we receive a FIN or RST? |
test [edx + 20 + TCP_Packet.Flags], TH_FIN |
test [edx + TCP_Packet.Flags], TH_FIN |
jz .check_ack |
|
; It was a fin or reset. |
|
; Remove resend entries from the queue - I dont want to send any more data |
pushad |
; Send an ACK to that fin, and enter closewait state |
|
; get skt # |
stdcall net_socket_addr_to_num, ebx |
|
mov esi, resendQ |
mov ecx, 0 |
|
.next_resendq: |
; cmp ecx, NUMRESENDENTRIES |
; je .last_resendq ; None left |
; cmp [esi + 4], eax |
; je @f ; found one |
; inc ecx |
; add esi, 8 |
; jmp .next_resendq |
|
@@: mov dword[esi + 4], 0 |
inc ecx |
add esi, 8 |
jmp .next_resendq |
|
.last_resendq: |
popad |
|
@@: ; Send an ACK to that fin, and enter closewait state |
|
mov [ebx + SOCKET.TCBState], TCB_CLOSE_WAIT |
lea esi, [ebx + SOCKET.RCV_NXT] |
mov eax, [esi] ; save original |
call inc_inet_esi |
;; jmp ste_ack - NO, there may be data |
|
.check_ack: |
; Check that we received an ACK |
test [edx + 20 + TCP_Packet.Flags], TH_ACK |
test [edx + TCP_Packet.Flags], TH_ACK |
jz .exit |
|
; TODO - done, I think! |
; First, look at the incoming window. If this is less than or equal to 1024, |
; Set the socket window timer to 1. This will stop an additional Packets being queued. |
; ** I may need to tweak this value, since I do not know how many Packets are already queued |
mov cx, [edx + 20 + TCP_Packet.Window] |
mov cx, [edx + TCP_Packet.Window] |
xchg cl, ch |
cmp cx, 1024 |
ja @f |
|
mov [ebx + SOCKET.wndsizeTimer], 1 |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.wndsizeTimer], 1 |
|
@@: ; OK, here is the deal |
; My recv.nct field holds the seq of the expected next rec byte |
938,117 → 751,41 |
; recv.nxt is in dword [edx+24], in inet format |
; recv seq is in [sktAddr]+56, in inet format |
; just do a comparision |
mov ecx, [ebx + SOCKET.RCV_NXT] |
cmp [ebx + SOCKET.TCBState], TCB_CLOSE_WAIT |
mov ecx, [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RCV_NXT] |
cmp [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_CLOSE_WAIT |
jne @f |
mov ecx, eax |
|
@@: cmp ecx, [edx + 20 + TCP_Packet.SequenceNumber] |
@@: cmp ecx, [edx + TCP_Packet.SequenceNumber] |
jne .ack |
|
test ecx, ecx |
jnz .data |
|
; Read the data bytes, store in socket buffer |
; movzx ecx, [edx + IP_Packet.TotalLength] |
xchg cl, ch |
sub ecx, 40 ; Discard 40 bytes of header |
ja .data ; Read data, if any |
|
; If we had received a fin, we need to ACK it. |
cmp [ebx + SOCKET.TCBState], TCB_CLOSE_WAIT |
cmp [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_CLOSE_WAIT |
je .ack |
jmp .exit |
|
.data: |
push ebx |
add ebx, SOCKET.lock |
call wait_mutex |
pop ebx |
mov esi, [esp + 4] |
sub edx, esi |
mov edi, edx |
call socket_internal_receiver |
|
push ecx |
push [ebx + SOCKET.PID] ; get socket owner PID |
mov eax, [ebx + SOCKET.rxDataCount] |
add eax, ecx |
cmp eax, SOCKETBUFFSIZE - SOCKETHEADERSIZE |
ja .overflow |
|
mov [ebx + SOCKET.rxDataCount], eax ; increment the count of bytes in buffer |
|
; point to the location to store the data |
lea edi, [ebx + eax + SOCKETHEADERSIZE] |
sub edi, ecx |
|
add edx, 40 ; edx now points to the data |
mov esi, edx |
|
cld |
rep movsb ; copy the data across |
mov [ebx + SOCKET.lock], 0 ; release mutex |
|
; flag an event to the application |
pop eax |
mov ecx, 1 |
mov esi, TASK_DATA + TASKDATA.pid |
|
.next_pid: |
cmp [esi], eax |
je .found_pid |
inc ecx |
add esi, 0x20 |
cmp ecx, [TASK_COUNT] |
jbe .next_pid |
|
.found_pid: |
shl ecx, 8 |
or [ecx + SLOT_BASE + APPDATA.event_mask], EVENT_NETWORK ; stack event |
|
pop ecx |
|
; Update our recv.nxt field |
lea esi, [ebx + SOCKET.RCV_NXT] |
call add_inet_esi |
|
.ack: |
; Send an ACK |
; Now construct the response, and queue for sending by IP |
; mov eax, EMPTY_QUEUE |
; call dequeue |
; cmp ax, NO_BUFFER |
je .exit |
|
push eax |
|
mov bl, TH_ACK |
xor ecx, ecx |
xor esi, esi |
; stdcall build_tcp_Packet, [sockAddr] |
|
; mov eax, NET1OUT_QUEUE |
|
;;; mov edx, [stack_ip] |
; mov ecx, [sockAddr] |
; cmp edx, [ecx + SOCKET.RemoteIP] |
; jne .not_local |
; mov eax, IPIN_QUEUE |
|
.not_local: |
; Send it. |
pop ebx |
;;; call queue |
|
call TCP_send_ack |
.exit: |
ret |
.overflow: |
; no place in buffer |
; so simply restore stack and exit |
pop eax ecx |
mov [ebx + SOCKET.lock], 0 |
ret |
endp |
|
|
proc stateTCB_FIN_WAIT_1 stdcall, sockAddr:DWORD |
|
align 4 |
stateTCB_FIN_WAIT_1: |
; We can either receive an ACK of a fin, or a fin |
mov al, [edx + 20 + TCP_Packet.Flags] |
mov al, [edx + TCP_Packet.Flags] |
and al, TH_FIN + TH_ACK |
|
cmp al, TH_ACK |
1055,109 → 792,69 |
jne @f |
|
; It was an ACK |
mov [ebx + SOCKET.TCBState], TCB_FIN_WAIT_2 |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_FIN_WAIT_2 |
jmp .exit |
|
@@: mov [ebx + SOCKET.TCBState], TCB_CLOSING |
@@: mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_CLOSING |
cmp al, TH_FIN |
je @f |
mov [ebx + SOCKET.TCBState], TCB_TIMED_WAIT |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_TIMED_WAIT |
|
@@: lea esi, [ebx + SOCKET.RCV_NXT] |
call inc_inet_esi |
|
@@: lea esi, [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RCV_NXT] |
inc_INET esi |
; Send an ACK |
; mov eax, EMPTY_QUEUE |
; call dequeue |
; cmp ax, NO_BUFFER |
je .exit |
|
push eax |
|
mov bl, TH_ACK |
xor ecx, ecx |
xor esi, esi |
; stdcall build_tcp_Packet, [sockAddr] |
call TCP_send_ack |
|
; mov eax, NET1OUT_QUEUE |
;;; mov edx, [stack_ip] |
; mov ecx, [sockAddr] |
; cmp edx, [ecx + SOCKET.RemoteIP] |
; jne .not_local |
; mov eax, IPIN_QUEUE |
|
.not_local: |
; Send it. |
pop ebx |
;;; call queue |
|
.exit: |
ret |
endp |
|
|
proc stateTCB_FIN_WAIT_2 stdcall, sockAddr:DWORD |
test [edx + 20 + TCP_Packet.Flags], TH_FIN |
|
align 4 |
stateTCB_FIN_WAIT_2: |
test [edx + TCP_Packet.Flags], TH_FIN |
jz .exit |
|
; Change state, as we have a fin |
mov [ebx + SOCKET.TCBState], TCB_TIMED_WAIT |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_TIMED_WAIT |
|
lea esi, [ebx + SOCKET.RCV_NXT] |
call inc_inet_esi |
lea esi, [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.RCV_NXT] |
inc_INET esi |
|
; Send an ACK |
; mov eax, EMPTY_QUEUE |
; call dequeue |
;; cmp ax, NO_BUFFER |
; je .exit |
|
push eax |
|
mov bl, TH_ACK |
xor ecx, ecx |
xor esi, esi |
; stdcall build_tcp_Packet, [sockAddr] |
call TCP_send_ack |
|
; mov eax, NET1OUT_QUEUE |
;;; mov edx, [stack_ip] |
mov ecx, [sockAddr] |
cmp edx, [ecx + SOCKET.RemoteIP] |
jne .not_local |
; mov eax, IPIN_QUEUE |
|
.not_local: |
; Send it. |
pop ebx |
;;; call queue |
|
.exit: |
ret |
endp |
|
|
proc stateTCB_CLOSE_WAIT stdcall, sockAddr:DWORD |
|
align 4 |
stateTCB_CLOSE_WAIT: |
; Intentionally left empty |
; socket_close_tcp handles this |
ret |
endp |
|
|
proc stateTCB_CLOSING stdcall, sockAddr:DWORD |
|
align 4 |
stateTCB_CLOSING: |
; We can either receive an ACK of a fin, or a fin |
test [edx + 20 + TCP_Packet.Flags], TH_ACK |
test [edx + TCP_Packet.Flags], TH_ACK |
jz .exit |
|
mov [ebx + SOCKET.TCBState], TCB_TIMED_WAIT |
mov [ebx + SOCKET_head.end + IPv4_SOCKET.end + TCP_SOCKET.TCBState], TCB_TIMED_WAIT |
|
.exit: |
ret |
endp |
|
|
proc stateTCB_LAST_ACK stdcall, sockAddr:DWORD |
align 4 |
stateTCB_LAST_ACK: |
; Look at control flags - expecting an ACK |
test [edx + 20 + TCP_Packet.Flags], TH_ACK |
test [edx + TCP_Packet.Flags], TH_ACK |
jz .exit |
|
; delete the socket |
1165,235 → 862,17 |
|
.exit: |
ret |
endp |
|
|
proc stateTCB_TIME_WAIT stdcall, sockAddr:DWORD |
align 4 |
stateTCB_TIME_WAIT: |
ret |
endp |
|
|
proc stateTCB_CLOSED stdcall, sockAddr:DWORD |
align 4 |
stateTCB_CLOSED: |
ret |
endp |
|
|
|
;; [53.7] Send data through STREAM socket |
; |
; @param EBX is socket number |
; @param ECX is application data size (number of bytes to send) |
; @param EDX is pointer to application data buffer |
; @return 0 (sent successfully) or -1 (error) in EAX |
;; |
;proc socket_write_tcp stdcall |
;local sockAddr dd ? |
|
; DEBUGF 1, "socket_write_tcp(0x%x)\n", ebx |
stdcall net_socket_num_to_addr, ebx |
or eax, eax |
jz .error |
|
mov ebx, eax |
; mov [sockAddr], ebx |
|
; If the sockets window timer is nonzero, do not queue Packet |
cmp [ebx + SOCKET.wndsizeTimer], 0 |
jne .error |
|
; mov eax, EMPTY_QUEUE |
; call dequeue |
; cmp ax, NO_BUFFER |
; je .error |
|
push eax |
|
; Get the address of the callers data |
mov edi, [TASK_BASE] |
add edi, TASKDATA.mem_start |
add edx, [edi] |
mov esi, edx |
|
pop eax |
push eax |
|
push ecx |
mov bl, TH_ACK |
; stdcall build_tcp_Packet, [sockAddr] |
pop ecx |
|
; Check destination IP address. |
; If it is the local host IP, route it back to IP_RX |
|
pop ebx |
push ecx |
|
; mov eax, NET1OUT_QUEUE |
;;; TODO: get device id in edx |
xor edx, edx |
|
shl edx, 2 |
mov edx, [IP_LIST+edx] |
; mov ecx, [sockAddr] |
; cmp edx, [ecx + SOCKET.RemoteIP] |
; jne .not_local |
; mov eax, IPIN_QUEUE |
|
.not_local: |
pop ecx |
push ebx ; save ipbuffer number |
|
;;;; call queue |
|
; mov esi, [sockAddr] |
|
; increament SND.NXT in socket |
; Amount to increment by is in ecx |
add esi, SOCKET.SND_NXT |
call add_inet_esi |
|
pop ebx |
|
; Copy the IP buffer to a resend queue |
; If there isn't one, dont worry about it for now |
mov esi, resendQ |
mov ecx, 0 |
|
.next_resendq: |
; cmp ecx, NUMRESENDENTRIES |
je .exit ; None found |
cmp dword[esi + 4], 0 |
je @f ; found one |
inc ecx |
add esi, 8 |
jmp .next_resendq |
|
@@: push ebx |
|
; OK, we have a buffer descriptor ptr in esi. |
; resend entry # in ecx |
; Populate it |
; socket # |
; retries count |
; retry time |
; fill IP buffer associated with this descriptor |
|
; stdcall net_socket_addr_to_num, [sockAddr] |
mov [esi + 4], eax |
mov byte[esi + 1], TCP_RETRIES |
mov word[esi + 2], TCP_TIMEOUT |
|
inc ecx |
; Now get buffer location, and copy buffer across. argh! more copying,, |
; mov edi, resendBuffer - IPBUFFSIZE |
|
; @@: add edi, IPBUFFSIZE |
loop @b |
|
; we have dest buffer location in edi |
pop eax |
; convert source buffer pointer eax to the absolute address |
; mov ecx, IPBUFFSIZE |
; mul ecx |
; add eax, IPbuffs |
; mov esi, eax |
|
; do copy |
; mov ecx, IPBUFFSIZE |
; cld |
rep movsb |
|
.exit: |
xor eax, eax |
ret |
|
.error: |
or eax, -1 |
ret |
;endp |
|
|
|
;*************************************************************************** |
; Function |
; checksum |
; |
; Description |
; checkAdd1,checkAdd2, checkSize1, checkSize2, checkResult |
; Dont break anything; Most registers are used by the caller |
; This code is derived from the 'C' source, cksum.c, in the book |
; Internetworking with TCP/IP Volume II by D.E. Comer |
; |
;*************************************************************************** |
|
|
checksum: |
pusha |
; mov eax, [checkAdd1] |
xor edx, edx ; edx is the accumulative checksum |
xor ebx, ebx |
; mov cx, [checkSize1] |
shr cx, 1 |
jz cs1_1 |
|
cs1: |
mov bh, [eax] |
mov bl, [eax + 1] |
|
add eax, 2 |
add edx, ebx |
|
loopw cs1 |
|
cs1_1: |
; and word [checkSize1], 0x01 |
jz cs_test2 |
|
mov bh, [eax] |
xor bl, bl |
|
add edx, ebx |
|
cs_test2: |
; mov cx, [checkSize2] |
cmp cx, 0 |
jz cs_exit ; Finished if no 2nd buffer |
|
; mov eax, [checkAdd2] |
|
shr cx, 1 |
jz cs2_1 |
|
cs2: |
mov bh, [eax] |
mov bl, [eax + 1] |
|
add eax, 2 |
add edx, ebx |
|
loopw cs2 |
|
cs2_1: |
; and word [checkSize2], 0x01 |
jz cs_exit |
|
mov bh, [eax] |
xor bl, bl |
|
add edx, ebx |
|
cs_exit: |
mov ebx, edx |
|
shr ebx, 16 |
and edx, 0xffff |
add edx, ebx |
mov eax, edx |
shr eax, 16 |
add edx, eax |
not dx |
|
; mov [checkResult], dx |
popa |
ret |
|