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 <linux/linkage.h>
#include <asm/ubc.h>

#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