2005-04-17 06:20:36 +08:00
|
|
|
/*
|
2006-10-04 05:01:26 +08:00
|
|
|
* arch/sh/kernel/cpu/ubc.S
|
2005-04-17 06:20:36 +08:00
|
|
|
*
|
|
|
|
* 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
|
|
|
|
|