hust_writefifo.s

实现基于ip2022的MPEG2 TS的IP组播接收

;void write_fifo (void)
.section	.text,"ax",@progbits
.global	_write_fifo
.func	write_fifo,_write_fifo
_write_fifo:
	push	wreg
	push	$80
	push	$81
	push	iph
	push	ipl
;	clrb	XCFG,7
	
	mov	w,#0x00
	mov	0x0026,w	;RB口输出 
	mov	0x002E,w	;rd

	mov	w,#%hi8data(_data_write)
	mov	IPH,w
	mov	w,#%lo8data(_data_write)
	mov	IPL,w
	
	mov	w,#7
	mov	$80,w
	setb	0x0025,1
	
back1:
	setb	0x0025,0
	clrb	0x0025,2
	mov	w,(ip)
	mov	0x002D,w
	nop
	nop

	setb	0x0025,2
	nop
	nop

	inc	IPL
	clrb	0x0025,0
		
	mov	w,#187
	mov	$81,w
back2:	
	clrb	0x0025,2
	mov	w,(ip)
	mov	0x002D,w
	nop
	nop

	setb	0x0025,2
	nop
	nop

	inc	IPL
	decsz	$81
	jmp	back2
	decsz	$80
	jmp	back1
	
	clrb	0x0025,1
	
;	setb	XCFG,7	
	pop	ipl
	pop	iph
	pop	$81
	pop	$80
	pop	wreg


	ret
.endfunc