sys/arch/acorn26/ioc/ioc_fiq_util.S

   1 /*      $NetBSD: ioc_fiq_util.S,v 1.1 2002/03/24 15:47:18 bjh21 Exp $   */
   2
   3 /*-
   4  * Copyright (c) 2001 Ben Harris
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  * 3. The name of the author may not be used to endorse or promote products
  16  *    derived from this software without specific prior written permission.
  17  *
  18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  19  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  20  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  21  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  22  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  23  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  24  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  25  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  26  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  27  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28  */
  29
  30 #include <machine/asm.h>
  31
  32 RCSID("$NetBSD: ioc_fiq_util.S,v 1.1 2002/03/24 15:47:18 bjh21 Exp $")
  33
  34 #include <machine/memcreg.h>
  35 #include <arch/acorn26/iobus/iocreg.h>
  36
  37 /*
  38  * fiq_downgrade should be called in FIQ mode.  It uses R12_fiq and R13_fiq
  39  * as scratch registers.  When finished, it returns from the FIQ.
  40  */
  41 ENTRY(fiq_downgrade)
  42         ldr     r12, Lioc_base
  43         ldrb    r13, [r12, #(IOC_IRQMSKA << 2)]
  44         orr     r13, r13, #(1 <<IOC_IRQ_1)
  45         strb    r13, [r12, #(IOC_IRQMSKA << 2)]
  46         mov     r13, #0
  47         strb    r13, [r12, #(IOC_FIQMSK << 2)]
  48         ldr     r12, Lfiq_want_downgrade
  49         mov     r13, #1
  50         str     r13, [r12]
  51         subs    pc, r14, #4
  52
  53 ENTRY(fiq_downgrade_dont_disable)
  54         ldr     r12, Lioc_base
  55         ldrb    r13, [r12, #(IOC_IRQMSKA << 2)]
  56         orr     r13, r13, #(1 <<IOC_IRQ_1)
  57         strb    r13, [r12, #(IOC_IRQMSKA << 2)]
  58         ldr     r12, Lfiq_want_downgrade
  59         mov     r13, #1
  60         str     r13, [r12]
  61         subs    pc, r14, #4
  62
  63
  64 Lioc_base:
  65         .word   0x03200000
  66 Lfiq_want_downgrade:
  67         .word   _C_LABEL(fiq_want_downgrade)