11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * align.c - address exception handler for M32R 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (c) 2003 Hitoshi Yamamoto 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/ptrace.h> 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int get_reg(struct pt_regs *regs, int nr) 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int val; 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (nr < 4) 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = *(unsigned long *)(®s->r0 + nr); 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (nr < 7) 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = *(unsigned long *)(®s->r4 + (nr - 4)); 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (nr < 13) 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = *(unsigned long *)(®s->r7 + (nr - 7)); 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = *(unsigned long *)(®s->fp + (nr - 13)); 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return val; 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void set_reg(struct pt_regs *regs, int nr, int val) 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (nr < 4) 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *(unsigned long *)(®s->r0 + nr) = val; 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (nr < 7) 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *(unsigned long *)(®s->r4 + (nr - 4)) = val; 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (nr < 13) 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *(unsigned long *)(®s->r7 + (nr - 7)) = val; 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *(unsigned long *)(®s->fp + (nr - 13)) = val; 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define REG1(insn) (((insn) & 0x0f00) >> 8) 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define REG2(insn) ((insn) & 0x000f) 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define PSW_BC 0x100 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* O- instruction */ 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_LD1 0x20c0 /* ld Rdest, @Rsrc */ 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_LD2 0x20e0 /* ld Rdest, @Rsrc+ */ 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_LDH 0x20a0 /* ldh Rdest, @Rsrc */ 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_LDUH 0x20b0 /* lduh Rdest, @Rsrc */ 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_ST1 0x2040 /* st Rsrc1, @Rsrc2 */ 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_ST2 0x2060 /* st Rsrc1, @+Rsrc2 */ 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_ST3 0x2070 /* st Rsrc1, @-Rsrc2 */ 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_STH1 0x2020 /* sth Rsrc1, @Rsrc2 */ 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_STH2 0x2030 /* sth Rsrc1, @Rsrc2+ */ 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_ISA_DUAL_ISSUE 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* OS instruction */ 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_ADD 0x00a0 /* add Rdest, Rsrc */ 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_ADDI 0x4000 /* addi Rdest, #imm8 */ 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_ADDX 0x0090 /* addx Rdest, Rsrc */ 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_AND 0x00c0 /* and Rdest, Rsrc */ 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_CMP 0x0040 /* cmp Rsrc1, Rsrc2 */ 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_CMPEQ 0x0060 /* cmpeq Rsrc1, Rsrc2 */ 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_CMPU 0x0050 /* cmpu Rsrc1, Rsrc2 */ 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_CMPZ 0x0070 /* cmpz Rsrc */ 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_LDI 0x6000 /* ldi Rdest, #imm8 */ 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_MV 0x1080 /* mv Rdest, Rsrc */ 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_NEG 0x0030 /* neg Rdest, Rsrc */ 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_NOP 0x7000 /* nop */ 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_NOT 0x00b0 /* not Rdest, Rsrc */ 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_OR 0x00e0 /* or Rdest, Rsrc */ 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_SUB 0x0020 /* sub Rdest, Rsrc */ 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_SUBX 0x0010 /* subx Rdest, Rsrc */ 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_XOR 0x00d0 /* xor Rdest, Rsrc */ 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* -S instruction */ 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_MUL 0x1060 /* mul Rdest, Rsrc */ 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_MULLO_A0 0x3010 /* mullo Rsrc1, Rsrc2, A0 */ 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_MULLO_A1 0x3090 /* mullo Rsrc1, Rsrc2, A1 */ 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_MVFACMI_A0 0x50f2 /* mvfacmi Rdest, A0 */ 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ISA_MVFACMI_A1 0x50f6 /* mvfacmi Rdest, A1 */ 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_addi(unsigned short insn, struct pt_regs *regs) 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char imm = (char)(insn & 0xff); 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dest = REG1(insn); 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int val; 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = get_reg(regs, dest); 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val += imm; 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, dest, val); 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_ldi(unsigned short insn, struct pt_regs *regs) 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char imm = (char)(insn & 0xff); 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, REG1(insn), (int)imm); 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_add(unsigned short insn, struct pt_regs *regs) 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dest = REG1(insn); 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int src = REG2(insn); 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int val; 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = get_reg(regs, dest); 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val += get_reg(regs, src); 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, dest, val); 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_addx(unsigned short insn, struct pt_regs *regs) 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dest = REG1(insn); 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int val, tmp; 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = regs->psw & PSW_BC ? 1 : 0; 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = get_reg(regs, dest); 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val += tmp; 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val += (unsigned int)get_reg(regs, REG2(insn)); 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, dest, val); 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* C bit set */ 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (val < tmp) 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw |= PSW_BC; 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw &= ~(PSW_BC); 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_and(unsigned short insn, struct pt_regs *regs) 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dest = REG1(insn); 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int val; 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = get_reg(regs, dest); 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val &= get_reg(regs, REG2(insn)); 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, dest, val); 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_cmp(unsigned short insn, struct pt_regs *regs) 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (get_reg(regs, REG1(insn)) < get_reg(regs, REG2(insn))) 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw |= PSW_BC; 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw &= ~(PSW_BC); 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_cmpeq(unsigned short insn, struct pt_regs *regs) 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (get_reg(regs, REG1(insn)) == get_reg(regs, REG2(insn))) 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw |= PSW_BC; 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw &= ~(PSW_BC); 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_cmpu(unsigned short insn, struct pt_regs *regs) 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((unsigned int)get_reg(regs, REG1(insn)) 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds < (unsigned int)get_reg(regs, REG2(insn))) 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw |= PSW_BC; 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw &= ~(PSW_BC); 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_cmpz(unsigned short insn, struct pt_regs *regs) 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!get_reg(regs, REG2(insn))) 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw |= PSW_BC; 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw &= ~(PSW_BC); 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_mv(unsigned short insn, struct pt_regs *regs) 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int val; 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = get_reg(regs, REG2(insn)); 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, REG1(insn), val); 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_neg(unsigned short insn, struct pt_regs *regs) 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int val; 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = get_reg(regs, REG2(insn)); 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, REG1(insn), 0 - val); 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_not(unsigned short insn, struct pt_regs *regs) 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int val; 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = get_reg(regs, REG2(insn)); 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, REG1(insn), ~val); 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_or(unsigned short insn, struct pt_regs *regs) 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dest = REG1(insn); 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int val; 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = get_reg(regs, dest); 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val |= get_reg(regs, REG2(insn)); 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, dest, val); 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_sub(unsigned short insn, struct pt_regs *regs) 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dest = REG1(insn); 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int val; 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = get_reg(regs, dest); 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val -= get_reg(regs, REG2(insn)); 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, dest, val); 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_subx(unsigned short insn, struct pt_regs *regs) 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dest = REG1(insn); 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int val, tmp; 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = tmp = get_reg(regs, dest); 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val -= (unsigned int)get_reg(regs, REG2(insn)); 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val -= regs->psw & PSW_BC ? 1 : 0; 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, dest, val); 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* C bit set */ 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (val > tmp) 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw |= PSW_BC; 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->psw &= ~(PSW_BC); 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_xor(unsigned short insn, struct pt_regs *regs) 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dest = REG1(insn); 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int val; 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = (unsigned int)get_reg(regs, dest); 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val ^= (unsigned int)get_reg(regs, REG2(insn)); 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, dest, val); 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_mul(unsigned short insn, struct pt_regs *regs) 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dest = REG1(insn); 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int reg1, reg2; 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds reg1 = get_reg(regs, dest); 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds reg2 = get_reg(regs, REG2(insn)); 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __asm__ __volatile__ ( 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "mul %0, %1; \n\t" 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds : "+r" (reg1) : "r" (reg2) 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ); 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, dest, reg1); 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_mullo_a0(unsigned short insn, struct pt_regs *regs) 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int reg1, reg2; 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds reg1 = get_reg(regs, REG1(insn)); 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds reg2 = get_reg(regs, REG2(insn)); 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __asm__ __volatile__ ( 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "mullo %0, %1, a0; \n\t" 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "mvfachi %0, a0; \n\t" 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "mvfaclo %1, a0; \n\t" 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds : "+r" (reg1), "+r" (reg2) 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ); 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->acc0h = reg1; 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->acc0l = reg2; 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_mullo_a1(unsigned short insn, struct pt_regs *regs) 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int reg1, reg2; 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds reg1 = get_reg(regs, REG1(insn)); 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds reg2 = get_reg(regs, REG2(insn)); 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __asm__ __volatile__ ( 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "mullo %0, %1, a0; \n\t" 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "mvfachi %0, a0; \n\t" 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "mvfaclo %1, a0; \n\t" 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds : "+r" (reg1), "+r" (reg2) 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ); 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->acc1h = reg1; 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->acc1l = reg2; 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_mvfacmi_a0(unsigned short insn, struct pt_regs *regs) 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long val; 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = (regs->acc0h << 16) | (regs->acc0l >> 16); 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, REG1(insn), (int)val); 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_mvfacmi_a1(unsigned short insn, struct pt_regs *regs) 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long val; 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = (regs->acc1h << 16) | (regs->acc1l >> 16); 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, REG1(insn), (int)val); 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_m32r2(unsigned short insn, struct pt_regs *regs) 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int res = -1; 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((insn & 0x7fff) == ISA_NOP) /* nop */ 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch(insn & 0x7000) { 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_ADDI: /* addi Rdest, #imm8 */ 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_addi(insn, regs); 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_LDI: /* ldi Rdest, #imm8 */ 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_ldi(insn, regs); 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!res) 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch(insn & 0x70f0) { 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_ADD: /* add Rdest, Rsrc */ 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_add(insn, regs); 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_ADDX: /* addx Rdest, Rsrc */ 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_addx(insn, regs); 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_AND: /* and Rdest, Rsrc */ 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_and(insn, regs); 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_CMP: /* cmp Rsrc1, Rsrc2 */ 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_cmp(insn, regs); 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_CMPEQ: /* cmpeq Rsrc1, Rsrc2 */ 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_cmpeq(insn, regs); 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_CMPU: /* cmpu Rsrc1, Rsrc2 */ 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_cmpu(insn, regs); 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_CMPZ: /* cmpz Rsrc */ 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_cmpz(insn, regs); 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_MV: /* mv Rdest, Rsrc */ 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_mv(insn, regs); 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_NEG: /* neg Rdest, Rsrc */ 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_neg(insn, regs); 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_NOT: /* not Rdest, Rsrc */ 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_not(insn, regs); 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_OR: /* or Rdest, Rsrc */ 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_or(insn, regs); 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_SUB: /* sub Rdest, Rsrc */ 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_sub(insn, regs); 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_SUBX: /* subx Rdest, Rsrc */ 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_subx(insn, regs); 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_XOR: /* xor Rdest, Rsrc */ 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_xor(insn, regs); 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_MUL: /* mul Rdest, Rsrc */ 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_mul(insn, regs); 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_MULLO_A0: /* mullo Rsrc1, Rsrc2 */ 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_mullo_a0(insn, regs); 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_MULLO_A1: /* mullo Rsrc1, Rsrc2 */ 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_mullo_a1(insn, regs); 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!res) 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch(insn & 0x70ff) { 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_MVFACMI_A0: /* mvfacmi Rdest */ 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_mvfacmi_a0(insn, regs); 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ISA_MVFACMI_A1: /* mvfacmi Rdest */ 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_mvfacmi_a1(insn, regs); 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return res; 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif /* CONFIG_ISA_DUAL_ISSUE */ 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ld : ?010 dest 1100 src 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 0010 dest 1110 src : ld Rdest, @Rsrc+ 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ldh : ?010 dest 1010 src 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * lduh : ?010 dest 1011 src 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * st : ?010 src1 0100 src2 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 0010 src1 0110 src2 : st Rsrc1, @+Rsrc2 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 0010 src1 0111 src2 : st Rsrc1, @-Rsrc2 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * sth : ?010 src1 0010 src2 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int insn_check(unsigned long insn, struct pt_regs *regs, 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char **ucp) 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int res = 0; 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 32bit insn 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ld Rdest, @(disp16, Rsrc) 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * st Rdest, @(disp16, Rsrc) 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (insn & 0x80000000) { /* 32bit insn */ 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *ucp += (short)(insn & 0x0000ffff); 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->bpc += 4; 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { /* 16bit insn */ 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_ISA_DUAL_ISSUE 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* parallel exec check */ 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(regs->bpc & 0x2) && insn & 0x8000) { 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_m32r2((unsigned short)insn, regs); 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->bpc += 4; 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif /* CONFIG_ISA_DUAL_ISSUE */ 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds regs->bpc += 2; 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return res; 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_ld(unsigned long insn32, struct pt_regs *regs) 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char *ucp; 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long val; 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned short insn16; 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int size, src; 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds insn16 = insn32 >> 16; 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src = REG2(insn16); 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ucp = (unsigned char *)get_reg(regs, src); 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (insn_check(insn32, regs, &ucp)) 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -1; 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = insn16 & 0x0040 ? 4 : 2; 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&val, ucp, size)) 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -1; 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size == 2) 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val >>= 16; 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ldh sign check */ 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((insn16 & 0x00f0) == 0x00a0 && (val & 0x8000)) 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val |= 0xffff0000; 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, REG1(insn16), val); 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ld increment check */ 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((insn16 & 0xf0f0) == ISA_LD2) /* ld Rdest, @Rsrc+ */ 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, src, (unsigned long)(ucp + 4)); 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int emu_st(unsigned long insn32, struct pt_regs *regs) 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char *ucp; 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long val; 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned short insn16; 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int size, src2; 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds insn16 = insn32 >> 16; 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src2 = REG2(insn16); 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ucp = (unsigned char *)get_reg(regs, src2); 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (insn_check(insn32, regs, &ucp)) 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -1; 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = insn16 & 0x0040 ? 4 : 2; 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = get_reg(regs, REG1(insn16)); 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size == 2) 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val <<= 16; 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* st inc/dec check */ 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((insn16 & 0xf0e0) == 0x2060) { 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (insn16 & 0x0010) 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ucp -= 4; 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ucp += 4; 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, src2, (unsigned long)ucp); 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_to_user(ucp, &val, size)) 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -1; 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* sth inc check */ 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((insn16 & 0xf0f0) == ISA_STH2) { 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ucp += 2; 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_reg(regs, src2, (unsigned long)ucp); 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint handle_unaligned_access(unsigned long insn32, struct pt_regs *regs) 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned short insn16; 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int res; 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds insn16 = insn32 >> 16; 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ld or st check */ 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((insn16 & 0x7000) != 0x2000) 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -1; 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* insn alignment check */ 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((insn16 & 0x8000) && (regs->bpc & 3)) 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -1; 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (insn16 & 0x0080) /* ld */ 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_ld(insn32, regs); 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else /* st */ 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = emu_st(insn32, regs); 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return res; 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 585