sh: Add a few more branch types to the branch emulator.
This plugs in some extra encodings for matching more bsr/bsrf/jsr branches. Signed-off-by: Paul Mundt <lethal@linux-sh.org>
This commit is contained in:
parent
5dd614761f
commit
edfd6da040
|
@ -689,7 +689,7 @@ asmlinkage void do_reserved_inst(unsigned long r4, unsigned long r5,
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef CONFIG_SH_FPU_EMU
|
#ifdef CONFIG_SH_FPU_EMU
|
||||||
static int emulate_branch(unsigned short inst, struct pt_regs* regs)
|
static int emulate_branch(unsigned short inst, struct pt_regs *regs)
|
||||||
{
|
{
|
||||||
/*
|
/*
|
||||||
* bfs: 8fxx: PC+=d*2+4;
|
* bfs: 8fxx: PC+=d*2+4;
|
||||||
|
@ -702,27 +702,32 @@ static int emulate_branch(unsigned short inst, struct pt_regs* regs)
|
||||||
* jsr: 4x0b: PC=Rn after PR=PC+4;
|
* jsr: 4x0b: PC=Rn after PR=PC+4;
|
||||||
* rts: 000b: PC=PR;
|
* rts: 000b: PC=PR;
|
||||||
*/
|
*/
|
||||||
if ((inst & 0xfd00) == 0x8d00) {
|
if (((inst & 0xf000) == 0xb000) || /* bsr */
|
||||||
|
((inst & 0xf0ff) == 0x0003) || /* bsrf */
|
||||||
|
((inst & 0xf0ff) == 0x400b)) /* jsr */
|
||||||
|
regs->pr = regs->pc + 4;
|
||||||
|
|
||||||
|
if ((inst & 0xfd00) == 0x8d00) { /* bfs, bts */
|
||||||
regs->pc += SH_PC_8BIT_OFFSET(inst);
|
regs->pc += SH_PC_8BIT_OFFSET(inst);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
if ((inst & 0xe000) == 0xa000) {
|
if ((inst & 0xe000) == 0xa000) { /* bra, bsr */
|
||||||
regs->pc += SH_PC_12BIT_OFFSET(inst);
|
regs->pc += SH_PC_12BIT_OFFSET(inst);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
if ((inst & 0xf0df) == 0x0003) {
|
if ((inst & 0xf0df) == 0x0003) { /* braf, bsrf */
|
||||||
regs->pc += regs->regs[(inst & 0x0f00) >> 8] + 4;
|
regs->pc += regs->regs[(inst & 0x0f00) >> 8] + 4;
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
if ((inst & 0xf0df) == 0x400b) {
|
if ((inst & 0xf0df) == 0x400b) { /* jmp, jsr */
|
||||||
regs->pc = regs->regs[(inst & 0x0f00) >> 8];
|
regs->pc = regs->regs[(inst & 0x0f00) >> 8];
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
if ((inst & 0xffff) == 0x000b) {
|
if ((inst & 0xffff) == 0x000b) { /* rts */
|
||||||
regs->pc = regs->pr;
|
regs->pc = regs->pr;
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue