testutil.68k

用于motorala 68K系列处理器的小实时多任务操作系统 The OMU Kernel was written to provide a cut-down Unix-like O/S for a

******************************************************************************
*	Miscalainious routines
******************************************************************************
*

	globl	_getstack, _getst,	_setsr
	globl	_spl7,	_spl6,	_spl5,	_spl4,	_spl3,	_spl2
	globl	_spl1,	_spl0,	_splx

_getstack:
	move.l a7,d0
	rts

_getsr:
	move.w sr,d0		;Gets status information
	rts

_setsr:
	move.w 6(a7),sr		;Sets status register
	rts

*
*	Sets interupt levels	returns present status register
*				for use with splx.

_spl7:				;Sets NMI
	move.w sr,d0
	move.w #$2700,sr
	rts

_spl6:				;Sets NMI as well
	move.w sr,d0
	move.w #$2600,sr
	rts

_spl5:
	move.w sr,d0
	move.w #$2500,sr
	rts

_spl4:
	move.w sr,d0
	move.w #$2400,sr
	rts

_spl3:
	move.w sr,d0
	move.w #$2300,sr
	rts

_spl2:
	move.w sr,d0
	move.w #$2200,sr
	rts

_spl1:
	move.w sr,d0
	move.w #$2100,sr
	rts

_spl0:
	move.w sr,d0
	move.w #$2000,sr
	rts

_splx:				;Returns to interupt level given
	move.l 4(a7),d0
	ori.l #$2000,d0
	move.w d0,sr
	rts


*################ CPM-68k ################
*bytecp.s
*+++++++++++++++++++++++++++++++++++++++++


* modified for max speed (copies longs words or bytes)
* arguments <from address><to address><bytes>
* Codata C link system

	globl _bytecp, _byteclr

	text

_bytecp:

	link a6,#0			;Save sp and registers
	movem.l d6-d7/a4-a5,-(sp)
	move.l 16(a6),d7		;Gets length in bytes
	movea.l 8(a6),a5		;Gets from address
	movea.l 12(a6),a4		;Gets to address

	cmpi.l #0,d7			;Checks if length is 0
	beq endcp
	move.w a5,d6			;Checks if either address is odd
	move.w a4,d0
	or.b d0,d6			;Or number of bytes is odd
	or.b d7,d6
	andi.b #1,d6
	bne chars			;If so then do character copy

	clr.l d0			;Sets d0 to indicate word copy
	move.b d7,d6			;Checks if length not in longs
	andi.b #2,d6
	beq long
	addq.l #1,d0			;If not set d0 to flag word

long:
	asr.l #2,d7			;Number of longs

* 1 is subtracted from length to change the loop to a db loop where
* nloops == len -1

	subq.l #1,d7
	blt oneword			;Special case one word only
	move.w d7,d6			;Moves lower half of length into d6
	swap d7				;Sets d7 to top half of length
loopl:
	move.l (a5)+,(a4)+		;Transfers data;
	dbf d6,loopl			;Inner loop
	move.w #$FFFF,d6		;Sets d6 for 64k loops
	dbf d7,loopl			;Outer loop

	andi.b #1,d0
	beq endcp

oneword:
	move.w (a5)+,(a4)+		;Writes last word in word copy

endcp:
	movem.l (sp)+,d6-d7/a4-a5	;Recovers registers
	unlk a6
	rts

chars:
	subq.l #1,d7			;Decrements d7 for dbra type loops
	move.w d7,d6			;Moves lower half of length into d6
	swap d7				;Sets d7 to top half of length
loopc:
	move.b (a5)+,(a4)+		;Transfers data;
	dbf d6,loopc			;Inner loop
	move.w #$FFFF,d6		;Sets d6 for 64k loops
	dbf d7,loopc			;Outer loop

	bra endcp

*
*	Byteclr clears an area of memory
*	Interface from C  byteclr(<address><nobytes>)
*
	
_byteclr:

	link a6,#0			;Save sp and registers
	movem.l d6-d7/a5,-(sp)
	movea.l 8(a6),a5		;Gets from address
	move.l 12(a6),d7		;Gets length in bytes

	cmpi.l #0,d7			;Checks if length is 0
	beq endclr
	move.w a5,d6			;Checks if either address is odd
	or.b d7,d6			;Or number of bytes is odd
	andi.b #1,d6
	bne charclr			;If so then do character copy

	clr.l d0			;Sets d0 to indicate word copy
	move.b d7,d6			;Checks if length not in longs
	andi.b #2,d6
	beq longclr
	addq.l #1,d0			;If not set d0 to flag word

longclr:
	asr.l #2,d7			;Number of longs

* 1 is subtracted from length to change the loop to a db loop where
* nloops == len -1

	subq.l #1,d7
	blt onewordclr			;Special case one word only
	move.w d7,d6			;Moves lower half of length into d6
	swap d7				;Sets d7 to top half of length
looplclr:
	clr.l (a5)+			;Clears area
	dbf d6,looplclr			;Inner loop
	move.w #$FFFF,d6		;Sets d6 for 64k loops
	dbf d7,looplclr			;Outer loop

	andi.b #1,d0
	beq endclr

onewordclr:
	clr.w (a5)+			;Writes last word in word copy

endclr:
	movem.l (sp)+,d6-d7/a5		;Recovers registers
	unlk a6
	rts

charclr:
	subq.l #1,d7			;Decrements d7 for dbra type loops
	move.w d7,d6			;Moves lower half of length into d6
	swap d7				;Sets d7 to top half of length
loopcclr:
	clr.b (a5)+			;Transfers data;
	dbf d6,loopcclr			;Inner loop
	move.w #$FFFF,d6		;Sets d6 for 64k loops
	dbf d7,loopcclr			;Outer loop

	bra endclr

	
	data