Kernel 0.93

DRV/UTHERNET.DRV.S.txt

@@ -472,40 +472,34 @@ WRITE			php
 				ldy #S.IOCTL.BYTECNT+1
 				lda (ZPIOCTL),y
 				sta TxLength+1,x
-				eor #$ff
-				sta Counter+1
+				lsr
+				pha
 
 				dey
 				lda (ZPIOCTL),y
 				sta TxLength,x
+				ror
+				adc #0
 				eor #$ff
 				sta Counter
+
+				pla
+				adc #0
+				eor #$ff
+				sta Counter+1
+
 				
 				lda /PP.BusST		
 				sta PacketPagePTR+1,x
 				lda #PP.BusST		
 				sta PacketPagePTR,x
 
-				ldy #16
-				
-.1				lda	PacketPageDATA+1,x
+				lda	PacketPageDATA+1,x
+				ldy	PacketPageDATA,x
 				and /PP.BusST.Rdy4TxNOW
-				bne WRITE.1
+				beq WRITE.9
 				
-				lda	PacketPageDATA,x
-				and #PP.BusST.TxBidErr
-				bne .9
-				
-				dey
-				bne	.1
-				
-.9				lda #E.NODATA
-
-				plp
-				sec
-				rts
-				
-WRITE.1			ldy #S.IOCTL.BUFPTR
+				ldy #S.IOCTL.BUFPTR
 				lda (ZPIOCTL),y
 				sta ZPBufPtr
 				iny
@@ -536,12 +530,7 @@ WRITE.1			ldy #S.IOCTL.BUFPTR
 				bne .3
 				inc ZPBufPtr+1
 				
-.3				inc Counter
-				bne .4
-				inc Counter+1
-				beq .8
-				
-.4				lda	(ZPBufPtr),y
+.3				lda	(ZPBufPtr),y
 				sta RTDATA+1,x
 				iny
 				bne .1
@@ -551,6 +540,12 @@ WRITE.1			ldy #S.IOCTL.BUFPTR
 .8				plp
 				clc
 				rts	
+				
+WRITE.9			lda #E.NODATA
+
+				plp
+				sec
+				rts
 *--------------------------------------
 DRV.CS.END
 DEVSLOTx0		.BS 1