A2osX/LIB/LIBTCPIP.S.SKT.txt

NEW
  AUTO 3,1
*/--------------------------------------
* # Socket
* Create a new socket
* ## C
* `hFD socket(short int type, short int protocol);`
* ## ASM
* `>PUSHB type`
* `>PUSHB protocol`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.socket`
* ## RETURN VALUE
* CC: A = hSOCKET
* CS: A = EC
*\--------------------------------------
SKT.Socket		>PULLA					get protocol (RAW)
				pha
				>PULLA
				tax
				pla
SKT.Socket.I	jmp (J.SKT.Socket,x)

SKT.Socket.RAW	ldy #S.SOCKET
				bra SKT.Socket.DSOCK
SKT.Socket.DGRAM
				lda #S.IP.PROTOCOL.UDP
				ldy #S.SOCKET
SKT.Socket.DSOCK
				stx FD.DSOCK+S.SOCKET.T		save type
				sta FD.DSOCK+S.SOCKET.PROTO		ICMP,UDP,TCP

				jsr SKT.Socket.FindFree
				bcs SKT.Socket.RTS

				ldy #0

.1				lda FD.DSOCK,y
				sta (ZPTmpPtr1),y
				iny
				cpy #FD.DSOCK.SIZE
				bne .1

				bra SKT.Socket.ZERO

SKT.Socket.SEQPKT
SKT.Socket.STREAM
				lda #S.IP.PROTOCOL.TCP
				ldy #S.SOCKET.TCP

				stx FD.SSOCK+S.SOCKET.T		save type
				sta FD.SSOCK+S.SOCKET.PROTO

				jsr SKT.Socket.FindFree
				bcs SKT.Socket.RTS

				ldy #0

.1				lda FD.SSOCK,y
				sta (ZPTmpPtr1),y
				iny
				cpy #FD.SSOCK.SIZE
				bne .1

SKT.Socket.ZERO	lda #0

.1				sta (ZPTmpPtr1),y
				iny
				cpy TmpDWord
				bne .1

				txa
				clc
SKT.Socket.RTS	rts
*--------------------------------------
SKT.Socket.FindFree
				sty TmpDWord			Y = socket.size

				ldx #1

.1				lda FDs.pHI-1,x
				beq .2

				inx
				cpx #K.FD.MAX+1
				bcc .1

				lda #E.OOH
*				sec
				rts

.2				stx .8+1

*				lda #0					Y,A = socket.size
				>SYSCALL2 GetMem
				bcs SKT.Socket.RTS

				>STYA ZPTmpPtr1

.8				ldx #$FF				SELF MODIFIED
				sta FDs.pHI-1,x
				tya
				sta FDs.pLO-1,x

*				clc
				rts
*/--------------------------------------
* # Bind
* bind a name to a socket
* ## C
* `int bind(hFD fd, const struct sockaddr *addr);`
* ## ASM
* `>PUSHB fd`
* `>PUSHW addr`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.socket`
* ## RETURN VALUE
* CC: A = hSOCKET
* CS: A = EC
*\--------------------------------------
SKT.bind		jsr SKT.PullLocAddr
				jsr SKT.PullhFD

				lda SKT.LOC.ADDR+S.SOCKADDR.PORT
				ora SKT.LOC.ADDR+S.SOCKADDR.PORT+1
				bne .1

				jsr GetDynPort

				sta SKT.LOC.ADDR+S.SOCKADDR.PORT
				stx SKT.LOC.ADDR+S.SOCKADDR.PORT+1

.1				ldx #1

.2				lda FDs.pHI-1,x
				beq .7

				sta ZPTmpPtr1+1
				lda FDs.pLO-1,x
				sta ZPTmpPtr1

				lda (ZPTmpPtr1)
				cmp #S.FD.T.DSOCK
				beq .4
				
				cmp #S.FD.T.SSOCK
				bne .7

				ldy #S.SOCKET.AF
				lda (ZPTmpPtr1),y
				cmp #AF.INET
				bne .7

				ldy #S.SOCKET.LOC.ADDR

.4				lda (ZPTmpPtr1),y
				cmp SKT.LOC.ADDR+S.SOCKADDR.ADDR-S.SOCKET.LOC.ADDR,y
				bne .7

				iny
				cpy #S.SOCKET.LOC.PORT+2
				bne .4

				lda #ERR.SKT.BUSY
*				sec
				rts

.7				inx
				cpx #K.FD.MAX+1
				bne .2

				jmp SKT.SetLocAddr
