write_fifo.s

来自「实现基于ip2022的MPEG2 TS的IP组播接收」· S 代码 · 共 79 行

;void write_fifo (voids)
.section	.text
.global	_write_fifo
.func	write_fifo,_write_fifo
_write_fifo:		
	push	$80
	push	$81
	push	wreg
	clrb	xcfg,7
	mov	w,#0x0
	mov	$82,w

;	mov	w,#0xfb
;	mov	0x0026,w
	
;reload:	
;	clrb	0x0025,2
;	nop
;	mov	w,#71
;	nop
;	nop
;	mov	0x002D,w
;	inc 	$82
;	nop
;	nop
;	setb	0x0025,2
;	nop
;	nop
;	clrb	0x0025,2
	mov	w,#188
	mov	$80,w
	mov	w,#0x47				
	mov	$81,w	
	setb	0x0025,0
continue_wrt:	
;	mov	w,#0x40;;;;;;;;;;;;;;
;	mov	$81,w
	
	clrb	0x0025,2
;	setb	0x0025,2			
	mov	w,$81
	mov	0x002D,w
	nop	
	call	wait_here	
	setb	0x0025,2
;	clrb	0x0025,2
	nop
	call	wait_here
	;clrb	0x0025,2
	clrb	0x0025,0
	dec	$81
	decsz	$80
	jmp	continue_wrt



write_end:	
	setb	xcfg,7
	pop	wreg
	pop	$81
	pop	$80
	ret
	
wait_here:
	mov	w,#0x3
	mov	$83,w	
wait_here_flag:	
	nop
	decsz	$83
	jmp	wait_here_flag
	nop
	ret	
	
	
	
.endfunc