2231 lines
36 KiB
C++
2231 lines
36 KiB
C++
// Change Log
|
|
|
|
// fixed dsp_opc_mulx (regarding DSP 0.0.4.pdf)
|
|
// fixed dsp_opc_mulxmv (regarding DSP 0.0.4.pdf)
|
|
// fixed dsp_opc_mulxmvz (regarding DSP 0.0.4.pdf)
|
|
// dsp_opc_shifti: removed strange " >> 9"
|
|
// added masking for SR_COMPARE_FLAGS
|
|
// added "UNKNOWN_CW" but without a function (yet? :)
|
|
// added missing compare type to MISSING_COMPARES_JX ... but i dunno what it does
|
|
|
|
// added "MULXMV" to another function table
|
|
|
|
/*====================================================================
|
|
|
|
filename: gdsp_opcodes.cpp
|
|
project: GCemu
|
|
created: 2004-6-18
|
|
mail: duddie@walla.com
|
|
|
|
Copyright (c) 2005 Duddie & Tratax
|
|
|
|
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.
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program; if not, write to the Free Software
|
|
Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
|
|
====================================================================*/
|
|
|
|
#include <stdio.h>
|
|
#include "Globals.h"
|
|
#include "gdsp_opcodes.h"
|
|
#include "gdsp_memory.h"
|
|
#include "gdsp_interpreter.h"
|
|
#include "gdsp_registers.h"
|
|
#include "gdsp_opcodes_helper.h"
|
|
#include "gdsp_ext_op.h"
|
|
|
|
#define SR_CMP_MASK 0x3f
|
|
#define DSP_REG_MASK 0x1f
|
|
|
|
|
|
void Update_SR_Register(sint64 _Value)
|
|
{
|
|
g_dsp.r[R_SR] &= ~SR_CMP_MASK;
|
|
|
|
if (_Value < 0)
|
|
{
|
|
g_dsp.r[R_SR] |= 0x8;
|
|
}
|
|
|
|
if (_Value == 0)
|
|
{
|
|
g_dsp.r[R_SR] |= 0x4;
|
|
}
|
|
|
|
// logic
|
|
if ((_Value >> 62) == 0)
|
|
{
|
|
g_dsp.r[R_SR] |= 0x20;
|
|
}
|
|
}
|
|
|
|
|
|
void Update_SR_Register(sint16 _Value)
|
|
{
|
|
g_dsp.r[R_SR] &= ~SR_CMP_MASK;
|
|
|
|
if (_Value < 0)
|
|
{
|
|
g_dsp.r[R_SR] |= 0x8;
|
|
}
|
|
|
|
if (_Value == 0)
|
|
{
|
|
g_dsp.r[R_SR] |= 0x4;
|
|
}
|
|
|
|
// logic
|
|
if ((_Value >> 14) == 0)
|
|
{
|
|
g_dsp.r[R_SR] |= 0x20;
|
|
}
|
|
}
|
|
|
|
|
|
sint8 GetMultiplyModifier()
|
|
{
|
|
if (g_dsp.r[R_SR] & (1 << 13))
|
|
{
|
|
return(1);
|
|
}
|
|
|
|
return(2);
|
|
}
|
|
|
|
|
|
bool CheckCondition(uint8 _Condition)
|
|
{
|
|
bool taken = false;
|
|
|
|
switch (_Condition & 0xf)
|
|
{
|
|
case 0x0:
|
|
|
|
if ((!(g_dsp.r[R_SR] & 0x02)) && (!(g_dsp.r[R_SR] & 0x08)))
|
|
{
|
|
taken = true;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x3:
|
|
|
|
if ((g_dsp.r[R_SR] & 0x02) || (g_dsp.r[R_SR] & 0x04) || (g_dsp.r[R_SR] & 0x08))
|
|
{
|
|
taken = true;
|
|
}
|
|
|
|
break;
|
|
|
|
// old from duddie
|
|
case 0x1: // seems okay
|
|
|
|
if ((!(g_dsp.r[R_SR] & 0x02)) && (g_dsp.r[R_SR] & 0x08))
|
|
{
|
|
taken = true;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x2:
|
|
|
|
if (!(g_dsp.r[R_SR] & 0x08))
|
|
{
|
|
taken = true;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x4:
|
|
|
|
if (!(g_dsp.r[R_SR] & 0x04))
|
|
{
|
|
taken = true;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x5:
|
|
|
|
if (g_dsp.r[R_SR] & 0x04)
|
|
{
|
|
taken = true;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0xc:
|
|
|
|
if (!(g_dsp.r[R_SR] & 0x40))
|
|
{
|
|
taken = true;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0xd:
|
|
|
|
if (g_dsp.r[R_SR] & 0x40)
|
|
{
|
|
taken = true;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0xf:
|
|
taken = true;
|
|
break;
|
|
|
|
default:
|
|
// DebugLog("Unknown condition check: 0x%04x\n", _Condition & 0xf);
|
|
break;
|
|
}
|
|
|
|
return(taken);
|
|
}
|
|
|
|
|
|
// =======================================================================
|
|
|
|
void dsp_op_unknown(uint16 opc)
|
|
{
|
|
_assert_msg_(MASTER_LOG, !g_dsp.exception_in_progress_hack, "assert while exception");
|
|
ErrorLog("dsp_op_unknown somewhere");
|
|
g_dsp.pc = g_dsp.err_pc;
|
|
}
|
|
|
|
|
|
void dsp_opc_call(uint16 opc)
|
|
{
|
|
uint16 dest = dsp_fetch_code();
|
|
|
|
if (CheckCondition(opc & 0xf))
|
|
{
|
|
dsp_reg_store_stack(DSP_STACK_C, g_dsp.pc);
|
|
g_dsp.pc = dest;
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_ifcc(uint16 opc)
|
|
{
|
|
if (!CheckCondition(opc & 0xf))
|
|
{
|
|
dsp_fetch_code(); // skip the next opcode
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_jcc(uint16 opc)
|
|
{
|
|
uint16 dest = dsp_fetch_code();
|
|
|
|
if (CheckCondition(opc & 0xf))
|
|
{
|
|
g_dsp.pc = dest;
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_jmpa(uint16 opc)
|
|
{
|
|
uint8 reg;
|
|
uint16 addr;
|
|
|
|
if ((opc & 0xf) != 0xf)
|
|
{
|
|
ErrorLog("dsp_opc_jmpa");
|
|
}
|
|
|
|
reg = (opc >> 5) & 0x7;
|
|
addr = dsp_op_read_reg(reg);
|
|
|
|
if (opc & 0x0010)
|
|
{
|
|
// CALLA
|
|
dsp_reg_store_stack(DSP_STACK_C, g_dsp.pc);
|
|
}
|
|
|
|
g_dsp.pc = addr;
|
|
}
|
|
|
|
|
|
// NEW (added condition check)
|
|
void dsp_opc_ret(uint16 opc)
|
|
{
|
|
if (CheckCondition(opc & 0xf))
|
|
{
|
|
g_dsp.pc = dsp_reg_load_stack(DSP_STACK_C);
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_rti(uint16 opc)
|
|
{
|
|
if ((opc & 0xf) != 0xf)
|
|
{
|
|
ErrorLog("dsp_opc_rti");
|
|
}
|
|
|
|
g_dsp.r[R_SR] = dsp_reg_load_stack(DSP_STACK_D);
|
|
g_dsp.pc = dsp_reg_load_stack(DSP_STACK_C);
|
|
|
|
g_dsp.exception_in_progress_hack = false;
|
|
}
|
|
|
|
|
|
void dsp_opc_halt(uint16 opc)
|
|
{
|
|
g_dsp.cr |= 0x4;
|
|
g_dsp.pc = g_dsp.err_pc;
|
|
}
|
|
|
|
|
|
void dsp_opc_loop(uint16 opc)
|
|
{
|
|
uint16 reg = opc & 0x1f;
|
|
uint16 cnt = g_dsp.r[reg];
|
|
uint16 loop_pc = g_dsp.pc;
|
|
|
|
while (cnt--)
|
|
{
|
|
gdsp_loop_step();
|
|
g_dsp.pc = loop_pc;
|
|
}
|
|
|
|
g_dsp.pc = loop_pc + 1;
|
|
}
|
|
|
|
|
|
void dsp_opc_loopi(uint16 opc)
|
|
{
|
|
uint16 cnt = opc & 0xff;
|
|
uint16 loop_pc = g_dsp.pc;
|
|
|
|
while (cnt--)
|
|
{
|
|
gdsp_loop_step();
|
|
g_dsp.pc = loop_pc;
|
|
}
|
|
|
|
g_dsp.pc = loop_pc + 1;
|
|
}
|
|
|
|
|
|
void dsp_opc_bloop(uint16 opc)
|
|
{
|
|
uint16 reg = opc & 0x1f;
|
|
uint16 cnt = g_dsp.r[reg];
|
|
uint16 loop_pc = dsp_fetch_code();
|
|
|
|
if (cnt)
|
|
{
|
|
dsp_reg_store_stack(0, g_dsp.pc);
|
|
dsp_reg_store_stack(2, loop_pc);
|
|
dsp_reg_store_stack(3, cnt);
|
|
}
|
|
else
|
|
{
|
|
g_dsp.pc = loop_pc + 1;
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_bloopi(uint16 opc)
|
|
{
|
|
uint16 cnt = opc & 0xff;
|
|
uint16 loop_pc = dsp_fetch_code();
|
|
|
|
if (cnt)
|
|
{
|
|
dsp_reg_store_stack(0, g_dsp.pc);
|
|
dsp_reg_store_stack(2, loop_pc);
|
|
dsp_reg_store_stack(3, cnt);
|
|
}
|
|
else
|
|
{
|
|
g_dsp.pc = loop_pc + 1;
|
|
}
|
|
}
|
|
|
|
|
|
//-------------------------------------------------------------
|
|
|
|
|
|
void dsp_opc_mrr(uint16 opc)
|
|
{
|
|
uint8 sreg = opc & 0x1f;
|
|
uint8 dreg = (opc >> 5) & 0x1f;
|
|
|
|
uint16 val = dsp_op_read_reg(sreg);
|
|
dsp_op_write_reg(dreg, val);
|
|
}
|
|
|
|
|
|
void dsp_opc_lrr(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 5) & 0x3;
|
|
uint8 dreg = opc & 0x1f;
|
|
|
|
uint16 val = dsp_dmem_read(g_dsp.r[sreg]);
|
|
dsp_op_write_reg(dreg, val);
|
|
|
|
// post processing of source reg
|
|
switch ((opc >> 7) & 0x3)
|
|
{
|
|
case 0x0: // LRR
|
|
break;
|
|
|
|
case 0x1: // LRRD
|
|
g_dsp.r[sreg]--;
|
|
break;
|
|
|
|
case 0x2: // LRRI
|
|
g_dsp.r[sreg]++;
|
|
break;
|
|
|
|
case 0x3:
|
|
g_dsp.r[sreg] += g_dsp.r[sreg + 4];
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_srr(uint16 opc)
|
|
{
|
|
uint8 dreg = (opc >> 5) & 0x3;
|
|
uint8 sreg = opc & 0x1f;
|
|
|
|
uint16 val = dsp_op_read_reg(sreg);
|
|
dsp_dmem_write(g_dsp.r[dreg], val);
|
|
|
|
// post processing of dest reg
|
|
switch ((opc >> 7) & 0x3)
|
|
{
|
|
case 0x0: // SRR
|
|
break;
|
|
|
|
case 0x1: // SRRD
|
|
g_dsp.r[dreg]--;
|
|
break;
|
|
|
|
case 0x2: // SRRI
|
|
g_dsp.r[dreg]++;
|
|
break;
|
|
|
|
case 0x3: // SRRX
|
|
g_dsp.r[dreg] += g_dsp.r[dreg + 4];
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_ilrr(uint16 opc)
|
|
{
|
|
uint16 reg = opc & 0x3;
|
|
uint16 dreg = 0x1e + ((opc >> 8) & 1);
|
|
|
|
// always to acc0 ?
|
|
g_dsp.r[dreg] = dsp_imem_read(g_dsp.r[reg]);
|
|
|
|
switch ((opc >> 2) & 0x3)
|
|
{
|
|
case 0x0: // no change
|
|
break;
|
|
|
|
case 0x1: // post decrement
|
|
g_dsp.r[reg]--;
|
|
break;
|
|
|
|
case 0x2: // post increment
|
|
g_dsp.r[reg]++;
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_opc_ilrr");
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_lri(uint16 opc)
|
|
{
|
|
uint8 reg = opc & DSP_REG_MASK;
|
|
uint16 imm = dsp_fetch_code();
|
|
dsp_op_write_reg(reg, imm);
|
|
}
|
|
|
|
|
|
void dsp_opc_lris(uint16 opc)
|
|
{
|
|
uint8 reg = ((opc >> 8) & 0x7) + 0x18;
|
|
uint16 imm = (sint8)opc;
|
|
dsp_op_write_reg(reg, imm);
|
|
}
|
|
|
|
|
|
void dsp_opc_lr(uint16 opc)
|
|
{
|
|
uint8 reg = opc & DSP_REG_MASK;
|
|
uint16 addr = dsp_fetch_code();
|
|
uint16 val = dsp_dmem_read(addr);
|
|
dsp_op_write_reg(reg, val);
|
|
}
|
|
|
|
|
|
void dsp_opc_sr(uint16 opc)
|
|
{
|
|
uint8 reg = opc & DSP_REG_MASK;
|
|
uint16 addr = dsp_fetch_code();
|
|
uint16 val = dsp_op_read_reg(reg);
|
|
dsp_dmem_write(addr, val);
|
|
}
|
|
|
|
|
|
void dsp_opc_si(uint16 opc)
|
|
{
|
|
uint16 addr = (sint8)opc;
|
|
uint16 imm = dsp_fetch_code();
|
|
dsp_dmem_write(addr, imm);
|
|
}
|
|
|
|
|
|
void dsp_opc_tstaxh(uint16 opc)
|
|
{
|
|
uint8 reg = (opc >> 8) & 0x1;
|
|
sint16 val = dsp_get_ax_h(reg);
|
|
|
|
Update_SR_Register(val);
|
|
}
|
|
|
|
|
|
void dsp_opc_clr(uint16 opc)
|
|
{
|
|
uint8 reg = (opc >> 11) & 0x1;
|
|
|
|
dsp_set_long_acc(reg, 0);
|
|
|
|
Update_SR_Register((sint64)0);
|
|
}
|
|
|
|
|
|
void dsp_opc_clrp(uint16 opc)
|
|
{
|
|
g_dsp.r[0x14] = 0x0000;
|
|
g_dsp.r[0x15] = 0xfff0;
|
|
g_dsp.r[0x16] = 0x00ff;
|
|
g_dsp.r[0x17] = 0x0010;
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_mulc(uint16 opc)
|
|
{
|
|
// math new prod
|
|
uint8 sreg = (opc >> 11) & 0x1;
|
|
uint8 treg = (opc >> 12) & 0x1;
|
|
|
|
sint64 prod = dsp_get_acc_m(sreg) * dsp_get_ax_h(treg) * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
|
|
Update_SR_Register(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_mulcmvz(uint16 opc)
|
|
{
|
|
ErrorLog("dsp_opc_mulcmvz ni");
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_mulcmv(uint16 opc)
|
|
{
|
|
ErrorLog("dsp_opc_mulcmv ni");
|
|
}
|
|
|
|
|
|
void dsp_opc_cmpar(uint16 opc)
|
|
{
|
|
uint8 rreg = ((opc >> 12) & 0x1) + 0x1a;
|
|
uint8 areg = (opc >> 11) & 0x1;
|
|
|
|
// we compare
|
|
sint64 rr = (sint16)g_dsp.r[rreg];
|
|
rr <<= 16;
|
|
|
|
sint64 ar = dsp_get_long_acc(areg);
|
|
|
|
Update_SR_Register(ar - rr);
|
|
}
|
|
|
|
|
|
void dsp_opc_cmp(uint16 opc)
|
|
{
|
|
sint64 acc0 = dsp_get_long_acc(0);
|
|
sint64 acc1 = dsp_get_long_acc(1);
|
|
|
|
Update_SR_Register(acc0 - acc1);
|
|
}
|
|
|
|
|
|
void dsp_opc_tsta(uint16 opc)
|
|
{
|
|
uint8 reg = (opc >> 11) & 0x1;
|
|
sint64 acc = dsp_get_long_acc(reg);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_addaxl(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 9) & 0x1;
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
|
|
sint64 acc = dsp_get_long_acc(dreg);
|
|
sint64 acx = dsp_get_ax_l(sreg);
|
|
|
|
acc += acx;
|
|
|
|
dsp_set_long_acc(dreg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_addarn(uint16 opc)
|
|
{
|
|
uint8 dreg = opc & 0x3;
|
|
uint8 sreg = (opc >> 2) & 0x3;
|
|
|
|
g_dsp.r[dreg] += (sint16)g_dsp.r[0x04 + sreg];
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_mulcac(uint16 opc)
|
|
{
|
|
sint64 TempProd = dsp_get_long_prod();
|
|
|
|
// update prod
|
|
uint8 sreg = (opc >> 12) & 0x1;
|
|
sint64 Prod = (sint64)dsp_get_acc_m(sreg) * (sint64)dsp_get_acc_h(sreg) * GetMultiplyModifier();
|
|
dsp_set_long_prod(Prod);
|
|
|
|
// update acc
|
|
uint8 rreg = (opc >> 8) & 0x1;
|
|
dsp_set_long_acc(rreg, TempProd);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_movr(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
uint8 sreg = ((opc >> 9) & 0x3) + 0x18;
|
|
|
|
sint64 acc = (sint16)g_dsp.r[sreg];
|
|
acc <<= 16;
|
|
acc &= ~0xffff;
|
|
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_movax(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 9) & 0x1;
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
|
|
g_dsp.r[0x1c + dreg] = g_dsp.r[0x18 + sreg];
|
|
g_dsp.r[0x1e + dreg] = g_dsp.r[0x1a + sreg];
|
|
|
|
if ((sint16)g_dsp.r[0x1a + sreg] < 0)
|
|
{
|
|
g_dsp.r[0x10 + dreg] = 0xffff;
|
|
}
|
|
else
|
|
{
|
|
g_dsp.r[0x10 + dreg] = 0;
|
|
}
|
|
|
|
dsp_opc_tsta(dreg << 11);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_xorr(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 9) & 0x1;
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
|
|
g_dsp.r[0x1e + dreg] ^= g_dsp.r[0x1a + sreg];
|
|
|
|
dsp_opc_tsta(dreg << 11);
|
|
}
|
|
|
|
|
|
void dsp_opc_andr(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 9) & 0x1;
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
|
|
g_dsp.r[0x1e + dreg] &= g_dsp.r[0x1a + sreg];
|
|
|
|
dsp_opc_tsta(dreg << 11);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_orr(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 9) & 0x1;
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
|
|
g_dsp.r[0x1e + dreg] |= g_dsp.r[0x1a + sreg];
|
|
|
|
dsp_opc_tsta(dreg << 11);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_andc(uint16 opc)
|
|
{
|
|
uint8 D = (opc >> 8) & 0x1;
|
|
|
|
uint16 ac1 = dsp_get_acc_m(D);
|
|
uint16 ac2 = dsp_get_acc_m(1 - D);
|
|
|
|
dsp_set_long_acc(D, ac1 & ac2);
|
|
|
|
if ((ac1 & ac2) == 0)
|
|
{
|
|
g_dsp.r[R_SR] |= 0x20;
|
|
}
|
|
else
|
|
{
|
|
g_dsp.r[R_SR] &= ~0x20;
|
|
}
|
|
}
|
|
|
|
|
|
//-------------------------------------------------------------
|
|
|
|
void dsp_opc_nx(uint16 opc)
|
|
{}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_andfc(uint16 opc)
|
|
{
|
|
if (opc & 0xf)
|
|
{
|
|
ErrorLog("dsp_opc_andfc");
|
|
}
|
|
|
|
uint8 reg = (opc >> 8) & 0x1;
|
|
uint16 imm = dsp_fetch_code();
|
|
uint16 val = dsp_get_acc_m(reg);
|
|
|
|
if ((val & imm) == imm)
|
|
{
|
|
g_dsp.r[R_SR] |= 0x40;
|
|
}
|
|
else
|
|
{
|
|
g_dsp.r[R_SR] &= ~0x40;
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_andf(uint16 opc)
|
|
{
|
|
uint8 reg;
|
|
uint16 imm;
|
|
uint16 val;
|
|
|
|
if (opc & 0xf)
|
|
{
|
|
ErrorLog("dsp_opc_andf");
|
|
}
|
|
|
|
reg = 0x1e + ((opc >> 8) & 0x1);
|
|
imm = dsp_fetch_code();
|
|
val = g_dsp.r[reg];
|
|
|
|
if ((val & imm) == 0)
|
|
{
|
|
g_dsp.r[R_SR] |= 0x40;
|
|
}
|
|
else
|
|
{
|
|
g_dsp.r[R_SR] &= ~0x40;
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_opc_subf(uint16 opc)
|
|
{
|
|
if (opc & 0xf)
|
|
{
|
|
ErrorLog("dsp_opc_subf");
|
|
}
|
|
|
|
uint8 reg = 0x1e + ((opc >> 8) & 0x1);
|
|
sint64 imm = (sint16)dsp_fetch_code();
|
|
|
|
sint64 val = (sint16)g_dsp.r[reg];
|
|
sint64 res = val - imm;
|
|
|
|
Update_SR_Register(res);
|
|
}
|
|
|
|
|
|
void dsp_opc_xori(uint16 opc)
|
|
{
|
|
if (opc & 0xf)
|
|
{
|
|
ErrorLog("dsp_opc_xori");
|
|
}
|
|
|
|
uint8 reg = 0x1e + ((opc >> 8) & 0x1);
|
|
uint16 imm = dsp_fetch_code();
|
|
g_dsp.r[reg] ^= imm;
|
|
|
|
Update_SR_Register((sint16)g_dsp.r[reg]);
|
|
}
|
|
|
|
|
|
void dsp_opc_andi(uint16 opc)
|
|
{
|
|
if (opc & 0xf)
|
|
{
|
|
ErrorLog("dsp_opc_andi");
|
|
}
|
|
|
|
uint8 reg = 0x1e + ((opc >> 8) & 0x1);
|
|
uint16 imm = dsp_fetch_code();
|
|
g_dsp.r[reg] &= imm;
|
|
|
|
Update_SR_Register((sint16)g_dsp.r[reg]);
|
|
}
|
|
|
|
|
|
// F|RES: i am not sure if this shouldnt be the whole ACC
|
|
//
|
|
void dsp_opc_ori(uint16 opc)
|
|
{
|
|
if (opc & 0xf)
|
|
{
|
|
return(ErrorLog("dsp_opc_ori"));
|
|
}
|
|
|
|
uint8 reg = 0x1e + ((opc >> 8) & 0x1);
|
|
uint16 imm = dsp_fetch_code();
|
|
g_dsp.r[reg] |= imm;
|
|
|
|
Update_SR_Register((sint16)g_dsp.r[reg]);
|
|
}
|
|
|
|
|
|
//-------------------------------------------------------------
|
|
|
|
void dsp_opc_add(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
sint64 acc0 = dsp_get_long_acc(0);
|
|
sint64 acc1 = dsp_get_long_acc(1);
|
|
|
|
sint64 res = acc0 + acc1;
|
|
|
|
dsp_set_long_acc(areg, res);
|
|
|
|
Update_SR_Register(res);
|
|
}
|
|
|
|
|
|
//-------------------------------------------------------------
|
|
|
|
void dsp_opc_addp(uint16 opc)
|
|
{
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
sint64 acc = dsp_get_long_acc(dreg);
|
|
acc = acc + dsp_get_long_prod();
|
|
dsp_set_long_acc(dreg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_cmpis(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
sint64 val = (sint8)opc;
|
|
val <<= 16;
|
|
|
|
sint64 res = acc - val;
|
|
|
|
Update_SR_Register(res);
|
|
}
|
|
|
|
|
|
// NEW
|
|
// verified at the console
|
|
void dsp_opc_addpaxz(uint16 opc)
|
|
{
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
uint8 sreg = (opc >> 9) & 0x1;
|
|
|
|
sint64 prod = dsp_get_long_prod() & ~0x0ffff;
|
|
sint64 ax_h = dsp_get_long_acx(sreg);
|
|
sint64 acc = (prod + ax_h) & ~0x0ffff;
|
|
|
|
dsp_set_long_acc(dreg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_movpz(uint16 opc)
|
|
{
|
|
uint8 dreg = (opc >> 8) & 0x01;
|
|
|
|
// overwrite acc and clear low part
|
|
sint64 prod = dsp_get_long_prod();
|
|
sint64 acc = prod & ~0xffff;
|
|
dsp_set_long_acc(dreg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_decm(uint16 opc)
|
|
{
|
|
uint8 dreg = (opc >> 8) & 0x01;
|
|
|
|
sint64 sub = 0x10000;
|
|
sint64 acc = dsp_get_long_acc(dreg);
|
|
acc -= sub;
|
|
dsp_set_long_acc(dreg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_dec(uint16 opc)
|
|
{
|
|
uint8 dreg = (opc >> 8) & 0x01;
|
|
|
|
sint64 acc = dsp_get_long_acc(dreg) - 1;
|
|
dsp_set_long_acc(dreg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_incm(uint16 opc)
|
|
{
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
|
|
sint64 sub = 0x10000;
|
|
sint64 acc = dsp_get_long_acc(dreg);
|
|
acc += sub;
|
|
dsp_set_long_acc(dreg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_inc(uint16 opc)
|
|
{
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
|
|
sint64 acc = dsp_get_long_acc(dreg);
|
|
acc++;
|
|
dsp_set_long_acc(dreg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_neg(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
acc = 0 - acc;
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_movnp(uint16 opc)
|
|
{
|
|
ErrorLog("dsp_opc_movnp\n");
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_addax(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
uint8 sreg = (opc >> 9) & 0x1;
|
|
|
|
sint64 ax = dsp_get_long_acx(sreg);
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
acc += ax;
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_addr(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
uint8 sreg = ((opc >> 9) & 0x3) + 0x18;
|
|
|
|
sint64 ax = (sint16)g_dsp.r[sreg];
|
|
ax <<= 16;
|
|
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
acc += ax;
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_subr(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
uint8 sreg = ((opc >> 9) & 0x3) + 0x18;
|
|
|
|
sint64 ax = (sint16)g_dsp.r[sreg];
|
|
ax <<= 16;
|
|
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
acc -= ax;
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
// NEW
|
|
void dsp_opc_subax(uint16 opc)
|
|
{
|
|
int regD = (opc >> 8) & 0x1;
|
|
int regT = (opc >> 9) & 0x1;
|
|
|
|
sint64 Acc = dsp_get_long_acc(regD) - dsp_get_long_acx(regT);
|
|
|
|
dsp_set_long_acc(regD, Acc);
|
|
Update_SR_Register(Acc);
|
|
}
|
|
|
|
void dsp_opc_addis(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
|
|
sint64 Imm = (sint8)opc;
|
|
Imm <<= 16;
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
acc += Imm;
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_addi(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
|
|
sint64 sub = (sint16)dsp_fetch_code();
|
|
sub <<= 16;
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
acc += sub;
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_lsl16(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
acc <<= 16;
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_madd(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 8) & 0x1;
|
|
|
|
sint64 prod = dsp_get_long_prod();
|
|
prod += (sint64)dsp_get_ax_l(sreg) * (sint64)dsp_get_ax_h(sreg) * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
}
|
|
|
|
|
|
void dsp_opc_lsr16(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 8) & 0x1;
|
|
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
acc >>= 16;
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_asr16(uint16 opc)
|
|
{
|
|
uint8 areg = (opc >> 11) & 0x1;
|
|
|
|
sint64 acc = dsp_get_long_acc(areg);
|
|
acc >>= 16;
|
|
dsp_set_long_acc(areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
union UOpcodeShifti
|
|
{
|
|
uint16 Hex;
|
|
struct
|
|
{
|
|
signed shift : 6;
|
|
unsigned negating : 1;
|
|
unsigned arithmetic : 1;
|
|
unsigned areg : 1;
|
|
unsigned op : 7;
|
|
};
|
|
struct
|
|
{
|
|
unsigned ushift : 6;
|
|
};
|
|
UOpcodeShifti(uint16 _Hex)
|
|
: Hex(_Hex) {}
|
|
};
|
|
|
|
void dsp_opc_shifti(uint16 opc)
|
|
{
|
|
UOpcodeShifti Opcode(opc);
|
|
|
|
// direction: left
|
|
bool ShiftLeft = true;
|
|
uint16 shift = Opcode.ushift;
|
|
|
|
if ((Opcode.negating) && (Opcode.shift < 0))
|
|
{
|
|
ShiftLeft = false;
|
|
shift = -Opcode.shift;
|
|
}
|
|
|
|
sint64 acc;
|
|
uint64 uacc;
|
|
|
|
if (Opcode.arithmetic)
|
|
{
|
|
// arithmetic shift
|
|
uacc = dsp_get_long_acc(Opcode.areg);
|
|
|
|
if (!ShiftLeft)
|
|
{
|
|
uacc >>= shift;
|
|
}
|
|
else
|
|
{
|
|
uacc <<= shift;
|
|
}
|
|
|
|
acc = uacc;
|
|
}
|
|
else
|
|
{
|
|
acc = dsp_get_long_acc(Opcode.areg);
|
|
|
|
if (!ShiftLeft)
|
|
{
|
|
acc >>= shift;
|
|
}
|
|
else
|
|
{
|
|
acc <<= shift;
|
|
}
|
|
}
|
|
|
|
dsp_set_long_acc(Opcode.areg, acc);
|
|
|
|
Update_SR_Register(acc);
|
|
}
|
|
|
|
|
|
//-------------------------------------------------------------
|
|
// hcs give me this code!!
|
|
void dsp_opc_dar(uint16 opc)
|
|
{
|
|
uint8 reg = opc & 0x3;
|
|
|
|
int temp = g_dsp.r[reg] + g_dsp.r[8];
|
|
|
|
if (temp <= 0x7ff){g_dsp.r[reg] = temp;}
|
|
else {g_dsp.r[reg]--;}
|
|
}
|
|
|
|
|
|
// hcs give me this code!!
|
|
void dsp_opc_iar(uint16 opc)
|
|
{
|
|
uint8 reg = opc & 0x3;
|
|
|
|
int temp = g_dsp.r[reg] + g_dsp.r[8];
|
|
|
|
if (temp <= 0x7ff){g_dsp.r[reg] = temp;}
|
|
else {g_dsp.r[reg]++;}
|
|
}
|
|
|
|
|
|
//-------------------------------------------------------------
|
|
|
|
void dsp_opc_sbclr(uint16 opc)
|
|
{
|
|
uint8 bit = (opc & 0xff) + 6;
|
|
g_dsp.r[R_SR] &= ~(1 << bit);
|
|
}
|
|
|
|
|
|
void dsp_opc_sbset(uint16 opc)
|
|
{
|
|
uint8 bit = (opc & 0xff) + 6;
|
|
g_dsp.r[R_SR] |= (1 << bit);
|
|
}
|
|
|
|
|
|
void dsp_opc_srbith(uint16 opc)
|
|
{
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0xe: // SET40
|
|
g_dsp.r[R_SR] &= ~(1 << 14);
|
|
break;
|
|
|
|
/* case 0xf: // SET16 // that doesnt happen on a real console
|
|
g_dsp.r[R_SR] |= (1 << 14);
|
|
break;*/
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
//-------------------------------------------------------------
|
|
|
|
void dsp_opc_movp(uint16 opc)
|
|
{
|
|
uint8 dreg = (opc >> 8) & 0x1;
|
|
|
|
sint64 prod = dsp_get_long_prod();
|
|
sint64 acc = prod;
|
|
dsp_set_long_acc(dreg, acc);
|
|
}
|
|
|
|
|
|
void dsp_opc_mul(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 11) & 0x1;
|
|
sint64 prod = (sint64)dsp_get_ax_h(sreg) * (sint64)dsp_get_ax_l(sreg) * GetMultiplyModifier();
|
|
|
|
dsp_set_long_prod(prod);
|
|
|
|
Update_SR_Register(prod);
|
|
}
|
|
|
|
// NEW
|
|
void dsp_opc_mulac(uint16 opc)
|
|
{
|
|
// add old prod to acc
|
|
uint8 rreg = (opc >> 8) & 0x1;
|
|
sint64 acR = dsp_get_long_acc(rreg) + dsp_get_long_prod();
|
|
dsp_set_long_acc(rreg, acR);
|
|
|
|
// math new prod
|
|
uint8 sreg = (opc >> 11) & 0x1;
|
|
sint64 prod = dsp_get_ax_l(sreg) * dsp_get_ax_h(sreg) * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
|
|
Update_SR_Register(prod);
|
|
}
|
|
|
|
|
|
void dsp_opc_mulmv(uint16 opc)
|
|
{
|
|
uint8 rreg = (opc >> 8) & 0x1;
|
|
sint64 prod = dsp_get_long_prod();
|
|
sint64 acc = prod;
|
|
dsp_set_long_acc(rreg, acc);
|
|
|
|
uint8 areg = ((opc >> 11) & 0x1) + 0x18;
|
|
uint8 breg = ((opc >> 11) & 0x1) + 0x1a;
|
|
sint64 val1 = (sint16)g_dsp.r[areg];
|
|
sint64 val2 = (sint16)g_dsp.r[breg];
|
|
|
|
prod = val1 * val2 * GetMultiplyModifier();
|
|
|
|
dsp_set_long_prod(prod);
|
|
|
|
Update_SR_Register(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_mulmvz(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 11) & 0x1;
|
|
uint8 rreg = (opc >> 8) & 0x1;
|
|
|
|
// overwrite acc and clear low part
|
|
sint64 prod = dsp_get_long_prod();
|
|
sint64 acc = prod & ~0xffff;
|
|
dsp_set_long_acc(rreg, acc);
|
|
|
|
// math prod
|
|
prod = (sint64)g_dsp.r[0x18 + sreg] * (sint64)g_dsp.r[0x1a + sreg] * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
|
|
Update_SR_Register(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_mulx(uint16 opc)
|
|
{
|
|
uint8 sreg = ((opc >> 12) & 0x1);
|
|
uint8 treg = ((opc >> 11) & 0x1);
|
|
|
|
sint64 val1 = (sreg == 0) ? dsp_get_ax_l(0) : dsp_get_ax_h(0);
|
|
sint64 val2 = (treg == 0) ? dsp_get_ax_l(1) : dsp_get_ax_h(1);
|
|
|
|
sint64 prod = val1 * val2 * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
|
|
Update_SR_Register(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_mulxac(uint16 opc)
|
|
{
|
|
// add old prod to acc
|
|
uint8 rreg = (opc >> 8) & 0x1;
|
|
sint64 acR = dsp_get_long_acc(rreg) + dsp_get_long_prod();
|
|
dsp_set_long_acc(rreg, acR);
|
|
|
|
// math new prod
|
|
uint8 sreg = (opc >> 12) & 0x1;
|
|
uint8 treg = (opc >> 11) & 0x1;
|
|
|
|
sint64 val1 = (sreg == 0) ? dsp_get_ax_l(0) : dsp_get_ax_h(0);
|
|
sint64 val2 = (treg == 0) ? dsp_get_ax_l(1) : dsp_get_ax_h(1);
|
|
|
|
sint64 prod = val1 * val2 * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
|
|
Update_SR_Register(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_mulxmv(uint16 opc)
|
|
{
|
|
// add old prod to acc
|
|
uint8 rreg = ((opc >> 8) & 0x1);
|
|
sint64 acR = dsp_get_long_prod();
|
|
dsp_set_long_acc(rreg, acR);
|
|
|
|
// math new prod
|
|
uint8 sreg = (opc >> 12) & 0x1;
|
|
uint8 treg = (opc >> 11) & 0x1;
|
|
|
|
sint64 val1 = (sreg == 0) ? dsp_get_ax_l(0) : dsp_get_ax_h(0);
|
|
sint64 val2 = (treg == 0) ? dsp_get_ax_l(1) : dsp_get_ax_h(1);
|
|
|
|
sint64 prod = val1 * val2 * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
|
|
Update_SR_Register(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_mulxmvz(uint16 opc)
|
|
{
|
|
// overwrite acc and clear low part
|
|
uint8 rreg = (opc >> 8) & 0x1;
|
|
sint64 prod = dsp_get_long_prod();
|
|
sint64 acc = prod & ~0xffff;
|
|
dsp_set_long_acc(rreg, acc);
|
|
|
|
// math prod
|
|
uint8 sreg = (opc >> 12) & 0x1;
|
|
uint8 treg = (opc >> 11) & 0x1;
|
|
|
|
sint64 val1 = (sreg == 0) ? dsp_get_ax_l(0) : dsp_get_ax_h(0);
|
|
sint64 val2 = (treg == 0) ? dsp_get_ax_l(1) : dsp_get_ax_h(1);
|
|
|
|
prod = val1 * val2 * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
|
|
Update_SR_Register(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_sub(uint16 opc)
|
|
{
|
|
uint8 D = (opc >> 8) & 0x1;
|
|
sint64 Acc1 = dsp_get_long_acc(D);
|
|
sint64 Acc2 = dsp_get_long_acc(1 - D);
|
|
|
|
Acc1 -= Acc2;
|
|
|
|
dsp_set_long_acc(D, Acc1);
|
|
}
|
|
|
|
|
|
//-------------------------------------------------------------
|
|
//
|
|
// --- Table E
|
|
//
|
|
//-------------------------------------------------------------
|
|
|
|
// NEW
|
|
void dsp_opc_maddx(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 9) & 0x1;
|
|
uint8 treg = (opc >> 8) & 0x1;
|
|
|
|
sint64 val1 = (sreg == 0) ? dsp_get_ax_l(0) : dsp_get_ax_h(0);
|
|
sint64 val2 = (treg == 0) ? dsp_get_ax_l(1) : dsp_get_ax_h(1);
|
|
|
|
sint64 prod = dsp_get_long_prod();
|
|
prod += val1 * val2 * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_msubx(uint16 opc)
|
|
{
|
|
uint8 sreg = (opc >> 9) & 0x1;
|
|
uint8 treg = (opc >> 8) & 0x1;
|
|
|
|
sint64 val1 = (sreg == 0) ? dsp_get_ax_l(0) : dsp_get_ax_h(0);
|
|
sint64 val2 = (treg == 0) ? dsp_get_ax_l(1) : dsp_get_ax_h(1);
|
|
|
|
sint64 prod = dsp_get_long_prod();
|
|
prod -= val1 * val2 * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_maddc(uint16 opc)
|
|
{
|
|
uint sreg = (opc >> 9) & 0x1;
|
|
uint treg = (opc >> 8) & 0x1;
|
|
|
|
sint64 val1 = dsp_get_acc_m(sreg);
|
|
sint64 val2 = dsp_get_ax_h(treg);
|
|
|
|
sint64 prod = dsp_get_long_prod();
|
|
prod += val1 * val2 * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
}
|
|
|
|
|
|
// NEW
|
|
void dsp_opc_msubc(uint16 opc)
|
|
{
|
|
uint sreg = (opc >> 9) & 0x1;
|
|
uint treg = (opc >> 8) & 0x1;
|
|
|
|
sint64 val1 = dsp_get_acc_m(sreg);
|
|
sint64 val2 = dsp_get_ax_h(treg);
|
|
|
|
sint64 prod = dsp_get_long_prod();
|
|
prod -= val1 * val2 * GetMultiplyModifier();
|
|
dsp_set_long_prod(prod);
|
|
}
|
|
|
|
|
|
//-------------------------------------------------------------
|
|
void dsp_op0(uint16 opc)
|
|
{
|
|
if (opc == 0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x0:
|
|
|
|
switch ((opc >> 4) & 0xf)
|
|
{
|
|
case 0x0:
|
|
|
|
switch (opc & 0xf)
|
|
{
|
|
case 0x4:
|
|
case 0x5:
|
|
case 0x6:
|
|
case 0x7:
|
|
dsp_opc_dar(opc);
|
|
break;
|
|
|
|
case 0x8:
|
|
case 0x9:
|
|
case 0xa:
|
|
case 0xb:
|
|
dsp_opc_iar(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op0");
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x1:
|
|
dsp_opc_addarn(opc);
|
|
break;
|
|
|
|
case 0x2: // HALT
|
|
dsp_opc_halt(opc);
|
|
break;
|
|
|
|
case 0x4: // LOOP
|
|
case 0x5: // LOOP
|
|
dsp_opc_loop(opc);
|
|
break;
|
|
|
|
case 0x6: // BLOOP
|
|
case 0x7: // BLOOP
|
|
dsp_opc_bloop(opc);
|
|
break;
|
|
|
|
case 0x8: // LRI
|
|
case 0x9: // LRI
|
|
dsp_opc_lri(opc);
|
|
break;
|
|
|
|
case 0xC: // LR
|
|
case 0xD: // LR
|
|
dsp_opc_lr(opc);
|
|
break;
|
|
|
|
case 0xE: // SR
|
|
case 0xF: // SR
|
|
dsp_opc_sr(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op0");
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x2:
|
|
|
|
switch ((opc >> 4) & 0xf)
|
|
{
|
|
case 0x0: // ADDI
|
|
dsp_opc_addi(opc);
|
|
break;
|
|
|
|
case 0x1: // IL
|
|
dsp_opc_ilrr(opc);
|
|
break;
|
|
|
|
case 0x2: // XORI
|
|
dsp_opc_xori(opc);
|
|
break;
|
|
|
|
case 0x4: // ANDI
|
|
dsp_opc_andi(opc);
|
|
break;
|
|
|
|
case 0x6: // ORI
|
|
dsp_opc_ori(opc);
|
|
break;
|
|
|
|
case 0x7: //
|
|
dsp_opc_ifcc(opc);
|
|
break;
|
|
|
|
case 0x8: // SUBF
|
|
dsp_opc_subf(opc);
|
|
break;
|
|
|
|
case 0x9: // Jxx
|
|
dsp_opc_jcc(opc);
|
|
break;
|
|
|
|
case 0xa: // ANDF
|
|
dsp_opc_andf(opc);
|
|
break;
|
|
|
|
case 0xb: // CALL
|
|
dsp_opc_call(opc);
|
|
break;
|
|
|
|
case 0xc:
|
|
dsp_opc_andfc(opc);
|
|
break;
|
|
|
|
case 0xd: // RET
|
|
dsp_opc_ret(opc);
|
|
break;
|
|
|
|
case 0xf: // RTI
|
|
dsp_opc_rti(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op0");
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x3:
|
|
|
|
switch ((opc >> 4) & 0xf)
|
|
{
|
|
case 0x0: // ADDAI
|
|
dsp_opc_addi(opc);
|
|
break;
|
|
|
|
case 0x1: // ILR
|
|
dsp_opc_ilrr(opc);
|
|
break;
|
|
|
|
case 0x2: // XORI
|
|
dsp_opc_xori(opc);
|
|
break;
|
|
|
|
case 0x4: // ANDI
|
|
dsp_opc_andi(opc);
|
|
break;
|
|
|
|
case 0x6: // ORI
|
|
dsp_opc_ori(opc);
|
|
break;
|
|
|
|
case 0x8: // SUBF
|
|
dsp_opc_subf(opc);
|
|
break;
|
|
|
|
case 0xa: // ANDF
|
|
dsp_opc_andf(opc);
|
|
break;
|
|
|
|
case 0xc: // ANDFC
|
|
dsp_opc_andfc(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op0");
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x4:
|
|
case 0x5:
|
|
dsp_opc_addis(opc);
|
|
break;
|
|
|
|
case 0x6: // SUBISF
|
|
case 0x7:
|
|
dsp_opc_cmpis(opc);
|
|
break;
|
|
|
|
case 0x8: // LRIS
|
|
case 0x9:
|
|
case 0xa:
|
|
case 0xb:
|
|
case 0xc:
|
|
case 0xd:
|
|
case 0xe:
|
|
case 0xf:
|
|
dsp_opc_lris(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op0");
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_op1(uint16 opc)
|
|
{
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x0:
|
|
dsp_opc_loopi(opc);
|
|
break;
|
|
|
|
case 0x1: // BLOOPI
|
|
dsp_opc_bloopi(opc);
|
|
break;
|
|
|
|
case 0x2: // SBCLR
|
|
dsp_opc_sbclr(opc);
|
|
break;
|
|
|
|
case 0x3: // SBSET
|
|
dsp_opc_sbset(opc);
|
|
break;
|
|
|
|
case 0x4: // shifti
|
|
case 0x5:
|
|
dsp_opc_shifti(opc);
|
|
break;
|
|
|
|
case 0x6: // SI
|
|
dsp_opc_si(opc);
|
|
break;
|
|
|
|
case 0x7: // JMPA/CALLA
|
|
dsp_opc_jmpa(opc);
|
|
break;
|
|
|
|
case 0x8: // LRRx
|
|
case 0x9: // LRRx
|
|
dsp_opc_lrr(opc);
|
|
break;
|
|
|
|
case 0xa: // SRRx
|
|
case 0xb: // SRRx
|
|
dsp_opc_srr(opc);
|
|
break;
|
|
|
|
case 0xc: // MRR
|
|
case 0xd: // MRR
|
|
case 0xe: // MRR
|
|
case 0xf: // MRR
|
|
dsp_opc_mrr(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op1");
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_op2(uint16 opc)
|
|
{
|
|
// lrs, srs
|
|
uint8 reg = ((opc >> 8) & 0x7) + 0x18;
|
|
uint16 addr = (sint8) opc;
|
|
|
|
if (opc & 0x0800)
|
|
{
|
|
// srs
|
|
dsp_dmem_write(addr, g_dsp.r[reg]);
|
|
}
|
|
else
|
|
{
|
|
// lrs
|
|
g_dsp.r[reg] = dsp_dmem_read(addr);
|
|
}
|
|
}
|
|
|
|
|
|
void dsp_op3(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x0:
|
|
case 0x1:
|
|
case 0x2:
|
|
case 0x3:
|
|
dsp_opc_xorr(opc);
|
|
break;
|
|
|
|
case 0x4:
|
|
case 0x5:
|
|
case 0x6:
|
|
case 0x7:
|
|
dsp_opc_andr(opc);
|
|
break;
|
|
|
|
case 0x8:
|
|
case 0x9:
|
|
case 0xa:
|
|
case 0xb:
|
|
dsp_opc_orr(opc);
|
|
break;
|
|
|
|
case 0xc:
|
|
case 0xd:
|
|
dsp_opc_andc(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op3");
|
|
break;
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_op4(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x0:
|
|
case 0x1:
|
|
case 0x2:
|
|
case 0x3:
|
|
case 0x4:
|
|
case 0x5:
|
|
case 0x6:
|
|
case 0x7:
|
|
dsp_opc_addr(opc);
|
|
break;
|
|
|
|
case 0x8:
|
|
case 0x9:
|
|
case 0xa:
|
|
case 0xb:
|
|
dsp_opc_addax(opc);
|
|
break;
|
|
|
|
case 0xc:
|
|
case 0xd:
|
|
dsp_opc_add(opc);
|
|
break;
|
|
|
|
case 0xe:
|
|
case 0xf:
|
|
dsp_opc_addp(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op4");
|
|
break;
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_op5(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x0:
|
|
case 0x1:
|
|
case 0x2:
|
|
case 0x3:
|
|
case 0x4:
|
|
case 0x5:
|
|
case 0x6:
|
|
case 0x7:
|
|
dsp_opc_subr(opc);
|
|
break;
|
|
|
|
case 0x8:
|
|
case 0x9:
|
|
case 0xa:
|
|
case 0xb:
|
|
dsp_opc_subax(opc);
|
|
break;
|
|
|
|
case 0xc:
|
|
case 0xd:
|
|
dsp_opc_sub(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op5: %x", (opc >> 8) & 0xf);
|
|
break;
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_op6(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x00: // MOVR
|
|
case 0x01:
|
|
case 0x02:
|
|
case 0x03:
|
|
case 0x04:
|
|
case 0x05:
|
|
case 0x06:
|
|
case 0x07:
|
|
dsp_opc_movr(opc);
|
|
break;
|
|
|
|
case 0x8: // MVAXA
|
|
case 0x9:
|
|
case 0xa:
|
|
case 0xb:
|
|
dsp_opc_movax(opc);
|
|
break;
|
|
|
|
case 0xe:
|
|
case 0xf:
|
|
dsp_opc_movp(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op6");
|
|
break;
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_op7(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x0:
|
|
case 0x1:
|
|
case 0x2:
|
|
case 0x3:
|
|
dsp_opc_addaxl(opc);
|
|
break;
|
|
|
|
case 0x4:
|
|
case 0x5:
|
|
dsp_opc_incm(opc);
|
|
break;
|
|
|
|
case 0x6:
|
|
case 0x7:
|
|
dsp_opc_inc(opc);
|
|
break;
|
|
|
|
case 0x8:
|
|
case 0x9:
|
|
dsp_opc_decm(opc);
|
|
break;
|
|
|
|
case 0xa:
|
|
case 0xb:
|
|
dsp_opc_dec(opc);
|
|
break;
|
|
|
|
case 0xc:
|
|
case 0xd:
|
|
dsp_opc_neg(opc);
|
|
break;
|
|
|
|
case 0xe:
|
|
case 0xf:
|
|
dsp_opc_movnp(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op7");
|
|
break;
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_op8(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x0:
|
|
case 0x8:
|
|
dsp_opc_nx(opc);
|
|
break;
|
|
|
|
case 0x1: // CLR 0
|
|
case 0x9: // CLR 1
|
|
dsp_opc_clr(opc);
|
|
break;
|
|
|
|
case 0x2: // CMP
|
|
dsp_opc_cmp(opc);
|
|
break;
|
|
|
|
case 0x4: // CLRP
|
|
dsp_opc_clrp(opc);
|
|
break;
|
|
|
|
case 0x6:
|
|
case 0x7:
|
|
dsp_opc_tstaxh(opc);
|
|
break;
|
|
|
|
case 0xc:
|
|
case 0xb:
|
|
case 0xe: // SET40
|
|
case 0xd:
|
|
case 0xa:
|
|
case 0xf:
|
|
dsp_opc_srbith(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op8");
|
|
break;
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_op9(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x02:
|
|
case 0x03:
|
|
case 0x0a:
|
|
case 0x0b:
|
|
dsp_opc_mulmvz(opc);
|
|
break;
|
|
|
|
case 0x04:
|
|
case 0x05:
|
|
case 0x0c:
|
|
case 0x0d:
|
|
dsp_opc_mulac(opc);
|
|
break;
|
|
|
|
case 0x6:
|
|
case 0x7:
|
|
case 0xe:
|
|
case 0xf:
|
|
dsp_opc_mulmv(opc);
|
|
break;
|
|
|
|
case 0x0:
|
|
case 0x8:
|
|
dsp_opc_mul(opc);
|
|
break;
|
|
|
|
case 0x1:
|
|
case 0x9:
|
|
dsp_opc_asr16(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_op9");
|
|
break;
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_opab(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0x7)
|
|
{
|
|
case 0x0:
|
|
dsp_opc_mulx(opc);
|
|
break;
|
|
|
|
case 0x1:
|
|
dsp_opc_tsta(opc);
|
|
break;
|
|
|
|
case 0x2:
|
|
case 0x3:
|
|
dsp_opc_mulxmvz(opc);
|
|
break;
|
|
|
|
case 0x4:
|
|
case 0x5:
|
|
dsp_opc_mulxac(opc);
|
|
break;
|
|
|
|
case 0x6:
|
|
case 0x7:
|
|
dsp_opc_mulxmv(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_opab");
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_opcd(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0x7)
|
|
{
|
|
case 0x0: // MULC
|
|
dsp_opc_mulc(opc);
|
|
break;
|
|
|
|
case 0x1: // CMPAR
|
|
dsp_opc_cmpar(opc);
|
|
break;
|
|
|
|
case 0x2: // MULCMVZ
|
|
case 0x3:
|
|
dsp_opc_mulcmvz(opc);
|
|
break;
|
|
|
|
case 0x4: // MULCAC
|
|
case 0x5:
|
|
dsp_opc_mulcac(opc);
|
|
break;
|
|
|
|
case 0x6: // MULCMV
|
|
case 0x7:
|
|
dsp_opc_mulcmv(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_opcd");
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_ope(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 10) & 0x3)
|
|
{
|
|
case 0x00: // MADDX
|
|
dsp_opc_maddx(opc);
|
|
break;
|
|
|
|
case 0x01: // MSUBX
|
|
dsp_opc_msubx(opc);
|
|
break;
|
|
|
|
case 0x02: // MADDC
|
|
dsp_opc_maddc(opc);
|
|
break;
|
|
|
|
case 0x03: // MSUBC
|
|
dsp_opc_msubc(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_ope");
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|
|
void dsp_opf(uint16 opc)
|
|
{
|
|
dsp_op_ext_ops_pro(opc);
|
|
|
|
switch ((opc >> 8) & 0xf)
|
|
{
|
|
case 0x0:
|
|
case 0x1:
|
|
dsp_opc_lsl16(opc);
|
|
break;
|
|
|
|
case 0x02:
|
|
case 0x03:
|
|
dsp_opc_madd(opc);
|
|
break;
|
|
|
|
case 0x4:
|
|
case 0x5:
|
|
dsp_opc_lsr16(opc);
|
|
break;
|
|
|
|
case 0x8:
|
|
case 0x9:
|
|
case 0xa:
|
|
case 0xb:
|
|
dsp_opc_addpaxz(opc);
|
|
break;
|
|
|
|
case 0xe:
|
|
case 0xf:
|
|
dsp_opc_movpz(opc);
|
|
break;
|
|
|
|
default:
|
|
ErrorLog("dsp_opf");
|
|
break;
|
|
}
|
|
|
|
dsp_op_ext_ops_epi(opc);
|
|
}
|
|
|
|
|