*/--------------------------------------
* # Connect
* Initiate a connection on a socket
* ## C
* `int connect(hFD fd, const struct sockaddr *addr);`
* ## ASM
* `>PUSHB fd`
* `>PUSHW addr`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.socket`
* ## RETURN VALUE
* CC: A = hSOCKET
* CS: A = EC
*\--------------------------------------
SKT.connect		jsr SKT.PullRemAddr
				jsr SKT.PullhFD

				ldy #S.SOCKET.T
				lda (ZPPtrSKT),y
				tax
				jmp (J.SKT.connect,x)

SKT.connect.RAW
SKT.connect.DGRAM
				jmp SKT.SetRemAddr

SKT.connect.STREAM
SKT.connect.SEQPKT
				ldy #S.SOCKET.TCP.S
				lda (ZPPtrSKT),y
				beq .1

				cmp #S.SOCKET.TCP.S.ESTBLSH
				beq SKT.listen.8
				bcs .9

				cmp #S.SOCKET.TCP.S.OPENED
				beq .2

				cmp #S.SOCKET.TCP.S.SYNSENT
				beq .99

.9				lda #ERR.SKT.BAD
				sec
				rts

.1				jsr SKT.SetRemAddr
				jsr SKT.NewTCB
				bcs SKT.listen.RTS

				lda #S.SOCKET.TCP.S.OPENED
				jsr SKT.StoreTCB.S

.2				lda #S.TCP.OPTIONS.SYN
				jsr TCP.OUT.SendOptA	Send SYN
				bcs .99

				lda #S.SOCKET.TCP.S.SYNSENT
				jsr SKT.StoreTCB.S

.99				lda #ERR.SKT.NOCONN
				sec
				rts
*/--------------------------------------
* # Listen
* Listen for connections on a socket
* ## C
* `int listen(hFD fd);`
* ## ASM
* `lda fd`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.listen`
* ## RETURN VALUE
* CS: A = EC
*\--------------------------------------
SKT.listen		jsr SKT.GetFD

				ldy #S.SOCKET.T
				lda (ZPPtrSKT),y
				cmp #S.SOCKET.T.SEQPKT
				bcc SKT.listen.9

				ldy #S.SOCKET.TCP.S
				lda (ZPPtrSKT),y
				bne SKT.listen.9

				lda #S.SOCKET.TCP.S.LISTEN
				sta (ZPPtrSKT),y

				ldy #S.SOCKET.O
				lda #S.SOCKET.O.ACCEPTCONN
				sta (ZPPtrSKT),y

SKT.listen.8	clc
				rts

SKT.listen.9	lda #ERR.SKT.BAD
				sec
SKT.listen.RTS	rts
*/--------------------------------------
* # Accept
* Accept a connection on a socket
* ## C
* `hFD Accept(hFD fd);`
* ## ASM
* `lda fd`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.accept`
* ## RETURN VALUE
* A = hSocket
*\--------------------------------------
SKT.Accept		jsr SKT.GetFD

				ldy #S.SOCKET.O
				lda (ZPPtrSKT),y
				and #S.SOCKET.O.ACCEPTCONN
				beq SKT.listen.9
*--------------------------------------
SKT.GetFromQueue
				ldy #S.SOCKET.HQ.TAIL
				lda (ZPPtrSKT),y
				iny						#S.SOCKET.HQ.HEAD
				cmp (ZPPtrSKT),y
				beq .9					CS

				pha
				inc
				cmp #S.SOCKET.HQ.MAX
				bne .1

				lda #0

.1				dey						#S.SOCKET.HQ.TAIL
				sta (ZPPtrSKT),y

				pla
				clc
				adc #S.SOCKET.HQ
				tay
				lda (ZPPtrSKT),y

*				clc

.9				rts
*/--------------------------------------
* # Shutdown
* Close socket
* ## C
* `int shutdown(int fd);`
* ## ASM
* `lda fd`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.shutdown`
* ## RETURN VALUE
*\--------------------------------------
SKT.shutdown	pha
				jsr SKT.GetFD

				ldy #S.SOCKET.O
				lda (ZPPtrSKT),y
				and #S.SOCKET.O.ACCEPTCONN
				bne SKT.shutdown.HQ

				ldy #S.SOCKET.T
				lda (ZPPtrSKT),y
				cmp #S.SOCKET.T.SEQPKT
				bcc	SKT.shutdown.HQ

				bne .15
				
.11				jsr SKT.GetFromQueue
				bcs .15
				
				>SYSCALL2 FreeMem
				bcc .11

.15				ldy #S.SOCKET.TCP.S
				lda (ZPPtrSKT),y
				cmp #S.SOCKET.TCP.S.CLWAIT
				bne .10

				lda	#S.SOCKET.TCP.S.TIMEWT

				sta (ZPPtrSKT),y
				pla
				clc
				rts
*--------------------------------------
.10				pla
				jsr SKT.GetTCB
				ldy #S.SOCKET.TCP.S
				lda (ZPPtrSKT),y

				cmp #S.SOCKET.TCP.S.ESTBLSH
				bne .1

				jsr TCP.OUT.SendFINACK

				lda #S.SOCKET.TCP.S.FINWT1
				jmp SKT.StoreTCB.S

.1				cmp #S.SOCKET.TCP.S.FINWT2
				bne .2

				jsr TCP.OUT.SendFINACK

				lda #S.SOCKET.TCP.S.LASTACK
				jmp SKT.StoreTCB.S

.2				lda #S.TCP.OPTIONS.RST
				jsr TCP.OUT.SendOptA	Send RST

.3				lda #S.SOCKET.TCP.S.TIMEWT
				jmp SKT.StoreTCB.S
*--------------------------------------
SKT.shutdown.HQ	jsr SKT.GetFromQueue
				bcs .1

				>SYSCALL2 FreeMem

				bra SKT.shutdown.HQ

