Home | History | Annotate | Line # | Download | only in iomd
iomd_fiq.S revision 1.2.2.2
      1  1.2.2.2  thorpej /*	$NetBSD: iomd_fiq.S,v 1.2.2.2 2002/01/10 19:38:02 thorpej Exp $	*/
      2  1.2.2.2  thorpej 
      3  1.2.2.2  thorpej /*
      4  1.2.2.2  thorpej  * Copyright (c) 1994-1996 Mark Brinicombe.
      5  1.2.2.2  thorpej  * Copyright (c) 1994 Brini.
      6  1.2.2.2  thorpej  * All rights reserved.
      7  1.2.2.2  thorpej  *
      8  1.2.2.2  thorpej  * Redistribution and use in source and binary forms, with or without
      9  1.2.2.2  thorpej  * modification, are permitted provided that the following conditions
     10  1.2.2.2  thorpej  * are met:
     11  1.2.2.2  thorpej  * 1. Redistributions of source code must retain the above copyright
     12  1.2.2.2  thorpej  *    notice, this list of conditions and the following disclaimer.
     13  1.2.2.2  thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     14  1.2.2.2  thorpej  *    notice, this list of conditions and the following disclaimer in the
     15  1.2.2.2  thorpej  *    documentation and/or other materials provided with the distribution.
     16  1.2.2.2  thorpej  * 3. All advertising materials mentioning features or use of this software
     17  1.2.2.2  thorpej  *    must display the following acknowledgement:
     18  1.2.2.2  thorpej  *	This product includes software developed by Mark Brinicombe.
     19  1.2.2.2  thorpej  * 4. The name of the company nor the name of the author may be used to
     20  1.2.2.2  thorpej  *    endorse or promote products derived from this software without specific
     21  1.2.2.2  thorpej  *    prior written permission.
     22  1.2.2.2  thorpej  *
     23  1.2.2.2  thorpej  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
     24  1.2.2.2  thorpej  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     25  1.2.2.2  thorpej  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     26  1.2.2.2  thorpej  * IN NO EVENT SHALL HTE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
     27  1.2.2.2  thorpej  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     28  1.2.2.2  thorpej  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     29  1.2.2.2  thorpej  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     30  1.2.2.2  thorpej  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     31  1.2.2.2  thorpej  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     32  1.2.2.2  thorpej  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     33  1.2.2.2  thorpej  * SUCH DAMAGE.
     34  1.2.2.2  thorpej  *
     35  1.2.2.2  thorpej  * RiscBSD kernel project
     36  1.2.2.2  thorpej  *
     37  1.2.2.2  thorpej  * fiq.S
     38  1.2.2.2  thorpej  *
     39  1.2.2.2  thorpej  * Low level fiq handlers
     40  1.2.2.2  thorpej  *
     41  1.2.2.2  thorpej  * Created      : 27/09/94
     42  1.2.2.2  thorpej  */
     43  1.2.2.2  thorpej 
     44  1.2.2.2  thorpej #include <machine/asm.h>
     45  1.2.2.2  thorpej #include <machine/cpu.h>
     46  1.2.2.2  thorpej 
     47  1.2.2.2  thorpej 
     48  1.2.2.2  thorpej /*
     49  1.2.2.2  thorpej  * if NOFDFIQLOOPS is defined only 1 byte is transferred per
     50  1.2.2.2  thorpej  * FIQ. The new default behaviour is to keep looping
     51  1.2.2.2  thorpej  * until there are no FD FIQ's pending.
     52  1.2.2.2  thorpej  */
     53  1.2.2.2  thorpej 
     54  1.2.2.2  thorpej /*
     55  1.2.2.2  thorpej  * These registers needs to be consistent with fd
     56  1.2.2.2  thorpej  * driver's assignment.
     57  1.2.2.2  thorpej  *
     58  1.2.2.2  thorpej  *	r8  - scratch
     59  1.2.2.2  thorpej  *	r9  - IOMD_FIQRQ
     60  1.2.2.2  thorpej  *	r10 - transfer size
     61  1.2.2.2  thorpej  *	r11 - data address
     62  1.2.2.2  thorpej  *	r12 - floppy controller DACK address (+ 0x18000 for TC)
     63  1.2.2.2  thorpej  *	r13 - scratch (loop counter)
     64  1.2.2.2  thorpej  */
     65  1.2.2.2  thorpej 
     66  1.2.2.2  thorpej ENTRY_NP(floppy_read_fiq)
     67  1.2.2.2  thorpej 	subs	r10, r10, #0x00000001
     68  1.2.2.2  thorpej 	addeq	r12, r12, #0x00018000
     69  1.2.2.2  thorpej 	ldrb	r8, [r12]
     70  1.2.2.2  thorpej 	strb	r8, [r11], #0x0001
     71  1.2.2.2  thorpej #ifndef NOFDFIQLOOPS
     72  1.2.2.2  thorpej 	subeqs	pc, lr, #0x00000004
     73  1.2.2.2  thorpej 	ldrb	r8, [r9]
     74  1.2.2.2  thorpej 	tst	r8, #0x01
     75  1.2.2.2  thorpej 	addne	r13, r13, #0x00000001
     76  1.2.2.2  thorpej 	bne	_C_LABEL(floppy_read_fiq)
     77  1.2.2.2  thorpej #endif
     78  1.2.2.2  thorpej 	subs	pc, lr, #0x00000004
     79  1.2.2.2  thorpej 
     80  1.2.2.2  thorpej 	.global	_C_LABEL(floppy_read_fiq_end)
     81  1.2.2.2  thorpej _C_LABEL(floppy_read_fiq_end):
     82  1.2.2.2  thorpej 
     83  1.2.2.2  thorpej 
     84  1.2.2.2  thorpej /*
     85  1.2.2.2  thorpej  * These registers needs to be consistent with fd
     86  1.2.2.2  thorpej  * driver's assignment.
     87  1.2.2.2  thorpej  *
     88  1.2.2.2  thorpej  *	r8  - scratch
     89  1.2.2.2  thorpej  *	r9  - IOMD_FIQRQ
     90  1.2.2.2  thorpej  *	r10 - transfer size
     91  1.2.2.2  thorpej  *	r11 - data address
     92  1.2.2.2  thorpej  *	r12 - floppy controller DACK address (+ 0x18000 for TC)
     93  1.2.2.2  thorpej  *	r13 - scratch (loop counter)
     94  1.2.2.2  thorpej  */
     95  1.2.2.2  thorpej 
     96  1.2.2.2  thorpej ENTRY_NP(floppy_write_fiq)
     97  1.2.2.2  thorpej 	subs	r10, r10, #0x00000001
     98  1.2.2.2  thorpej 	addeq	r12, r12, #0x00018000
     99  1.2.2.2  thorpej 	ldrb	r8, [r11], #0x0001
    100  1.2.2.2  thorpej 	strb	r8, [r12]
    101  1.2.2.2  thorpej #ifndef NOFDFIQLOOPS
    102  1.2.2.2  thorpej 	subeqs	pc, lr, #0x00000004
    103  1.2.2.2  thorpej 	ldrb	r8, [r9]
    104  1.2.2.2  thorpej 	tst	r8, #0x01
    105  1.2.2.2  thorpej 	addne	r13, r13, #0x00000001
    106  1.2.2.2  thorpej 	bne	_C_LABEL(floppy_write_fiq)
    107  1.2.2.2  thorpej #endif
    108  1.2.2.2  thorpej 	subs	pc, lr, #0x00000004
    109  1.2.2.2  thorpej 
    110  1.2.2.2  thorpej 	.global	_C_LABEL(floppy_write_fiq_end)
    111  1.2.2.2  thorpej _C_LABEL(floppy_write_fiq_end):
    112