/*      $NetBSD: hd6446x_subr.S,v 1.7 2008/04/28 20:23:22 martin Exp $  */

/*-
 * Copyright (c) 2002 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by UCHIYAMA Yasushi.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <sh3/asm.h>
#include <hpcsh/dev/hd6446x/hd6446xintcreg.h>

/*
 * LINTSTUB: Func: int hd6446x_intr_raise(int s)
 *      raise SR.IMASK and HD6446x ICU interrupt mask to 's'.
 *      if current SR.IMASK is greater equal 's',nothing to do.
 *      Returns previous SR.IMASK.
 */
NENTRY(hd6446x_intr_raise)
        stc     sr,     r2
        mov     #0x78,  r1
        mov     r2,     r0
        shll    r1              /* r1 = 0xf0 */
        and     r1,     r0      /* r0 = SR & 0xf0 */
        cmp/ge  r4,     r0      /* r0 >= r4 ? T = 1 */
        bt/s    1f
         not    r1,     r1      /* r1 = 0xffffff0f */
        and     r1,     r2      /* r2 = SR & ~0xf0 */
        or      r4,     r2      /* r2 = (SR & ~0xf0) | s */
        ldc     r2,     sr      /* SR = r2 */
        shlr2   r4
        shlr    r4
        mov.l   2f,     r1
        add     r4,     r1
        mov.w   @r1,    r2      /* r2 = hd6446x_imask[s >> 4] */
        mov.l   3f,     r1
        mov.w   r2,     @r1     /* Set new interrupt mask to HD6446x */
1:      rts
         nop                    /* return (SR & 0xf0) */

        .align  2
2:      .long   _C_LABEL(hd6446x_imask)
3:      .long   HD6446X_NIMR

        SET_ENTRY_SIZE(hd6446x_intr_raise)


/*
 * LINTSTUB: Func: int hd6446x_intr_resume(int s)
 *      Set SR.IMASK and HD6446x interrupt mask register to
 *      's' interrupt level. Returns previous SR.IMASK.
 */
NENTRY(hd6446x_intr_resume)
        mov     r4,     r0
        shlr2   r0
        shlr    r0
        mov.l   2f,     r1
        add     r0,     r1
        mov.w   @r1,    r2      /* r2 = hd6446x_imask[s >> 4] */
        mov.l   3f,     r1
        mov.w   r2,     @r1     /* Set new interrupt mask to HD6446x */
        stc     sr,     r0      /* r0 = SR */
        mov     #0x78,  r2
        shll    r2              /* r2 = 0x000000f0 */
        not     r2,     r1      /* r1 = 0xffffff0f */
        and     r0,     r1      /* r1 = (SR & ~0xf0) */
        or      r1,     r4      /* r4 = (SR & ~0xf0) | level */
        ldc     r4,     sr      /* Set new IMASK to SR */
        rts
         and    r2,     r0      /* return (SR & 0xf0) */

        .align  2
2:      .long   _C_LABEL(hd6446x_imask)
3:      .long   HD6446X_NIMR

        SET_ENTRY_SIZE(hd6446x_intr_resume)