.1				pla					get hFD...
*--------------------------------------
SKT.FreeFD		tax
				lda FDs.pHI-1,x
				stz FDs.pHI-1,x
				ldy FDs.pLO-1,x
				>SYSCALL2 Free
				rts
*/--------------------------------------
* # Read (STREAM)
* ## C
* `int skt.read(hFD fd, void *buf, int count);`
* ## ASM
* `>PUSHB fd`
* `>PUSHW buf`
* `>PUSHW count`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.read`
* ## RETURN VALUE
* CC: Y,A = bytes read
* CS: A = EC
*\--------------------------------------
SKT.Read 		jsr SKT.PullhFDDataInPtrLen

				jsr SKT.GetTCB

				ldy #S.SOCKET.TCP.INUSED
				lda (ZPPtrSKT),y
				tax
				iny
				ora (ZPPtrSKT),y
				beq .8					no data, go check SKT status

				cpx ZPDataInLen			XA = Data in pipe
				lda (ZPPtrSKT),y
				sbc ZPDataInLen+1
				bcs SKT.GetDataFromSktIn	more data in pipe, get full buffer of data

				stx ZPDataInLen			less data than INUSED, Get only INUSED data
				lda (ZPPtrSKT),y
				sta ZPDataInLen+1
				bra SKT.GetDataFromSktIn

.8				jsr SKT.CheckStream
				bcs .99					I/O error

				lda #E.NODATA
				sec
.99				rts
*--------------------------------------
* In:
*  Src : hInMem/INTAIL
*  Dst : ZPDataOutPtr/ZPDataOutLen
* Out:
*  Y,A = bytes read
*--------------------------------------
SKT.GetDataFromSktIn
				ldy #S.SOCKET.SQ.hInMem
				lda (ZPPtrSKT),y
				.DO AUXPIPE=1
				>SYSCALL2 GetStkObjPtr
				.ELSE
				>SYSCALL2 GetMemPtr
				.FIN
				sty ZPTmpPtr1

*				clc
				adc SKT.Cache+S.SOCKET.TCP.INTAIL+1
				sta ZPTmpPtr1+1

				jsr SKT.GetNotDataInLen
				pha

				.DO AUXPIPE=1
				jsr SKT.SetupZPCode
				.FIN
				ldy SKT.Cache+S.SOCKET.TCP.INTAIL

.1				inx						Check if room left in dest buffer
				bne .2

				pla
				inc
				beq .8

				pha

.2				.DO AUXPIPE=1
				jsr ZPCode
				.ELSE
				lda (ZPTmpPtr1),y
				.FIN
				sta (ZPDataInPtr)
				inc ZPDataInPtr
				bne .3

				inc ZPDataInPtr+1

.3				iny
				bne .1

				inc ZPTmpPtr1+1

				inc SKT.Cache+S.SOCKET.TCP.INTAIL+1
				lda SKT.Cache+S.SOCKET.TCP.INTAIL+1
				cmp /K.TCP.WSIZE
				bne .1

				stz SKT.Cache+S.SOCKET.TCP.INTAIL+1
				lda ZPTmpPtr1+1
*				sec
				sbc /K.TCP.WSIZE
				sta ZPTmpPtr1+1
				bra .1

.8				sty SKT.Cache+S.SOCKET.TCP.INTAIL

*				>ADC16 SKT.Cache+S.SOCKET.TCP.INFREE,ZPDataInLen
				ldx #S.SOCKET.TCP.INFREE
				jsr SKT.AddDataInLenAtSktX

*				>SBC16 SKT.Cache+S.SOCKET.TCP.INUSED,ZPDataInLen
				ldx #S.SOCKET.TCP.INUSED
				jsr SKT.SubDataInLenAtSktX

				lda ZPDataInLen
				ldy ZPDataInLen+1
				ldx #S.SOCKET.TCP.INACKNUM
				jsr TCP.AddAYToSktCacheAtX

				jsr SKT.StoreTCB

				lda #S.TCP.OPTIONS.ACK
				jsr TCP.SetSocketTCPO

				>LDYA ZPDataInLen
				clc
				rts
*--------------------------------------
* From TCP.IN
* Src : ZPDataInPtr/ZPDataInLen
* Dst : hInMem/INHEAD
*--------------------------------------
SKT.AddDataToSktIn
				lda SKT.Cache+S.SOCKET.TCP.INFREE
				sec
				sbc ZPDataInLen
				tax
				lda SKT.Cache+S.SOCKET.TCP.INFREE+1
				sbc ZPDataInLen+1
				bcc .9					Not enough room in Q

				stx SKT.Cache+S.SOCKET.TCP.INFREE
				sta SKT.Cache+S.SOCKET.TCP.INFREE+1

				ldy #S.SOCKET.SQ.hInMem
				lda (ZPPtrSKT),y

				.DO AUXPIPE=1
				>SYSCALL2 GetStkObjPtr
				.ELSE
				>SYSCALL2 GetMemPtr
				.FIN

				sty ZPTmpPtr1

*				clc
				adc SKT.Cache+S.SOCKET.TCP.INHEAD+1
				sta ZPTmpPtr1+1

				jsr SKT.GetNotDataInLen
				pha
				ldy SKT.Cache+S.SOCKET.TCP.INHEAD

.1				.DO AUXPIPE=1
				sta IO.SETWRITEAUX
				.FIN

.2				inx
				bne .3

				pla
				inc
				beq .8

				pha

.3				lda (ZPDataInPtr)
				sta (ZPTmpPtr1),y
				inc ZPDataInPtr
				bne .4

				inc ZPDataInPtr+1

.4				iny
				bne .2

				.DO AUXPIPE=1
				sta IO.CLRWRITEAUX
				.FIN

				inc ZPTmpPtr1+1
				inc SKT.Cache+S.SOCKET.TCP.INHEAD+1
				lda SKT.Cache+S.SOCKET.TCP.INHEAD+1
				cmp /K.TCP.WSIZE
				bne .1

				stz SKT.Cache+S.SOCKET.TCP.INHEAD+1
				lda ZPTmpPtr1+1
*				sec
				sbc /K.TCP.WSIZE
				sta ZPTmpPtr1+1
				bra .1

.9				sec
				rts

.8				.DO AUXPIPE=1
				sta IO.CLRWRITEAUX
				.FIN
				sty SKT.Cache+S.SOCKET.TCP.INHEAD

*				>ADC16 SKT.Cache+S.SOCKET.TCP.INUSED,ZPDataInLen
				ldx #S.SOCKET.TCP.INUSED
				jsr SKT.AddDataInLenAtSktX

				clc
				rts
*/--------------------------------------
* # Write (STREAM)
* ## C
* `int skt.write(hFD fd, const void *buf, int count);`
* ## ASM
* `>PUSHB fd`
* `>PUSHW buf`
* `>PUSHW count`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.write`
* ## RETURN VALUE
* CC: Y,A = bytes written
* CS: A = EC
*\--------------------------------------
SKT.Write		jsr SKT.PullhFDDataInPtrLen

				jsr SKT.CheckStream
				bcs .99

				jsr SKT.GetTCB

				ldx SKT.Cache+S.SOCKET.TCP.OUTFREE
				cpx ZPDataInLen
				lda SKT.Cache+S.SOCKET.TCP.OUTFREE+1
				sbc ZPDataInLen+1
				bcs SKT.AddDataToSktOut

				lda #E.NODATA			Not enough room in Q,no data transfered
				sec
