Subversion Repositories or1k

/*

 * arch/sh/kernel/ubc.S

 *

 * Set of management routines for the User Break Controller (UBC)

 *

 * Copyright (C) 2002 Paul Mundt

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of the GNU General Public License as published by the

 * Free Software Foundation; either version 2 of the License, or (at your

 * option) any later version.

 */

#include 

#include 

#define STBCR2          0xffc00010

ENTRY(ubc_sleep)

        mov     #0, r0

        mov.l   1f, r1          ! Zero out UBC_BBRA ..

        mov.w   r0, @r1

        mov.l   2f, r1          ! .. same for BBRB ..

        mov.w   r0, @r1

        mov.l   3f, r1          ! .. and again for BRCR.

        mov.w   r0, @r1

        mov.w   @r1, r0         ! Dummy read BRCR

        mov.l   4f, r1          ! Set MSTP5 in STBCR2

        mov.b   @r1, r0

        or      #0x01, r0

        mov.b   r0, @r1

        mov.b   @r1, r0         ! Two dummy reads ..

        mov.b   @r1, r0

        rts

        nop

ENTRY(ubc_wakeup)

        mov.l   4f, r1          ! Clear MSTP5

        mov.b   @r1, r0

        and     #0xfe, r0

        mov.b   r0, @r1

        mov.b   @r1, r0         ! Two more dummy reads ..

        mov.b   @r1, r0

        rts

        nop

1:      .long   UBC_BBRA

2:      .long   UBC_BBRB

3:      .long   UBC_BRCR

4:      .long   STBCR2