/*      $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)