.99				rts
*--------------------------------------
* Src : ZPDataInPtr/ZPDataInLen
* Dst : hOutMem/OUTHEAD
*--------------------------------------
SKT.AddDataToSktOut
				ldy #S.SOCKET.SQ.hOutMem
				lda (ZPPtrSKT),y

				.DO AUXPIPE=1
				>SYSCALL2 GetStkObjPtr
				.ELSE
				>SYSCALL2 GetMemPtr
				.FIN

				sty ZPTmpPtr1

*				clc

				adc SKT.Cache+S.SOCKET.TCP.OUTHEAD+1
				sta ZPTmpPtr1+1

				ldy SKT.Cache+S.SOCKET.TCP.OUTHEAD

				jsr SKT.GetNotDataInLen
				pha
				
.1				.DO AUXPIPE=1
				sta IO.SETWRITEAUX
				.FIN

.2				inx
				bne .3

				pla
				inc
				beq .8

				pha

.3				lda (ZPDataInPtr)
				sta (ZPTmpPtr1),y

				inc ZPDataInPtr
				bne .4

				inc ZPDataInPtr+1

.4				iny
				bne .2

				inc ZPTmpPtr1+1
				.DO AUXPIPE=1
				sta IO.CLRWRITEAUX
				.FIN
				inc SKT.Cache+S.SOCKET.TCP.OUTHEAD+1
				lda SKT.Cache+S.SOCKET.TCP.OUTHEAD+1
				cmp /K.TCP.WSIZE
				bne .1

				stz SKT.Cache+S.SOCKET.TCP.OUTHEAD+1

				lda ZPTmpPtr1+1
*				sec
				sbc /K.TCP.WSIZE
				sta ZPTmpPtr1+1
				bra .1

.8				.DO AUXPIPE=1
				sta IO.CLRWRITEAUX
				.FIN
				sty SKT.Cache+S.SOCKET.TCP.OUTHEAD

*				>SBC16 SKT.Cache+S.SOCKET.TCP.OUTFREE,ZPDataInLen
				ldx #S.SOCKET.TCP.OUTFREE
				jsr SKT.SubDataInLenAtSktX

*				>ADC16 SKT.Cache+S.SOCKET.TCP.OUTUSED,ZPDataInLen
				ldx #S.SOCKET.TCP.OUTUSED
				jsr SKT.AddDataInLenAtSktX

*				>ADC16 SKT.Cache+S.SOCKET.TCP.OUTTOSEND,ZPDataInLen
				ldx #S.SOCKET.TCP.OUTTOSEND
				jsr SKT.AddDataInLenAtSktX

				jsr SKT.StoreTCB

				>LDYA ZPDataInLen
				clc
				rts
*--------------------------------------
SKT.AddDataInLenAtSktX
				clc
				lda SKT.Cache,x
				adc ZPDataInLen
				sta SKT.Cache,x
				inx
				lda SKT.Cache,x
				adc ZPDataInLen+1
				sta SKT.Cache,x
				rts
