floppydma.s

arm平台上的uclinux系统全部源代码

/*
 * linux/arch/arm/lib/floppydma.S
 *
 * Copyright (C) 1995, 1996 Russell King
 */

#include <asm/assembler.h>
		.text

		.global	_floppy_fiqin_start
		.global	_floppy_fiqin_end
_floppy_fiqin_start:
		subs	r9, r9, #1
		ldrgtb	r12, [r11, #-4]
		ldrleb	r12, [r11], #0
		strb	r12, [r10], #1
		subs	pc, lr, #4
_floppy_fiqin_end:

		.global	_floppy_fiqout_start
		.global	_floppy_fiqout_end
_floppy_fiqout_start:
		subs	r9, r9, #1
		ldrgeb	r12, [r10], #1
		movlt	r12, #0
		strleb	r12, [r11], #0
		subles	pc, lr, #4
		strb	r12, [r11, #-4]
		subs	pc, lr, #4
_floppy_fiqout_end:

@ Params:
@ r0 = length
@ r1 = address
@ r2 = floppy port
@ Puts these into R9_fiq, R10_fiq, R11_fiq
		.global	_floppy_fiqsetup
_floppy_fiqsetup:
		mov	ip, sp
		stmfd	sp!, {fp, ip, lr, pc}
		sub	fp, ip, #4
		MODE(r3,ip,I_BIT|F_BIT|DEFAULT_FIQ)	@ disable FIQs, IRQs, FIQ mode
		mov	r0, r0
		mov	r9, r0
		mov	r10, r1
		mov	r11, r2
		RESTOREMODE(r3)				@ back to normal
		mov	r0, r0
		LOADREGS(ea,fp,{fp, sp, pc})

		.global	_floppy_fiqresidual
_floppy_fiqresidual:
		mov	ip, sp
		stmfd	sp!, {fp, ip, lr, pc}
		sub	fp, ip, #4
		MODE(r3,ip,I_BIT|F_BIT|DEFAULT_FIQ)	@ disable FIQs, IRQs, FIQ mode
		mov	r0, r0
		mov	r0, r9
		RESTOREMODE(r3)
		mov	r0, r0
		LOADREGS(ea,fp,{fp, sp, pc})