hd6446x_subr.S revision 1.2.8.2
1 1.2.8.2 jdolecek /* $NetBSD: hd6446x_subr.S,v 1.2.8.2 2002/06/23 17:37:01 jdolecek Exp $ */ 2 1.2.8.2 jdolecek 3 1.2.8.2 jdolecek /*- 4 1.2.8.2 jdolecek * Copyright (c) 2002 The NetBSD Foundation, Inc. 5 1.2.8.2 jdolecek * All rights reserved. 6 1.2.8.2 jdolecek * 7 1.2.8.2 jdolecek * This code is derived from software contributed to The NetBSD Foundation 8 1.2.8.2 jdolecek * by UCHIYAMA Yasushi. 9 1.2.8.2 jdolecek * 10 1.2.8.2 jdolecek * Redistribution and use in source and binary forms, with or without 11 1.2.8.2 jdolecek * modification, are permitted provided that the following conditions 12 1.2.8.2 jdolecek * are met: 13 1.2.8.2 jdolecek * 1. Redistributions of source code must retain the above copyright 14 1.2.8.2 jdolecek * notice, this list of conditions and the following disclaimer. 15 1.2.8.2 jdolecek * 2. Redistributions in binary form must reproduce the above copyright 16 1.2.8.2 jdolecek * notice, this list of conditions and the following disclaimer in the 17 1.2.8.2 jdolecek * documentation and/or other materials provided with the distribution. 18 1.2.8.2 jdolecek * 3. All advertising materials mentioning features or use of this software 19 1.2.8.2 jdolecek * must display the following acknowledgement: 20 1.2.8.2 jdolecek * This product includes software developed by the NetBSD 21 1.2.8.2 jdolecek * Foundation, Inc. and its contributors. 22 1.2.8.2 jdolecek * 4. Neither the name of The NetBSD Foundation nor the names of its 23 1.2.8.2 jdolecek * contributors may be used to endorse or promote products derived 24 1.2.8.2 jdolecek * from this software without specific prior written permission. 25 1.2.8.2 jdolecek * 26 1.2.8.2 jdolecek * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 27 1.2.8.2 jdolecek * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 1.2.8.2 jdolecek * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 1.2.8.2 jdolecek * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 30 1.2.8.2 jdolecek * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 1.2.8.2 jdolecek * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 1.2.8.2 jdolecek * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 1.2.8.2 jdolecek * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 1.2.8.2 jdolecek * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 1.2.8.2 jdolecek * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 1.2.8.2 jdolecek * POSSIBILITY OF SUCH DAMAGE. 37 1.2.8.2 jdolecek */ 38 1.2.8.2 jdolecek 39 1.2.8.2 jdolecek #include <sh3/asm.h> 40 1.2.8.2 jdolecek #include <sh3/locore.h> 41 1.2.8.2 jdolecek #include <hpcsh/dev/hd6446x/hd6446xintcreg.h> 42 1.2.8.2 jdolecek 43 1.2.8.2 jdolecek /* 44 1.2.8.2 jdolecek * int hd6446x_intr_raise(int s): 45 1.2.8.2 jdolecek * raise SR.IMASK and HD6446x ICU interrupt mask to 's'. 46 1.2.8.2 jdolecek * if current SR.IMASK is greater equal 's',nothing to do. 47 1.2.8.2 jdolecek * Returns previous SR.IMASK. 48 1.2.8.2 jdolecek */ 49 1.2.8.2 jdolecek NENTRY(hd6446x_intr_raise) 50 1.2.8.2 jdolecek stc sr, r2 51 1.2.8.2 jdolecek mov #0x78, r1 52 1.2.8.2 jdolecek mov r2, r0 53 1.2.8.2 jdolecek shll r1 /* r1 = 0xf0 */ 54 1.2.8.2 jdolecek and r1, r0 /* r0 = SR & 0xf0 */ 55 1.2.8.2 jdolecek cmp/ge r4, r0 /* r0 >= r4 ? T = 1 */ 56 1.2.8.2 jdolecek bt/s 1f 57 1.2.8.2 jdolecek not r1, r1 /* r1 = 0xffffff0f */ 58 1.2.8.2 jdolecek and r1, r2 /* r2 = SR & ~0xf0 */ 59 1.2.8.2 jdolecek mov r4, r1 60 1.2.8.2 jdolecek or r2, r1 /* r1 = (SR & ~0xf0) | s */ 61 1.2.8.2 jdolecek ldc r1, sr /* SR = r1 */ 62 1.2.8.2 jdolecek shlr2 r4 63 1.2.8.2 jdolecek shlr r4 64 1.2.8.2 jdolecek mov.l 2f, r1 65 1.2.8.2 jdolecek add r4, r1 66 1.2.8.2 jdolecek mov.w @r1, r2 /* r2 = hd6446x_imask[s >> 4] */ 67 1.2.8.2 jdolecek mov.l 3f, r1 68 1.2.8.2 jdolecek mov.w r2, @r1 /* Set new interrupt mask to HD6446x */ 69 1.2.8.2 jdolecek 1: rts 70 1.2.8.2 jdolecek nop /* return (SR & 0xf0) */ 71 1.2.8.2 jdolecek .align 2 72 1.2.8.2 jdolecek 2: .long _C_LABEL(hd6446x_imask) 73 1.2.8.2 jdolecek 3: .long HD6446X_NIMR 74 1.2.8.2 jdolecek 75 1.2.8.2 jdolecek /* 76 1.2.8.2 jdolecek * int hd6446x_intr_resume(int s): 77 1.2.8.2 jdolecek * Set SR.IMASK and HD6446x interrupt mask register to 78 1.2.8.2 jdolecek * 's' interrupt level. Returns previous SR.IMASK. 79 1.2.8.2 jdolecek */ 80 1.2.8.2 jdolecek NENTRY(hd6446x_intr_resume) 81 1.2.8.2 jdolecek mov r4, r0 82 1.2.8.2 jdolecek shlr2 r0 83 1.2.8.2 jdolecek shlr r0 84 1.2.8.2 jdolecek mov.l 2f, r1 85 1.2.8.2 jdolecek add r0, r1 86 1.2.8.2 jdolecek mov.w @r1, r2 /* r2 = hd6446x_imask[s >> 4] */ 87 1.2.8.2 jdolecek mov.l 3f, r1 88 1.2.8.2 jdolecek mov.w r2, @r1 /* Set new interrupt mask to HD6446x */ 89 1.2.8.2 jdolecek stc sr, r0 /* r0 = SR */ 90 1.2.8.2 jdolecek mov #0x78, r2 91 1.2.8.2 jdolecek shll r2 /* r2 = 0x000000f0 */ 92 1.2.8.2 jdolecek not r2, r1 /* r1 = 0xffffff0f */ 93 1.2.8.2 jdolecek and r0, r1 /* r1 = (SR & ~0xf0) */ 94 1.2.8.2 jdolecek or r1, r4 /* r4 = (SR & ~0xf0) | level */ 95 1.2.8.2 jdolecek ldc r4, sr /* Set new IMASK to SR */ 96 1.2.8.2 jdolecek rts 97 1.2.8.2 jdolecek and r2, r0 /* return (SR & 0xf0) */ 98 1.2.8.2 jdolecek .align 2 99 1.2.8.2 jdolecek 2: .long _C_LABEL(hd6446x_imask) 100 1.2.8.2 jdolecek 3: .long HD6446X_NIMR 101
Indexes created Thu Oct 02 07:10:07 GMT 2025