*--------------------------------------
SKT.SubDataInLenAtSktX
				sec
				lda SKT.Cache,x
				sbc ZPDataInLen
				sta SKT.Cache,x
				inx
				lda SKT.Cache,x
				sbc ZPDataInLen+1
				sta SKT.Cache,x
				rts
*--------------------------------------
* From TCP.OUT
* Src : hOutMem/OUTTAIL
* Dst : ZPDataOutPtr/ZPDataOutLen
*--------------------------------------
SKT.GetDataFromSktOut
				ldy #S.SOCKET.SQ.hOutMem
				lda (ZPPtrSKT),y

				.DO AUXPIPE=1
				>SYSCALL2 GetStkObjPtr
				.ELSE
				>SYSCALL2 GetMemPtr
				.FIN

				sty ZPTmpPtr1

*				clc
				adc SKT.Cache+S.SOCKET.TCP.OUTTAILSENT+1
				sta ZPTmpPtr1+1
				lda ZPDataOutLen
				eor #$FF
				tax

				lda ZPDataOutLen+1
				eor #$FF
				pha

				.DO AUXPIPE=1
				jsr SKT.SetupZPCode
				.FIN

				ldy SKT.Cache+S.SOCKET.TCP.OUTTAILSENT

.1				inx
				bne .2

				pla
				inc
				beq .8

				pha

.2				.DO AUXPIPE=1
				jsr ZPCode
				.ELSE
				lda (ZPTmpPtr1),y
				.FIN
				sta (ZPDataOutPtr)
				inc ZPDataOutPtr
				bne .3

				inc ZPDataOutPtr+1

.3				iny
				bne .1

				inc ZPTmpPtr1+1
				inc SKT.Cache+S.SOCKET.TCP.OUTTAILSENT+1
				lda SKT.Cache+S.SOCKET.TCP.OUTTAILSENT+1
				cmp /K.TCP.WSIZE
				bne .1

				stz SKT.Cache+S.SOCKET.TCP.OUTTAILSENT+1

				lda ZPTmpPtr1+1
*				sec
				sbc /K.TCP.WSIZE
				sta ZPTmpPtr1+1
				bra .1

.8				sty SKT.Cache+S.SOCKET.TCP.OUTTAILSENT

				>SBC16 SKT.Cache+S.SOCKET.TCP.OUTTOSEND,ZPDataOutLen

				clc
				rts
*/--------------------------------------
* # RecvFrom (RAW,DGRAM)
* ## C
* `hMem recvfrom(hFD fd, struct sockaddr *addr);`
* ## ASM
* `>PUSHB fd`
* `>PUSHW addr`		(RecvFrom)
* `>LIBCALL hLIBTCPIP,LIBTCPIP.Recv`
* ## RETURN VALUE
* CC: A = hMem
* CS: A = EC
*\--------------------------------------
SKT.RecvFrom	>PULLW ZPTmpPtr1		addr
				>PULLA
				sec
				.HS 90					BCC
