mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-29 03:01:39 -04:00
sh: SH-4A UBC support
A simple patch to enable the UBC on SH-4A. Signed-off-by: Ryusuke Sakato <[email protected]> Signed-off-by: Paul Mundt <[email protected]>
This commit is contained in:
parent
baf4326e49
commit
8ae91b9ad8
2 changed files with 67 additions and 0 deletions
|
|
@ -5,6 +5,7 @@
|
|||
* Copyright (C) 1995 Linus Torvalds
|
||||
*
|
||||
* SuperH version: Copyright (C) 1999, 2000 Niibe Yutaka & Kaz Kojima
|
||||
* Copyright (C) 2006 Lineo Solutions Inc. support SH4A UBC
|
||||
*/
|
||||
|
||||
/*
|
||||
|
|
@ -290,6 +291,24 @@ int copy_thread(int nr, unsigned long clone_flags, unsigned long usp,
|
|||
static void
|
||||
ubc_set_tracing(int asid, unsigned long pc)
|
||||
{
|
||||
#if defined(CONFIG_CPU_SH4A)
|
||||
unsigned long val;
|
||||
|
||||
val = (UBC_CBR_ID_INST | UBC_CBR_RW_READ | UBC_CBR_CE);
|
||||
val |= (UBC_CBR_AIE | UBC_CBR_AIV_SET(asid));
|
||||
|
||||
ctrl_outl(val, UBC_CBR0);
|
||||
ctrl_outl(pc, UBC_CAR0);
|
||||
ctrl_outl(0x0, UBC_CAMR0);
|
||||
ctrl_outl(0x0, UBC_CBCR);
|
||||
|
||||
val = (UBC_CRR_RES | UBC_CRR_PCB | UBC_CRR_BIE);
|
||||
ctrl_outl(val, UBC_CRR0);
|
||||
|
||||
/* Read UBC register that we writed last. For chekking UBC Register changed */
|
||||
val = ctrl_inl(UBC_CRR0);
|
||||
|
||||
#else /* CONFIG_CPU_SH4A */
|
||||
ctrl_outl(pc, UBC_BARA);
|
||||
|
||||
#ifdef CONFIG_MMU
|
||||
|
|
@ -307,6 +326,7 @@ ubc_set_tracing(int asid, unsigned long pc)
|
|||
ctrl_outw(BBR_INST | BBR_READ, UBC_BBRA);
|
||||
ctrl_outw(BRCR_PCBA, UBC_BRCR);
|
||||
}
|
||||
#endif /* CONFIG_CPU_SH4A */
|
||||
}
|
||||
|
||||
/*
|
||||
|
|
@ -359,8 +379,13 @@ struct task_struct *__switch_to(struct task_struct *prev, struct task_struct *ne
|
|||
#endif
|
||||
ubc_set_tracing(asid, next->thread.ubc_pc);
|
||||
} else {
|
||||
#if defined(CONFIG_CPU_SH4A)
|
||||
ctrl_outl(UBC_CBR_INIT, UBC_CBR0);
|
||||
ctrl_outl(UBC_CRR_INIT, UBC_CRR0);
|
||||
#else
|
||||
ctrl_outw(0, UBC_BBRA);
|
||||
ctrl_outw(0, UBC_BBRB);
|
||||
#endif
|
||||
}
|
||||
|
||||
return prev;
|
||||
|
|
@ -460,8 +485,13 @@ asmlinkage void break_point_trap(unsigned long r4, unsigned long r5,
|
|||
struct pt_regs regs)
|
||||
{
|
||||
/* Clear tracing. */
|
||||
#if defined(CONFIG_CPU_SH4A)
|
||||
ctrl_outl(UBC_CBR_INIT, UBC_CBR0);
|
||||
ctrl_outl(UBC_CRR_INIT, UBC_CRR0);
|
||||
#else
|
||||
ctrl_outw(0, UBC_BBRA);
|
||||
ctrl_outw(0, UBC_BBRB);
|
||||
#endif
|
||||
current->thread.ubc_pc = 0;
|
||||
ubc_usercnt -= 1;
|
||||
|
||||
|
|
|
|||
Loading…
Reference in a new issue