*/--------------------------------------
* # Recv (RAW,DGRAM,SEQPKT)
* ## C
* `hMem recv(hFD fd);`
* ## ASM
* `lda fd`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.Recv`
* ## RETURN VALUE
* CC: A = hMem
* CS: A = EC
*\--------------------------------------
SKT.Recv		clc
				php
				jsr SKT.GetFD

				ldy #S.SOCKET.T
				lda (ZPPtrSKT),y
				cmp #S.SOCKET.T.SEQPKT
				bcc .10					RAW,DGRAM

				bne .98					STREAM

				jsr SKT.GetFromQueue	SEQPKT
				bcs .1

				pha
				>SYSCALL2 GetMemPtr
				>STYA ZPFrameInPtr

				jsr TCP.IN.SetDataInPtrAndLen

				jsr SKT.GetTCB

				lda ZPDataInLen
				ldy ZPDataInLen+1
				ldx #S.SOCKET.TCP.INACKNUM
				jsr TCP.AddAYToSktCacheAtX

				jsr SKT.StoreTCB
				
				lda #S.TCP.OPTIONS.ACK
*				jsr TCP.OUT.SendOptA
				jsr TCP.SetSocketTCPO
				
				pla
				plp
				clc
				rts

.1				jsr SKT.CheckTCP
				bcs .91

.90				lda #E.NODATA
.91				plp
				sec
				rts

.98				plp
.99				lda #ERR.SKT.BAD
				sec
				rts
*--------------------------------------
.10				jsr SKT.GetFromQueue
				bcs .90

				plp						if CS, RecvFrom
				bcc .9					CC, Recv : Exit with CC and A=hFrame

				pha
				>SYSCALL2 GetMemPtr
				>STYA ZPFrameInPtr

				ldy #S.IP.SRC

.2				lda (ZPFrameInPtr),y
				sta SA.REMOTE+S.SOCKADDR.ADDR-S.IP.SRC,y
				iny
				cpy #S.IP.SRC+4
				bne .2

				ldy #S.IP.PROTOCOL
				lda (ZPFrameInPtr),y
				cmp #S.IP.PROTOCOL.ICMP
				bne .3

				ldy #S.ICMP.IDENTIFIER
				bra .7

.3				cmp #S.IP.PROTOCOL.TCP
				beq .6

				cmp #S.IP.PROTOCOL.UDP
				bne .8

.6				ldy #S.TCPUDP.SRCPORT

.7				lda (ZPFrameInPtr),y
				sta SA.REMOTE+S.SOCKADDR+1
				iny
				lda (ZPFrameInPtr),y
				sta SA.REMOTE+S.SOCKADDR

.8				ldy #S.SOCKADDR-1

.80				lda SA.REMOTE,y
				sta (ZPTmpPtr1),y
				dey
				bpl .80

				pla
				clc
.9				rts
*/--------------------------------------
* # SendTo (RAW,DGRAM,SEQPKT)
* ## C
* `int skt.sendto(hFD fd, const void *buf, int count, const struct sockaddr *addr);`
* ## ASM
* `>PUSHB fd`
* `>PUSHW buf`
* `>PUSHWI count`
* `>PUSHW addr`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.sendto`
* ## RETURN VALUE
* CC: Y,A = bytes written
* CS: A = EC
*\--------------------------------------
SKT.SendTo		jsr SKT.PullRemAddr
*/--------------------------------------
* # Send (RAW,DGRAM,SEQPKT)
* ## C
* `int skt.send(hFD fd, const void *buf, int count);`
* ## ASM
* `>PUSHB fd`
* `>PUSHW buf`
* `>PUSHWI count`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.send`
* ## RETURN VALUE
* CC: Y,A = bytes written
* CS: A = EC
*\--------------------------------------
SKT.Send		jsr SKT.PullhFDDataInPtrLen

				ldy #S.SOCKET.T
				lda (ZPPtrSKT),y
				cmp #S.SOCKET.T.STREAM
			bcs *	
				tax
				jmp (J.SKT.send,x)
*--------------------------------------
SKT.Send.RAW	ldy #S.SOCKET.PROTO
				lda (ZPPtrSKT),y
				tax
				>LDYA ZPDataInLen
				jsr FRM.NewIP
				bcc SKT.Send.8

				rts
*--------------------------------------
SKT.Send.DGRAM	ldx #S.IP.PROTOCOL.UDP
				>LDYA ZPDataInLen
				jsr FRM.NewIP
				bcs SKT.Send.9

				jsr SKT.SetFrameOutTCPUDPPorts

SKT.Send.8		jsr SKT.SetFrameOutDstIP
				jsr SKT.CopyDataInToOut
				clc						Queue if fail
				jmp FRM.SendIP
*--------------------------------------
SKT.Send.SEQPKT	jsr SKT.CheckTCP
				bcs SKT.Send.9

				>LDYA ZPDataInLen
				jsr TCP.NewFrame
				bcs SKT.Send.9

				jsr SKT.GetTCB

				jsr SKT.CopyDataInToOut

				jmp TCP.OUT.SEQSEND
*--------------------------------------
SKT.Send.STREAM	lda #ERR.SKT.BAD
				sec
SKT.Send.9		rts
*/--------------------------------------
* # GetSockOpt
* Set Socket Options
* ## C
* `int getsockopt(hFD fd);`
* ## ASM
* `lda fd`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.GetSockOpt`
* ## RETURN VALUE
*\--------------------------------------
SKT.getsockopt	jsr SKT.GetFD
				ldy #S.SOCKET.O
				lda (ZPPtrSKT),y
*				clc
				rts
*/--------------------------------------
* # SetSockOpt
* Set Socket Options
* ## C
* `int setsockopt(hFD fd, short int opts);`
* ## ASM
* `>PUSHB fd`
* `>PUSHB opts`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.SetSockOpt`
* ## RETURN VALUE
*\--------------------------------------
SKT.setsockopt	>PULLA
				pha

				jsr SKT.PullhFD

				pla
				ldy #S.SOCKET.O
				sta (ZPPtrSKT),y
*				clc
				rts
*/--------------------------------------
* # EOF
* End Of File
* ## C
* `int eof(hFD fd);`
* ## ASM
* `lda fd`
* `>LIBCALL hLIBTCPIP,LIBTCPIP.EOF`
* ## RETURN VALUE
* CC : A = 0 if some data, A = $ff if EOF
* CS : A = Socket Error
*\--------------------------------------
SKT.EOF			jsr SKT.GetFD

				ldy #S.SOCKET.TCP.INUSED
				lda (ZPPtrSKT),y
				iny
				ora (ZPPtrSKT),y
				bne .8					some DATA...

				jsr SKT.CheckStream
				bcs .9

				lda #$ff				no DATA, EOF = true
*				clc
				rts

.8				lda #0					...EOF = false

*				clc
.9				rts
*--------------------------------------
SKT.CheckStream	lda #S.SOCKET.T.STREAM

				ldy #S.SOCKET.T
				cmp (ZPPtrSKT),y
				bne SKT.BAD

SKT.CheckTCP	ldy #S.SOCKET.O
				lda (ZPPtrSKT),y
				and #S.SOCKET.O.ACCEPTCONN
				bne SKT.BAD

				ldy #S.SOCKET.TCP.S
				lda (ZPPtrSKT),y
				cmp #S.SOCKET.TCP.S.ESTBLSH
				beq .8

				bcc .9

				lda #MLI.E.IO
*				sec
				rts

.8				lda #0
				clc
				rts

.9				lda #ERR.SKT.NOCONN
				sec
				rts

SKT.BAD			lda #ERR.SKT.BAD
				sec
				rts
*--------------------------------------
SKT.PullhFDDataInPtrLen
				>PULLW ZPDataInLen		!!!use DataInPtr/Len
				>PULLW ZPDataInPtr		!!!DataOut trashed when sending ACK in TCP.OUT

SKT.PullhFD		>PULLA

SKT.GetFD		tax
				lda FDs.pHI-1,x
				ldy FDs.pLO-1,x

				>STYA ZPPtrSKT
				rts
*--------------------------------------
SKT.PullLocAddr	clc
				.HS B0					BCS
*--------------------------------------
SKT.PullRemAddr	sec
				>PULLW ZPTmpPtr1
				ldy #S.SOCKADDR-1

				ldx #S.SOCKADDR-1
				bcc .1

				ldx #S.SOCKADDR+S.SOCKADDR-1

.1				lda (ZPTmpPtr1),y
				sta SKT.LOC.ADDR,x
				dex
				dey
				bpl .1

				rts
*--------------------------------------
SKT.SetLocAddr	ldy #S.SOCKET.LOC.PORT+1

.1				lda SKT.LOC.ADDR+S.SOCKADDR.ADDR-S.SOCKET.LOC.ADDR,y
				sta (ZPPtrSKT),y
				dey
				cpy #S.SOCKET.LOC.ADDR
				bcs .1

				rts
*--------------------------------------
SKT.SetRemAddr	ldy #S.SOCKET.REM.PORT+1

.1				lda SKT.REM.ADDR+S.SOCKADDR.ADDR-S.SOCKET.REM.ADDR,y
				sta (ZPPtrSKT),y
				dey
				cpy #S.SOCKET.REM.ADDR
				bcs .1

				rts
*--------------------------------------
*  SKT.REM.ADDR = Incoming Frame SRC
*  SKT.LOC.ADDR = Incoming Frame DST
*--------------------------------------
SKT.FindMatchingLocRem
				ldx #1

.1				lda FDs.pHI-1,x
				beq .8

				ldy FDs.pLO-1,x

				>STYA ZPPtrSKT

				ldy #S.SOCKET.AF
				lda (ZPPtrSKT),y
				cmp #AF.INET
				bne .8

				ldy #S.SOCKET.PROTO
				lda (ZPPtrSKT),y

				ldy #S.IP.PROTOCOL
				cmp (ZPFrameInPtr),y
				bne .8

				ldy #S.SOCKET.LOC.ADDR

.2				lda (ZPPtrSKT),y
				bne .4

				ldy #S.SOCKET.LOC.PORT	bound to 0.0.0.0,check only LOC port

.3				lda (ZPPtrSKT),y

.4				cmp SKT.LOC.ADDR+S.SOCKADDR.ADDR-S.SOCKET.LOC.ADDR,y
				bne .8

				iny
				cpy #S.SOCKET.LOC.PORT+2
				bne .3

				ldy #S.SOCKET.O
				lda (ZPPtrSKT),y
				and #S.SOCKET.O.ACCEPTCONN
				beq .6

				ldy #S.TCP.OPTIONS		Listening, only SYN packet....
				lda (ZPFrameInPtr),y
				cmp #S.TCP.OPTIONS.SYN
				beq .7					SYN received on a LISTEN socket, ok

				bne .8					bad packet for this listening

.6				lda SKT.REM.ADDR+S.SOCKADDR.ADDR
				cmp #$ff				incoming frame is FF.FF.FF.FF, Broadcast ?
				bne .41

*				ldy #S.SOCKET.O
				lda (ZPPtrSKT),y
				and #S.SOCKET.O.BROADCAST
				bne .43
*				sec
				rts						this socket does not accept broadcast

.41				ldy #S.SOCKET.REM.ADDR

				lda (ZPPtrSKT),y
				bne .44

.43				ldy #S.SOCKET.REM.PORT	Frame is Broadcast, or listening is 0.0.0.0 check port only

.42				lda (ZPPtrSKT),y

.44				cmp SKT.REM.ADDR+S.SOCKADDR.ADDR-S.SOCKET.REM.ADDR,y
				bne .8					wrong remote host, exit....

				iny
				cpy #S.SOCKET.REM.PORT+2
				bne .42

.7				clc						x = hFD
				rts

.8				inx
				cpx #K.FD.MAX+1
				bcc .1

*				sec
				rts
*--------------------------------------
SKT.AddToQueueA pha
				ldy #S.SOCKET.HQ.HEAD
				lda (ZPPtrSKT),y
				tax
				inc
				cmp #S.SOCKET.HQ.MAX
				bne .1

				lda #0

.1				dey						#S.SOCKET.HQ.TAIL
				cmp (ZPPtrSKT),y
				beq .9					Queue full!!

				iny						#S.SOCKET.HQ.HEAD
				sta (ZPPtrSKT),y
				txa
				clc
				adc #S.SOCKET.HQ
				tay

				pla
				sta (ZPPtrSKT),y
				clc
				rts

.9				pla						dicard hFrame
*				sec
				rts
*--------------------------------------
SKT.NewTCB		ldx #S.SOCKET.TCP.INSEQNUM

.1				stz SKT.Cache,x
				inx
				cpx #S.SOCKET.TCP
				bne .1

				ldx #3

.2				lda A2osX.T16,x
				sta SKT.Cache+S.SOCKET.TCP.OUTNEXTSEQ,x
				dex
				bpl .2

				ldy #S.SOCKET.T
				lda (ZPPtrSKT),y
				cmp #S.SOCKET.T.SEQPKT
				bcc .8

				tax

				>LDYAI K.TCP.WSIZE
				>STYA SKT.Cache+S.SOCKET.TCP.INFREE

				cpx #S.SOCKET.T.STREAM
				bcc .8

				.DO AUXPIPE=1
				>SYSCALL2 NewStkObj
				.ELSE
				>SYSCALL2 getmem
				.FIN
				bcs .9

				txa
				ldy #S.SOCKET.SQ.hInMem
				sta (ZPPtrSKT),y

				>LDYAI K.TCP.WSIZE
				>STYA SKT.Cache+S.SOCKET.TCP.OUTFREE

				.DO AUXPIPE=1
				>SYSCALL2 NewStkObj
				.ELSE
				>SYSCALL2 getmem
				.FIN
				bcs .9

				txa
				ldy #S.SOCKET.SQ.hOutMem
				sta (ZPPtrSKT),y
.8
*				clc
.9				rts
*--------------------------------------
SKT.GetTCB	 	ldy #S.SOCKET.TCP.INSEQNUM

.1				lda (ZPPtrSKT),y
				sta SKT.Cache,y
				iny
				cpy #S.SOCKET.TCP
				bne .1

				rts
*--------------------------------------
SKT.StoreTCB.S	ldy #S.SOCKET.TCP.S
				sta (ZPPtrSKT),y

SKT.StoreTCB 	ldy #S.SOCKET.TCP.INSEQNUM

.1				lda SKT.Cache,y
				sta (ZPPtrSKT),y
				iny
				cpy #S.SOCKET.TCP
				bne .1

				clc
				rts
*--------------------------------------
SKT.SetFrameOutDstIP
				ldx #3

				ldy #S.SOCKET.REM.ADDR
				lda (ZPPtrSKT),y
				beq .3					Socket Bound to 0.0.0.0...

.1				lda (ZPPtrSKT),y
				pha
				iny
				dex
				bpl .1

				ldy #S.IP.DST+3
				ldx #3

.2				pla
				sta (ZPFrameOutPtr),y
				dey
				dex
				bpl .2

				rts
.3				ldy #S.IP.DST+3			...sent to provided SentTo ADDR

.4				lda SKT.REM.ADDR+S.SOCKADDR.ADDR,x
				sta (ZPFrameOutPtr),y
				dey
				dex
				bpl .4

				rts
*--------------------------------------
SKT.SetFrameOutTCPUDPPorts
				ldy #S.SOCKET.LOC.PORT
				lda (ZPPtrSKT),y
				tax
				iny
				lda (ZPPtrSKT),y
 				ldy #S.TCPUDP.SRCPORT
				sta (ZPFrameOutPtr),y
				iny
				txa
				sta (ZPFrameOutPtr),y

				ldy #S.SOCKET.REM.PORT
				lda (ZPPtrSKT),y
				beq .1

				tax
				iny
				lda (ZPPtrSKT),y
				bra .2

.1				lda SKT.REM.ADDR+S.SOCKADDR.PORT+1
				ldx SKT.REM.ADDR+S.SOCKADDR.PORT

.2 				ldy #S.TCPUDP.DSTPORT
				sta (ZPFrameOutPtr),y
				iny
				txa
				sta (ZPFrameOutPtr),y

				rts
*--------------------------------------
SKT.GetNotDataInLen
				lda ZPDataInLen
				eor #$FF
				tax

				lda ZPDataInLen+1
				eor #$FF
				rts
*--------------------------------------
SKT.CopyDataInToOut
				lda ZPDataInPtr+1
				pha
				lda ZPDataOutPtr+1
				pha

				jsr SKT.GetNotDataInLen
				pha
				ldy #0

.1				inx
				bne .2

				pla
				inc
				beq .9

				pha

.2				lda (ZPDataInPtr),y
				sta (ZPDataOutPtr),y
				iny
				bne .1

				inc ZPDataInPtr+1
				inc ZPDataOutPtr+1
				bne .1

.9				pla
				sta ZPDataOutPtr+1
				pla
				sta ZPDataInPtr+1
				rts
*--------------------------------------
				.DO AUXPIPE=1
SKT.SetupZPCode	ldy #ZP.CODE.Len-1

.1				lda ZP.CODE,y
				sta ZPCode,y
				dey
				bpl .1

				rts
				.FIN
*--------------------------------------
MAN
SAVE usr/src/lib/libtcpip.s.skt
LOAD usr/src/lib/libtcpip.s
ASM