2016-01-27 09:11:59 +00:00
|
|
|
#include <windows.h>
|
|
|
|
#include <stdio.h>
|
|
|
|
#include <math.h>
|
2016-02-11 08:04:45 +00:00
|
|
|
#include "Rsp.h"
|
2016-01-27 09:11:59 +00:00
|
|
|
#include "CPU.h"
|
|
|
|
#include "RSP Command.h"
|
|
|
|
#include "RSP Registers.h"
|
|
|
|
#include "Interpreter CPU.h"
|
|
|
|
#include "memory.h"
|
|
|
|
#include "dma.h"
|
|
|
|
#include "log.h"
|
|
|
|
#include "x86.h"
|
2016-02-14 18:49:47 +00:00
|
|
|
#include "Types.h"
|
2016-01-27 09:11:59 +00:00
|
|
|
|
|
|
|
#include <float.h>
|
2021-03-19 06:38:30 +00:00
|
|
|
|
|
|
|
// TODO: Is this still an issue? If so, investigate, and if not, remove this!
|
2016-01-27 09:11:59 +00:00
|
|
|
/*
|
|
|
|
* Unfortunately, GCC 4.8.2 stable still has a bug with their <float.h> that
|
|
|
|
* includes a different copy of <float.h> from a different directory.
|
|
|
|
*
|
|
|
|
* Until that bug is fixed, the below macro definitions can be forced.
|
|
|
|
*
|
|
|
|
* It also is possible to emulate the RSP divide op-codes using a hardware-
|
|
|
|
* accurate LUT instead of any floating-point functions, so that works, too.
|
|
|
|
*/
|
2021-03-19 06:38:30 +00:00
|
|
|
|
2016-01-27 09:11:59 +00:00
|
|
|
#ifndef _MCW_RC
|
|
|
|
#define _MCW_RC 0x00000300
|
|
|
|
#endif
|
|
|
|
#ifndef _RC_CHOP
|
|
|
|
#define _RC_CHOP 0x00000300
|
|
|
|
#endif
|
|
|
|
|
|
|
|
extern UWORD32 Recp, RecpResult, SQroot, SQrootResult;
|
2016-02-14 18:49:47 +00:00
|
|
|
extern Boolean AudioHle, GraphicsHle;
|
2016-01-27 09:11:59 +00:00
|
|
|
|
2021-03-19 06:38:30 +00:00
|
|
|
// Opcode functions
|
|
|
|
|
2016-01-27 09:11:59 +00:00
|
|
|
void RSP_Opcode_SPECIAL ( void ) {
|
|
|
|
RSP_Special[ RSPOpC.funct ]();
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_REGIMM ( void ) {
|
|
|
|
RSP_RegImm[ RSPOpC.rt ]();
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_J ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_JumpTo = (RSPOpC.target << 2) & 0xFFC;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_JAL ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_GPR[31].UW = ( *PrgCount + 8 ) & 0xFFC;
|
|
|
|
RSP_JumpTo = (RSPOpC.target << 2) & 0xFFC;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_BEQ ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_JumpTo = RSP_branch_if(RSP_GPR[RSPOpC.rs].W == RSP_GPR[RSPOpC.rt].W);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_BNE ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_JumpTo = RSP_branch_if(RSP_GPR[RSPOpC.rs].W != RSP_GPR[RSPOpC.rt].W);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_BLEZ ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_JumpTo = RSP_branch_if(RSP_GPR[RSPOpC.rs].W <= 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_BGTZ ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_JumpTo = RSP_branch_if(RSP_GPR[RSPOpC.rs].W > 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_ADDI ( void ) {
|
|
|
|
RSP_GPR[RSPOpC.rt].W = RSP_GPR[RSPOpC.rs].W + (int16_t)RSPOpC.immediate;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_ADDIU ( void ) {
|
|
|
|
RSP_GPR[RSPOpC.rt].UW = RSP_GPR[RSPOpC.rs].UW + (uint32_t)((int16_t)RSPOpC.immediate);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SLTI (void) {
|
|
|
|
RSP_GPR[RSPOpC.rt].W = (RSP_GPR[RSPOpC.rs].W < (int16_t)RSPOpC.immediate) ? 1 : 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SLTIU (void) {
|
|
|
|
RSP_GPR[RSPOpC.rt].W = (RSP_GPR[RSPOpC.rs].UW < (uint32_t)(int16_t)RSPOpC.immediate) ? 1 : 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_ANDI ( void ) {
|
|
|
|
RSP_GPR[RSPOpC.rt].W = RSP_GPR[RSPOpC.rs].W & RSPOpC.immediate;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_ORI ( void ) {
|
|
|
|
RSP_GPR[RSPOpC.rt].W = RSP_GPR[RSPOpC.rs].W | RSPOpC.immediate;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_XORI ( void ) {
|
|
|
|
RSP_GPR[RSPOpC.rt].W = RSP_GPR[RSPOpC.rs].W ^ RSPOpC.immediate;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LUI (void) {
|
|
|
|
RSP_GPR[RSPOpC.rt].W = RSPOpC.immediate << 16;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_COP0 (void) {
|
|
|
|
RSP_Cop0[ RSPOpC.rs ]();
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_COP2 (void) {
|
|
|
|
RSP_Cop2[ RSPOpC.rs ]();
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LB ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (short)RSPOpC.offset) & 0xFFF;
|
|
|
|
RSP_LB_DMEM( Address, &RSP_GPR[RSPOpC.rt].UB[0] );
|
|
|
|
RSP_GPR[RSPOpC.rt].W = RSP_GPR[RSPOpC.rt].B[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LH ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (short)RSPOpC.offset) & 0xFFF;
|
|
|
|
RSP_LH_DMEM( Address, &RSP_GPR[RSPOpC.rt].UHW[0] );
|
|
|
|
RSP_GPR[RSPOpC.rt].W = RSP_GPR[RSPOpC.rt].HW[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LW ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (short)RSPOpC.offset) & 0xFFF;
|
|
|
|
RSP_LW_DMEM( Address, &RSP_GPR[RSPOpC.rt].UW );
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LBU ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (short)RSPOpC.offset) & 0xFFF;
|
|
|
|
RSP_LB_DMEM( Address, &RSP_GPR[RSPOpC.rt].UB[0] );
|
|
|
|
RSP_GPR[RSPOpC.rt].UW = RSP_GPR[RSPOpC.rt].UB[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LHU ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (short)RSPOpC.offset) & 0xFFF;
|
|
|
|
RSP_LH_DMEM( Address, &RSP_GPR[RSPOpC.rt].UHW[0] );
|
|
|
|
RSP_GPR[RSPOpC.rt].UW = RSP_GPR[RSPOpC.rt].UHW[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SB ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (short)RSPOpC.offset) & 0xFFF;
|
|
|
|
RSP_SB_DMEM( Address, RSP_GPR[RSPOpC.rt].UB[0] );
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SH ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (short)RSPOpC.offset) & 0xFFF;
|
|
|
|
RSP_SH_DMEM( Address, RSP_GPR[RSPOpC.rt].UHW[0] );
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SW ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (short)RSPOpC.offset) & 0xFFF;
|
|
|
|
RSP_SW_DMEM( Address, RSP_GPR[RSPOpC.rt].UW );
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LC2 (void) {
|
|
|
|
RSP_Lc2 [ RSPOpC.rd ]();
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SC2 (void) {
|
|
|
|
RSP_Sc2 [ RSPOpC.rd ]();
|
|
|
|
}
|
|
|
|
|
2021-03-19 06:38:30 +00:00
|
|
|
// R4300i Opcodes: Special
|
|
|
|
|
2016-01-27 09:11:59 +00:00
|
|
|
void RSP_Special_SLL ( void ) {
|
|
|
|
RSP_GPR[RSPOpC.rd].W = RSP_GPR[RSPOpC.rt].W << RSPOpC.sa;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_SRL ( void ) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = RSP_GPR[RSPOpC.rt].UW >> RSPOpC.sa;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_SRA ( void ) {
|
|
|
|
RSP_GPR[RSPOpC.rd].W = RSP_GPR[RSPOpC.rt].W >> RSPOpC.sa;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_SLLV (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].W = RSP_GPR[RSPOpC.rt].W << (RSP_GPR[RSPOpC.rs].W & 0x1F);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_SRLV (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = RSP_GPR[RSPOpC.rt].UW >> (RSP_GPR[RSPOpC.rs].W & 0x1F);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_SRAV (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].W = RSP_GPR[RSPOpC.rt].W >> (RSP_GPR[RSPOpC.rs].W & 0x1F);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_JR (void) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_JumpTo = (RSP_GPR[RSPOpC.rs].W & 0xFFC);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_JALR (void) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_GPR[RSPOpC.rd].W = (*PrgCount + 8) & 0xFFC;
|
|
|
|
RSP_JumpTo = (RSP_GPR[RSPOpC.rs].W & 0xFFC);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_BREAK ( void ) {
|
|
|
|
RSP_Running = FALSE;
|
|
|
|
*RSPInfo.SP_STATUS_REG |= (SP_STATUS_HALT | SP_STATUS_BROKE );
|
|
|
|
if ((*RSPInfo.SP_STATUS_REG & SP_STATUS_INTR_BREAK) != 0 ) {
|
|
|
|
*RSPInfo.MI_INTR_REG |= R4300i_SP_Intr;
|
|
|
|
RSPInfo.CheckInterrupts();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_ADD (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].W = RSP_GPR[RSPOpC.rs].W + RSP_GPR[RSPOpC.rt].W;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_ADDU (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = RSP_GPR[RSPOpC.rs].UW + RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_SUB (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].W = RSP_GPR[RSPOpC.rs].W - RSP_GPR[RSPOpC.rt].W;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_SUBU (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = RSP_GPR[RSPOpC.rs].UW - RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_AND (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = RSP_GPR[RSPOpC.rs].UW & RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_OR (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = RSP_GPR[RSPOpC.rs].UW | RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_XOR (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = RSP_GPR[RSPOpC.rs].UW ^ RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_NOR (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = ~(RSP_GPR[RSPOpC.rs].UW | RSP_GPR[RSPOpC.rt].UW);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_SLT (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = (RSP_GPR[RSPOpC.rs].W < RSP_GPR[RSPOpC.rt].W) ? 1 : 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Special_SLTU (void) {
|
|
|
|
RSP_GPR[RSPOpC.rd].UW = (RSP_GPR[RSPOpC.rs].UW < RSP_GPR[RSPOpC.rt].UW) ? 1 : 0;
|
|
|
|
}
|
|
|
|
|
2021-03-19 06:38:30 +00:00
|
|
|
// R4300i Opcodes: RegImm
|
|
|
|
|
2016-01-27 09:11:59 +00:00
|
|
|
void RSP_Opcode_BLTZ ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_JumpTo = RSP_branch_if(RSP_GPR[RSPOpC.rs].W < 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_BGEZ ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_JumpTo = RSP_branch_if(RSP_GPR[RSPOpC.rs].W >= 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_BLTZAL ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_GPR[31].UW = ( *PrgCount + 8 ) & 0xFFC;
|
|
|
|
RSP_JumpTo = RSP_branch_if(RSP_GPR[RSPOpC.rs].W < 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_BGEZAL ( void ) {
|
|
|
|
RSP_NextInstruction = DELAY_SLOT;
|
|
|
|
RSP_GPR[31].UW = ( *PrgCount + 8 ) & 0xFFC;
|
|
|
|
RSP_JumpTo = RSP_branch_if(RSP_GPR[RSPOpC.rs].W >= 0);
|
|
|
|
}
|
|
|
|
|
2021-03-19 06:38:30 +00:00
|
|
|
// COP0 functions
|
|
|
|
|
2016-01-27 09:11:59 +00:00
|
|
|
void RSP_Cop0_MF (void) {
|
|
|
|
if (LogRDP && CPUCore == InterpreterCPU)
|
|
|
|
{
|
|
|
|
RDP_LogMF0(*PrgCount,RSPOpC.rd);
|
|
|
|
}
|
|
|
|
switch (RSPOpC.rd) {
|
|
|
|
case 0: RSP_GPR[RSPOpC.rt].UW = *RSPInfo.SP_MEM_ADDR_REG; break;
|
|
|
|
case 1: RSP_GPR[RSPOpC.rt].UW = *RSPInfo.SP_DRAM_ADDR_REG; break;
|
|
|
|
case 4:
|
|
|
|
RSP_MfStatusCount += 1;
|
|
|
|
RSP_GPR[RSPOpC.rt].UW = *RSPInfo.SP_STATUS_REG;
|
2016-03-20 16:12:13 +00:00
|
|
|
if (Mfc0Count != 0 && RSP_MfStatusCount > Mfc0Count)
|
2016-01-27 09:11:59 +00:00
|
|
|
{
|
|
|
|
RSP_Running = FALSE;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 5: RSP_GPR[RSPOpC.rt].UW = *RSPInfo.SP_DMA_FULL_REG; break;
|
|
|
|
case 6: RSP_GPR[RSPOpC.rt].UW = *RSPInfo.SP_DMA_BUSY_REG; break;
|
|
|
|
case 7:
|
2016-03-20 19:06:39 +00:00
|
|
|
if (AudioHle || GraphicsHle || SemaphoreExit == 0)
|
2016-01-27 09:11:59 +00:00
|
|
|
{
|
|
|
|
RSP_GPR[RSPOpC.rt].W = 0;
|
|
|
|
} else {
|
|
|
|
RSP_GPR[RSPOpC.rt].W = *RSPInfo.SP_SEMAPHORE_REG;
|
|
|
|
*RSPInfo.SP_SEMAPHORE_REG = 1;
|
2016-03-20 19:06:39 +00:00
|
|
|
RSP_Running = FALSE;
|
2016-01-27 09:11:59 +00:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 8: RSP_GPR[RSPOpC.rt].UW = *RSPInfo.DPC_START_REG ; break;
|
|
|
|
case 9: RSP_GPR[RSPOpC.rt].UW = *RSPInfo.DPC_END_REG ; break;
|
|
|
|
case 10: RSP_GPR[RSPOpC.rt].UW = *RSPInfo.DPC_CURRENT_REG; break;
|
|
|
|
case 11: RSP_GPR[RSPOpC.rt].W = *RSPInfo.DPC_STATUS_REG; break;
|
|
|
|
case 12: RSP_GPR[RSPOpC.rt].W = *RSPInfo.DPC_CLOCK_REG; break;
|
|
|
|
default:
|
2021-03-19 06:38:30 +00:00
|
|
|
DisplayError("We have not implemented RSP MF CP0 reg %s (%d)",COP0_Name(RSPOpC.rd),RSPOpC.rd);
|
2016-01-27 09:11:59 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Cop0_MT (void) {
|
|
|
|
if (LogRDP && CPUCore == InterpreterCPU)
|
|
|
|
{
|
|
|
|
RDP_LogMT0(*PrgCount,RSPOpC.rd, RSP_GPR[RSPOpC.rt].UW);
|
|
|
|
}
|
|
|
|
switch (RSPOpC.rd) {
|
|
|
|
case 0: *RSPInfo.SP_MEM_ADDR_REG = RSP_GPR[RSPOpC.rt].UW; break;
|
|
|
|
case 1: *RSPInfo.SP_DRAM_ADDR_REG = RSP_GPR[RSPOpC.rt].UW; break;
|
|
|
|
case 2:
|
|
|
|
*RSPInfo.SP_RD_LEN_REG = RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
SP_DMA_READ();
|
|
|
|
break;
|
|
|
|
case 3:
|
|
|
|
*RSPInfo.SP_WR_LEN_REG = RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
SP_DMA_WRITE();
|
|
|
|
break;
|
|
|
|
case 4:
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_HALT ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_HALT; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_HALT ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_HALT; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_BROKE ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_BROKE; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_INTR ) != 0) { *RSPInfo.MI_INTR_REG &= ~R4300i_SP_Intr; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_INTR ) != 0)
|
|
|
|
{
|
|
|
|
*RSPInfo.MI_INTR_REG |= R4300i_SP_Intr;
|
|
|
|
RSPInfo.CheckInterrupts();
|
|
|
|
RSP_Running = FALSE;
|
|
|
|
}
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_SSTEP ) != 0)
|
|
|
|
{
|
|
|
|
*RSPInfo.SP_STATUS_REG &= ~SP_STATUS_SSTEP;
|
|
|
|
}
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_SSTEP ) != 0)
|
|
|
|
{
|
|
|
|
*RSPInfo.SP_STATUS_REG |= SP_STATUS_SSTEP;
|
|
|
|
RSP_NextInstruction = SINGLE_STEP;
|
|
|
|
}
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_INTR_BREAK ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_INTR_BREAK; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_INTR_BREAK ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_INTR_BREAK; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_SIG0 ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_SIG0; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_SIG0 ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_SIG0; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_SIG1 ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_SIG1; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_SIG1 ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_SIG1; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_SIG2 ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_SIG2; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_SIG2 ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_SIG2; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_SIG3 ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_SIG3; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_SIG3 ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_SIG3; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_SIG4 ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_SIG4; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_SIG4 ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_SIG4; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_SIG5 ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_SIG5; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_SIG5 ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_SIG5; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_SIG6 ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_SIG6; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_SIG6 ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_SIG6; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_CLR_SIG7 ) != 0) { *RSPInfo.SP_STATUS_REG &= ~SP_STATUS_SIG7; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & SP_SET_SIG7 ) != 0) { *RSPInfo.SP_STATUS_REG |= SP_STATUS_SIG7; }
|
|
|
|
break;
|
|
|
|
case 7: *RSPInfo.SP_SEMAPHORE_REG = 0; break;
|
|
|
|
case 8:
|
|
|
|
*RSPInfo.DPC_START_REG = RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
*RSPInfo.DPC_CURRENT_REG = RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
break;
|
|
|
|
case 9:
|
|
|
|
*RSPInfo.DPC_END_REG = RSP_GPR[RSPOpC.rt].UW;
|
|
|
|
RDP_LogDlist();
|
|
|
|
if (RSPInfo.ProcessRdpList != NULL) { RSPInfo.ProcessRdpList(); }
|
|
|
|
break;
|
|
|
|
case 10: *RSPInfo.DPC_CURRENT_REG = RSP_GPR[RSPOpC.rt].UW; break;
|
|
|
|
case 11:
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_CLR_XBUS_DMEM_DMA ) != 0) { *RSPInfo.DPC_STATUS_REG &= ~DPC_STATUS_XBUS_DMEM_DMA; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_SET_XBUS_DMEM_DMA ) != 0) { *RSPInfo.DPC_STATUS_REG |= DPC_STATUS_XBUS_DMEM_DMA; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_CLR_FREEZE ) != 0) { *RSPInfo.DPC_STATUS_REG &= ~DPC_STATUS_FREEZE; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_SET_FREEZE ) != 0) { *RSPInfo.DPC_STATUS_REG |= DPC_STATUS_FREEZE; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_CLR_FLUSH ) != 0) { *RSPInfo.DPC_STATUS_REG &= ~DPC_STATUS_FLUSH; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_SET_FLUSH ) != 0) { *RSPInfo.DPC_STATUS_REG |= DPC_STATUS_FLUSH; }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_CLR_TMEM_CTR ) != 0) { /* DisplayError("RSP: DPC_STATUS_REG: DPC_CLR_TMEM_CTR"); */ }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_CLR_PIPE_CTR ) != 0) { DisplayError("RSP: DPC_STATUS_REG: DPC_CLR_PIPE_CTR"); }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_CLR_CMD_CTR ) != 0) { DisplayError("RSP: DPC_STATUS_REG: DPC_CLR_CMD_CTR"); }
|
|
|
|
if ( ( RSP_GPR[RSPOpC.rt].W & DPC_CLR_CLOCK_CTR ) != 0) { /* DisplayError("RSP: DPC_STATUS_REG: DPC_CLR_CLOCK_CTR"); */ }
|
|
|
|
break;
|
|
|
|
default:
|
2021-03-19 06:38:30 +00:00
|
|
|
DisplayError("We have not implemented RSP MT CP0 reg %s (%d)",COP0_Name(RSPOpC.rd),RSPOpC.rd);
|
2016-01-27 09:11:59 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-03-19 06:38:30 +00:00
|
|
|
// COP2 functions
|
|
|
|
|
2016-01-27 09:11:59 +00:00
|
|
|
void RSP_Cop2_MF (void) {
|
|
|
|
int element = (RSPOpC.sa >> 1);
|
|
|
|
RSP_GPR[RSPOpC.rt].B[1] = RSP_Vect[RSPOpC.rd].B[15 - element];
|
|
|
|
RSP_GPR[RSPOpC.rt].B[0] = RSP_Vect[RSPOpC.rd].B[15 - ((element + 1) % 16)];
|
|
|
|
RSP_GPR[RSPOpC.rt].W = RSP_GPR[RSPOpC.rt].HW[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Cop2_CF (void) {
|
|
|
|
switch ((RSPOpC.rd & 0x03)) {
|
|
|
|
case 0: RSP_GPR[RSPOpC.rt].W = RSP_Flags[0].HW[0]; break;
|
|
|
|
case 1: RSP_GPR[RSPOpC.rt].W = RSP_Flags[1].HW[0]; break;
|
|
|
|
case 2: RSP_GPR[RSPOpC.rt].W = RSP_Flags[2].HW[0]; break;
|
|
|
|
case 3: RSP_GPR[RSPOpC.rt].W = RSP_Flags[2].HW[0]; break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Cop2_MT (void) {
|
|
|
|
int element = 15 - (RSPOpC.sa >> 1);
|
|
|
|
RSP_Vect[RSPOpC.rd].B[element] = RSP_GPR[RSPOpC.rt].B[1];
|
|
|
|
if (element != 0) {
|
|
|
|
RSP_Vect[RSPOpC.rd].B[element - 1] = RSP_GPR[RSPOpC.rt].B[0];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Cop2_CT (void) {
|
|
|
|
switch ((RSPOpC.rd & 0x03)) {
|
|
|
|
case 0: RSP_Flags[0].HW[0] = RSP_GPR[RSPOpC.rt].HW[0]; break;
|
|
|
|
case 1: RSP_Flags[1].HW[0] = RSP_GPR[RSPOpC.rt].HW[0]; break;
|
|
|
|
case 2: RSP_Flags[2].B[0] = RSP_GPR[RSPOpC.rt].B[0]; break;
|
|
|
|
case 3: RSP_Flags[2].B[0] = RSP_GPR[RSPOpC.rt].B[0]; break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_COP2_VECTOR (void) {
|
|
|
|
RSP_Vector[ RSPOpC.funct ]();
|
|
|
|
}
|
|
|
|
|
2021-03-19 06:38:30 +00:00
|
|
|
// Vector functions
|
|
|
|
|
2016-01-27 09:11:59 +00:00
|
|
|
void RSP_Vector_VMULF (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if (RSP_Vect[RSPOpC.rd].UHW[el] != 0x8000 || RSP_Vect[RSPOpC.rt].UHW[del] != 0x8000) {
|
|
|
|
temp.W = ((int32_t)RSP_Vect[RSPOpC.rd].HW[el] * (int32_t)RSP_Vect[RSPOpC.rt].HW[del]) << 1;
|
|
|
|
temp.UW += 0x8000;
|
|
|
|
RSP_ACCUM[el].HW[2] = temp.HW[1];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp.HW[0];
|
|
|
|
RSP_ACCUM[el].HW[3] = (RSP_ACCUM[el].HW[2] < 0) ? -1 : 0;
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
} else {
|
|
|
|
temp.W = 0x80000000;
|
|
|
|
RSP_ACCUM[el].UHW[3] = 0;
|
|
|
|
RSP_ACCUM[el].UHW[2] = 0x8000;
|
|
|
|
RSP_ACCUM[el].UHW[1] = 0x8000;
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMULU (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
RSP_ACCUM[el].DW = (int64_t)(RSP_Vect[RSPOpC.rd].HW[el] * RSP_Vect[RSPOpC.rt].HW[del]) << 17;
|
|
|
|
RSP_ACCUM[el].DW += 0x80000000;
|
|
|
|
if (RSP_ACCUM[el].DW < 0) {
|
|
|
|
result.HW[el] = 0;
|
|
|
|
} else if ((int16_t)(RSP_ACCUM[el].UHW[3] ^ RSP_ACCUM[el].UHW[2]) < 0) {
|
|
|
|
result.HW[el] = -1;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMUDL (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.UW = (uint32_t)RSP_Vect[RSPOpC.rd].UHW[el] * (uint32_t)RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_ACCUM[el].W[1] = 0;
|
|
|
|
RSP_ACCUM[el].HW[1] = temp.HW[1];
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[1];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMUDM (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.UW = (uint32_t)((int32_t)RSP_Vect[RSPOpC.rd].HW[el]) * (uint32_t)RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
if (temp.W < 0) {
|
|
|
|
RSP_ACCUM[el].HW[3] = -1;
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[3] = 0;
|
|
|
|
}
|
|
|
|
RSP_ACCUM[el].HW[2] = temp.HW[1];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp.HW[0];
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMUDN (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.UW = (uint32_t)RSP_Vect[RSPOpC.rd].UHW[el] * (uint32_t)((int32_t)RSP_Vect[RSPOpC.rt].HW[del]);
|
|
|
|
if (temp.W < 0) {
|
|
|
|
RSP_ACCUM[el].HW[3] = -1;
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[3] = 0;
|
|
|
|
}
|
|
|
|
RSP_ACCUM[el].HW[2] = temp.HW[1];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp.HW[0];
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[1];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMUDH (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
RSP_ACCUM[el].W[1] = (int32_t)RSP_Vect[RSPOpC.rd].HW[el] * (int32_t)RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
RSP_ACCUM[el].HW[1] = 0;
|
|
|
|
if (RSP_ACCUM[el].HW[3] < 0) {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0xFFFF) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] >= 0) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] < 0) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMACF (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
/*temp.W = (long)RSP_Vect[RSPOpC.rd].HW[el] * (long)(DWORD)RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
RSP_ACCUM[el].UHW[3] += (WORD)(temp.W >> 31);
|
|
|
|
temp.UW = temp.UW << 1;
|
|
|
|
temp2.UW = temp.UHW[0] + RSP_ACCUM[el].UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp2.HW[0];
|
|
|
|
temp2.UW = temp.UHW[1] + RSP_ACCUM[el].UHW[2] + temp2.UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[2] = temp2.HW[0];
|
|
|
|
RSP_ACCUM[el].HW[3] += temp2.HW[1];*/
|
|
|
|
temp.W = (int32_t)RSP_Vect[RSPOpC.rd].HW[el] * (int32_t)(uint32_t)RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
RSP_ACCUM[el].DW += ((int64_t)temp.W) << 17;
|
|
|
|
if (RSP_ACCUM[el].HW[3] < 0) {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0xFFFF) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] >= 0) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] < 0) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMACU (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp, temp2;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.W = (int32_t)RSP_Vect[RSPOpC.rd].HW[el] * (int32_t)(uint32_t)RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
RSP_ACCUM[el].UHW[3] = (RSP_ACCUM[el].UHW[3] + (WORD)(temp.W >> 31)) & 0xFFFF;
|
|
|
|
temp.UW = temp.UW << 1;
|
|
|
|
temp2.UW = temp.UHW[0] + RSP_ACCUM[el].UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp2.HW[0];
|
|
|
|
temp2.UW = temp.UHW[1] + RSP_ACCUM[el].UHW[2] + temp2.UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[2] = temp2.HW[0];
|
|
|
|
RSP_ACCUM[el].HW[3] += temp2.HW[1];
|
|
|
|
if (RSP_ACCUM[el].HW[3] < 0) {
|
|
|
|
result.HW[el] = 0;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0) {
|
|
|
|
result.UHW[el] = 0xFFFF;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] < 0) {
|
|
|
|
result.UHW[el] = 0xFFFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMACQ (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if (RSP_ACCUM[el].W[1] > 0x20) {
|
|
|
|
if ((RSP_ACCUM[el].W[1] & 0x20) == 0) {
|
|
|
|
RSP_ACCUM[el].W[1] -= 0x20;
|
|
|
|
}
|
|
|
|
} else if (RSP_ACCUM[el].W[1] < -0x20) {
|
|
|
|
if ((RSP_ACCUM[el].W[1] & 0x20) == 0) {
|
|
|
|
RSP_ACCUM[el].W[1] += 0x20;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
temp.W = RSP_ACCUM[el].W[1] >> 1;
|
|
|
|
if (temp.HW[1] < 0) {
|
|
|
|
if (temp.UHW[1] != 0xFFFF) {
|
|
|
|
result.HW[el] = (WORD)0x8000;
|
|
|
|
} else {
|
|
|
|
if (temp.HW[0] >= 0) {
|
|
|
|
result.HW[el] = (WORD)0x8000;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = (WORD)(temp.UW & 0xFFF0);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (temp.UHW[1] != 0) {
|
|
|
|
result.HW[el] = 0x7FF0;
|
|
|
|
} else {
|
|
|
|
if (temp.HW[0] < 0) {
|
|
|
|
result.HW[el] = 0x7FF0;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = (WORD)(temp.UW & 0xFFF0);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMADL (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp, temp2;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.UW = (uint32_t)RSP_Vect[RSPOpC.rd].UHW[el] * (uint32_t)RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
temp2.UW = temp.UHW[1] + RSP_ACCUM[el].UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp2.HW[0];
|
|
|
|
temp2.UW = RSP_ACCUM[el].UHW[2] + temp2.UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[2] = temp2.HW[0];
|
|
|
|
RSP_ACCUM[el].HW[3] += temp2.HW[1];
|
|
|
|
if (RSP_ACCUM[el].HW[3] < 0) {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0xFFFF) {
|
|
|
|
result.HW[el] = 0;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] >= 0) {
|
|
|
|
result.HW[el] = 0;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[1];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0) {
|
|
|
|
result.UHW[el] = 0xFFFF;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] < 0) {
|
|
|
|
result.UHW[el] = 0xFFFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[1];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMADM (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp, temp2;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.UW = (uint32_t)((int32_t)RSP_Vect[RSPOpC.rd].HW[el]) * (uint32_t)RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
temp2.UW = temp.UHW[0] + RSP_ACCUM[el].UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp2.HW[0];
|
|
|
|
temp2.UW = temp.UHW[1] + RSP_ACCUM[el].UHW[2] + temp2.UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[2] = temp2.HW[0];
|
|
|
|
RSP_ACCUM[el].HW[3] += temp2.HW[1];
|
|
|
|
if (temp.W < 0) {
|
|
|
|
RSP_ACCUM[el].HW[3] -= 1;
|
|
|
|
}
|
|
|
|
if (RSP_ACCUM[el].HW[3] < 0) {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0xFFFF) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] >= 0) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] < 0) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
//result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMADN (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp, temp2;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.UW = (uint32_t)RSP_Vect[RSPOpC.rd].UHW[el] * (uint32_t)((int32_t)RSP_Vect[RSPOpC.rt].HW[del]);
|
|
|
|
temp2.UW = temp.UHW[0] + RSP_ACCUM[el].UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp2.HW[0];
|
|
|
|
temp2.UW = temp.UHW[1] + RSP_ACCUM[el].UHW[2] + temp2.UHW[1];
|
|
|
|
RSP_ACCUM[el].HW[2] = temp2.HW[0];
|
|
|
|
RSP_ACCUM[el].HW[3] += temp2.HW[1];
|
|
|
|
if (temp.W < 0) {
|
|
|
|
RSP_ACCUM[el].HW[3] -= 1;
|
|
|
|
}
|
|
|
|
if (RSP_ACCUM[el].HW[3] < 0) {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0xFFFF) {
|
|
|
|
result.HW[el] = 0;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] >= 0) {
|
|
|
|
result.HW[el] = 0;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[1];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0) {
|
|
|
|
result.UHW[el] = 0xFFFF;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] < 0) {
|
|
|
|
result.UHW[el] = 0xFFFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[1];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMADH (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0; el < 8; el ++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
RSP_ACCUM[el].W[1] += (int32_t)RSP_Vect[RSPOpC.rd].HW[el] * (int32_t)RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
if (RSP_ACCUM[el].HW[3] < 0) {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0xFFFF) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] >= 0) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].UHW[3] != 0) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
if (RSP_ACCUM[el].HW[2] < 0) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[2];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VADD (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.W = (int)RSP_Vect[RSPOpC.rd].HW[el] + (int)RSP_Vect[RSPOpC.rt].HW[del] +
|
|
|
|
((RSP_Flags[0].UW >> (7 - el)) & 0x1);
|
|
|
|
RSP_ACCUM[el].HW[1] = temp.HW[0];
|
|
|
|
if ((temp.HW[0] & 0x8000) == 0) {
|
|
|
|
if (temp.HW[1] != 0) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = temp.HW[0];
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (temp.HW[1] != -1 ) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = temp.HW[0];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VSUB (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.W = (int)RSP_Vect[RSPOpC.rd].HW[el] - (int)RSP_Vect[RSPOpC.rt].HW[del] -
|
|
|
|
((RSP_Flags[0].UW >> (7 - el)) & 0x1);
|
|
|
|
RSP_ACCUM[el].HW[1] = temp.HW[0];
|
|
|
|
if ((temp.HW[0] & 0x8000) == 0) {
|
|
|
|
if (temp.HW[1] != 0) {
|
|
|
|
result.HW[el] = 0x8000;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = temp.HW[0];
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (temp.HW[1] != -1 ) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = temp.HW[0];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VABS (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] > 0) {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
} else if (RSP_Vect[RSPOpC.rd].HW[el] < 0) {
|
|
|
|
if (RSP_Vect[RSPOpC.rt].UHW[del] == 0x8000) {
|
|
|
|
result.HW[el] = 0x7FFF;
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rt].HW[del] * -1;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
result.HW[el] = 0;
|
|
|
|
}
|
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VADDC (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
for ( el = 0; el < 8; el++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.UW = (int)RSP_Vect[RSPOpC.rd].UHW[el] + (int)RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp.HW[0];
|
|
|
|
result.HW[el] = temp.HW[0];
|
|
|
|
if (temp.UW & 0xffff0000) {
|
|
|
|
RSP_Flags[0].UW |= ( 1 << (7 - el) );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VSUBC (void) {
|
|
|
|
int el, del;
|
|
|
|
UWORD32 temp;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
RSP_Flags[0].UW = 0x0;
|
|
|
|
for ( el = 0; el < 8; el++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
temp.UW = (int)RSP_Vect[RSPOpC.rd].UHW[el] - (int)RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_ACCUM[el].HW[1] = temp.HW[0];
|
|
|
|
result.HW[el] = temp.HW[0];
|
|
|
|
if (temp.HW[0] != 0) {
|
|
|
|
RSP_Flags[0].UW |= ( 0x1 << (15 - el) );
|
|
|
|
}
|
|
|
|
if (temp.UW & 0xffff0000) {
|
|
|
|
RSP_Flags[0].UW |= ( 0x1 << (7 - el) );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VSAW (void) {
|
|
|
|
VECTOR result;
|
|
|
|
|
|
|
|
switch ((RSPOpC.rs & 0xF)) {
|
|
|
|
case 8:
|
|
|
|
result.HW[0] = RSP_ACCUM[0].HW[3];
|
|
|
|
result.HW[1] = RSP_ACCUM[1].HW[3];
|
|
|
|
result.HW[2] = RSP_ACCUM[2].HW[3];
|
|
|
|
result.HW[3] = RSP_ACCUM[3].HW[3];
|
|
|
|
result.HW[4] = RSP_ACCUM[4].HW[3];
|
|
|
|
result.HW[5] = RSP_ACCUM[5].HW[3];
|
|
|
|
result.HW[6] = RSP_ACCUM[6].HW[3];
|
|
|
|
result.HW[7] = RSP_ACCUM[7].HW[3];
|
|
|
|
break;
|
|
|
|
case 9:
|
|
|
|
result.HW[0] = RSP_ACCUM[0].HW[2];
|
|
|
|
result.HW[1] = RSP_ACCUM[1].HW[2];
|
|
|
|
result.HW[2] = RSP_ACCUM[2].HW[2];
|
|
|
|
result.HW[3] = RSP_ACCUM[3].HW[2];
|
|
|
|
result.HW[4] = RSP_ACCUM[4].HW[2];
|
|
|
|
result.HW[5] = RSP_ACCUM[5].HW[2];
|
|
|
|
result.HW[6] = RSP_ACCUM[6].HW[2];
|
|
|
|
result.HW[7] = RSP_ACCUM[7].HW[2];
|
|
|
|
break;
|
|
|
|
case 10:
|
|
|
|
result.HW[0] = RSP_ACCUM[0].HW[1];
|
|
|
|
result.HW[1] = RSP_ACCUM[1].HW[1];
|
|
|
|
result.HW[2] = RSP_ACCUM[2].HW[1];
|
|
|
|
result.HW[3] = RSP_ACCUM[3].HW[1];
|
|
|
|
result.HW[4] = RSP_ACCUM[4].HW[1];
|
|
|
|
result.HW[5] = RSP_ACCUM[5].HW[1];
|
|
|
|
result.HW[6] = RSP_ACCUM[6].HW[1];
|
|
|
|
result.HW[7] = RSP_ACCUM[7].HW[1];
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
result.DW[1] = 0;
|
|
|
|
result.DW[0] = 0;
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VLT (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
RSP_Flags[1].UW = 0;
|
|
|
|
for ( el = 0; el < 8; el++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] < RSP_Vect[RSPOpC.rt].HW[del]) {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rd].UHW[el];
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el) );
|
|
|
|
} else if (RSP_Vect[RSPOpC.rd].HW[el] != RSP_Vect[RSPOpC.rt].HW[del]) {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_Flags[1].UW &= ~( 1 << (7 - el) );
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rd].UHW[el];
|
|
|
|
if ( (RSP_Flags[0].UW & (0x101 << (7 - el))) == (WORD)(0x101 << (7 - el))) {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el) );
|
|
|
|
} else {
|
|
|
|
RSP_Flags[1].UW &= ~( 1 << (7 - el) );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el];
|
|
|
|
}
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VEQ (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
RSP_Flags[1].UW = 0;
|
|
|
|
for ( el = 0; el < 8; el++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if (RSP_Vect[RSPOpC.rd].UHW[el] == RSP_Vect[RSPOpC.rt].UHW[del]) {
|
|
|
|
if ( (RSP_Flags[0].UW & (1 << (15 - el))) == 0) {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
}
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VNE (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
RSP_Flags[1].UW = 0;
|
|
|
|
for ( el = 0; el < 8; el++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if (RSP_Vect[RSPOpC.rd].UHW[el] != RSP_Vect[RSPOpC.rt].UHW[del]) {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el) );
|
|
|
|
} else {
|
|
|
|
if ( (RSP_Flags[0].UW & (1 << (15 - el))) != 0) {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el) );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rd].UHW[el];
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].UHW[el];
|
|
|
|
}
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VGE (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
RSP_Flags[1].UW = 0;
|
|
|
|
for ( el = 0; el < 8; el++ ) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] == RSP_Vect[RSPOpC.rt].HW[del]) {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rd].UHW[el];
|
|
|
|
if ( (RSP_Flags[0].UW & (0x101 << (7 - el))) == (WORD)(0x101 << (7 - el))) {
|
|
|
|
RSP_Flags[1].UW &= ~( 1 << (7 - el) );
|
|
|
|
} else {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el) );
|
|
|
|
}
|
|
|
|
} else if (RSP_Vect[RSPOpC.rd].HW[el] > RSP_Vect[RSPOpC.rt].HW[del]) {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rd].UHW[el];
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el) );
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_Flags[1].UW &= ~( 1 << (7 - el) );
|
|
|
|
}
|
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el];
|
|
|
|
}
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VCL (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for (el = 0;el < 8; el++) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if ((RSP_Flags[0].UW & ( 1 << (7 - el))) != 0 ) {
|
|
|
|
if ((RSP_Flags[0].UW & ( 1 << (15 - el))) != 0 ) {
|
|
|
|
if ((RSP_Flags[1].UW & ( 1 << (7 - el))) != 0 ) {
|
|
|
|
RSP_ACCUM[el].HW[1] = -RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if ((RSP_Flags[2].UW & ( 1 << (7 - el)))) {
|
|
|
|
if ( RSP_Vect[RSPOpC.rd].UHW[el] + RSP_Vect[RSPOpC.rt].UHW[del] > 0x10000) {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
RSP_Flags[1].UW &= ~(1 << (7 - el));
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[1] = -RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_Flags[1].UW |= (1 << (7 - el));
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (RSP_Vect[RSPOpC.rt].UHW[del] + RSP_Vect[RSPOpC.rd].UHW[el] != 0) {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
RSP_Flags[1].UW &= ~(1 << (7 - el));
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[1] = -RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_Flags[1].UW |= (1 << (7 - el));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if ((RSP_Flags[0].UW & ( 1 << (15 - el))) != 0 ) {
|
|
|
|
if ((RSP_Flags[1].UW & ( 1 << (15 - el))) != 0 ) {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if ( RSP_Vect[RSPOpC.rd].UHW[el] - RSP_Vect[RSPOpC.rt].UHW[del] >= 0) {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_Flags[1].UW |= (1 << (15 - el));
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
RSP_Flags[1].UW &= ~(1 << (15 - el));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[1];
|
|
|
|
}
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
RSP_Flags[2].UW = 0;
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VCH (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
RSP_Flags[1].UW = 0;
|
|
|
|
RSP_Flags[2].UW = 0;
|
|
|
|
|
|
|
|
for (el = 0;el < 8; el++) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if ((RSP_Vect[RSPOpC.rd].HW[el] ^ RSP_Vect[RSPOpC.rt].HW[del]) < 0) {
|
|
|
|
RSP_Flags[0].UW |= ( 1 << (7 - el));
|
|
|
|
if (RSP_Vect[RSPOpC.rt].HW[del] < 0) {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (15 - el));
|
|
|
|
|
|
|
|
}
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] + RSP_Vect[RSPOpC.rt].HW[del] <= 0) {
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] + RSP_Vect[RSPOpC.rt].HW[del] == -1) {
|
|
|
|
RSP_Flags[2].UW |= ( 1 << (7 - el));
|
|
|
|
}
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el));
|
|
|
|
RSP_ACCUM[el].HW[1] = -RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
}
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] + RSP_Vect[RSPOpC.rt].HW[del] != 0) {
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] != ~RSP_Vect[RSPOpC.rt].HW[del]) {
|
|
|
|
RSP_Flags[0].UW |= ( 1 << (15 - el));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (RSP_Vect[RSPOpC.rt].HW[del] < 0) {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el));
|
|
|
|
}
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] - RSP_Vect[RSPOpC.rt].HW[del] >= 0) {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (15 - el));
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
}
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] - RSP_Vect[RSPOpC.rt].HW[del] != 0) {
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] != ~RSP_Vect[RSPOpC.rt].HW[del]) {
|
|
|
|
RSP_Flags[0].UW |= ( 1 << (15 - el));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[1];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VCR (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
RSP_Flags[0].UW = 0;
|
|
|
|
RSP_Flags[1].UW = 0;
|
|
|
|
RSP_Flags[2].UW = 0;
|
|
|
|
for (el = 0;el < 8; el++) {
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if ((RSP_Vect[RSPOpC.rd].HW[el] ^ RSP_Vect[RSPOpC.rt].HW[del]) < 0) {
|
|
|
|
if (RSP_Vect[RSPOpC.rt].HW[del] < 0) {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (15 - el));
|
|
|
|
}
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] + RSP_Vect[RSPOpC.rt].HW[del] <= 0) {
|
|
|
|
RSP_ACCUM[el].HW[1] = ~RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el));
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (RSP_Vect[RSPOpC.rt].HW[del] < 0) {
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (7 - el));
|
|
|
|
}
|
|
|
|
if (RSP_Vect[RSPOpC.rd].HW[el] - RSP_Vect[RSPOpC.rt].HW[del] >= 0) {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rt].UHW[del];
|
|
|
|
RSP_Flags[1].UW |= ( 1 << (15 - el));
|
|
|
|
} else {
|
|
|
|
RSP_ACCUM[el].HW[1] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
result.HW[el] = RSP_ACCUM[el].HW[1];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMRG (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el ++ ){
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
|
|
|
|
if ((RSP_Flags[1].UW & ( 1 << (7 - el))) != 0) {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rd].HW[el];
|
|
|
|
} else {
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
}
|
2021-03-19 06:38:30 +00:00
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el]; // Suggested by Angrylion
|
2016-01-27 09:11:59 +00:00
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VAND (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el ++ ){
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rd].HW[el] & RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VNAND (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el ++ ){
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
result.HW[el] = ~(RSP_Vect[RSPOpC.rd].HW[el] & RSP_Vect[RSPOpC.rt].HW[del]);
|
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VOR (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el ++ ){
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rd].HW[el] | RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VNOR (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el ++ ){
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
result.HW[el] = ~(RSP_Vect[RSPOpC.rd].HW[el] | RSP_Vect[RSPOpC.rt].HW[del]);
|
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VXOR (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el ++ ){
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
result.HW[el] = RSP_Vect[RSPOpC.rd].HW[el] ^ RSP_Vect[RSPOpC.rt].HW[del];
|
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VNXOR (void) {
|
|
|
|
int el, del;
|
|
|
|
VECTOR result = {0};
|
|
|
|
|
|
|
|
for ( el = 0; el < 8; el ++ ){
|
|
|
|
del = EleSpec[RSPOpC.rs].B[el];
|
|
|
|
result.HW[el] = ~(RSP_Vect[RSPOpC.rd].HW[el] ^ RSP_Vect[RSPOpC.rt].HW[del]);
|
|
|
|
RSP_ACCUM[el].HW[1] = result.HW[el];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa] = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VRCP (void) {
|
|
|
|
int count, neg;
|
|
|
|
|
|
|
|
RecpResult.W = RSP_Vect[RSPOpC.rt].HW[EleSpec[RSPOpC.rs].B[(RSPOpC.rd & 0x7)]];
|
|
|
|
if (RecpResult.UW == 0) {
|
|
|
|
RecpResult.UW = 0x7FFFFFFF;
|
|
|
|
} else {
|
|
|
|
if (RecpResult.W < 0) {
|
|
|
|
neg = TRUE;
|
|
|
|
RecpResult.W = ~RecpResult.W + 1;
|
|
|
|
} else {
|
|
|
|
neg = FALSE;
|
|
|
|
}
|
|
|
|
for (count = 15; count > 0; count--) {
|
|
|
|
if ((RecpResult.W & (1 << count))) {
|
|
|
|
RecpResult.W &= (0xFFC0 >> (15 - count) );
|
|
|
|
count = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
{
|
|
|
|
DWORD RoundMethod = _RC_CHOP;
|
|
|
|
DWORD OldModel = _controlfp(RoundMethod, _MCW_RC);
|
|
|
|
RecpResult.W = (long)((0x7FFFFFFF / (double)RecpResult.W));
|
|
|
|
OldModel = _controlfp(OldModel, _MCW_RC);
|
|
|
|
}
|
|
|
|
for (count = 31; count > 0; count--) {
|
|
|
|
if ((RecpResult.W & (1 << count))) {
|
|
|
|
RecpResult.W &= (0xFFFF8000 >> (31 - count) );
|
|
|
|
count = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (neg == TRUE) {
|
|
|
|
RecpResult.W = ~RecpResult.W;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
for ( count = 0; count < 8; count++ ) {
|
|
|
|
RSP_ACCUM[count].HW[1] = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[count]];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa].HW[7 - (RSPOpC.rd & 0x7)] = RecpResult.UHW[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VRCPL (void) {
|
|
|
|
int count, neg;
|
|
|
|
|
|
|
|
RecpResult.UW = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[(RSPOpC.rd & 0x7)]] | Recp.W;
|
|
|
|
if (RecpResult.UW == 0) {
|
|
|
|
RecpResult.UW = 0x7FFFFFFF;
|
|
|
|
} else {
|
|
|
|
if (RecpResult.W < 0) {
|
|
|
|
neg = TRUE;
|
|
|
|
if (RecpResult.UHW[1] == 0xFFFF && RecpResult.HW[0] < 0) {
|
|
|
|
RecpResult.W = ~RecpResult.W + 1;
|
|
|
|
} else {
|
|
|
|
RecpResult.W = ~RecpResult.W;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
neg = FALSE;
|
|
|
|
}
|
|
|
|
for (count = 31; count > 0; count--) {
|
|
|
|
if ((RecpResult.W & (1 << count))) {
|
|
|
|
RecpResult.W &= (0xFFC00000 >> (31 - count) );
|
|
|
|
count = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
{
|
|
|
|
DWORD OldModel = _controlfp(_RC_CHOP, _MCW_RC);
|
|
|
|
//RecpResult.W = 0x7FFFFFFF / RecpResult.W;
|
|
|
|
RecpResult.W = (long)((0x7FFFFFFF / (double)RecpResult.W));
|
|
|
|
OldModel = _controlfp(OldModel, _MCW_RC);
|
|
|
|
}
|
|
|
|
for (count = 31; count > 0; count--) {
|
|
|
|
if ((RecpResult.W & (1 << count))) {
|
|
|
|
RecpResult.W &= (0xFFFF8000 >> (31 - count) );
|
|
|
|
count = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (neg == TRUE) {
|
|
|
|
RecpResult.W = ~RecpResult.W;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
for ( count = 0; count < 8; count++ ) {
|
|
|
|
RSP_ACCUM[count].HW[1] = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[count]];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa].HW[7 - (RSPOpC.rd & 0x7)] = RecpResult.UHW[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VRCPH (void) {
|
|
|
|
int count;
|
|
|
|
|
|
|
|
Recp.UHW[1] = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[(RSPOpC.rd & 0x7)]];
|
|
|
|
for ( count = 0; count < 8; count++ ) {
|
|
|
|
RSP_ACCUM[count].HW[1] = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[count]];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa].UHW[7 - (RSPOpC.rd & 0x7)] = RecpResult.UHW[1];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VMOV (void) {
|
|
|
|
int count;
|
|
|
|
|
|
|
|
for ( count = 0; count < 8; count++ ) {
|
|
|
|
RSP_ACCUM[count].HW[1] = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[count]];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa].UHW[7 - (RSPOpC.rd & 0x7)] =
|
|
|
|
RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[(RSPOpC.rd & 0x7)]];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VRSQ (void) {
|
|
|
|
int count, neg;
|
|
|
|
|
|
|
|
SQrootResult.W = RSP_Vect[RSPOpC.rt].HW[EleSpec[RSPOpC.rs].B[(RSPOpC.rd & 0x7)]];
|
|
|
|
if (SQrootResult.UW == 0) {
|
|
|
|
SQrootResult.UW = 0x7FFFFFFF;
|
|
|
|
} else if (SQrootResult.UW == 0xFFFF8000) {
|
|
|
|
SQrootResult.UW = 0xFFFF0000;
|
|
|
|
} else {
|
|
|
|
if (SQrootResult.W < 0) {
|
|
|
|
neg = TRUE;
|
|
|
|
SQrootResult.W = ~SQrootResult.W + 1;
|
|
|
|
} else {
|
|
|
|
neg = FALSE;
|
|
|
|
}
|
|
|
|
for (count = 15; count > 0; count--) {
|
|
|
|
if ((SQrootResult.W & (1 << count))) {
|
|
|
|
SQrootResult.W &= (0xFF80 >> (15 - count) );
|
|
|
|
count = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
{
|
|
|
|
DWORD RoundMethod = _RC_CHOP;
|
|
|
|
DWORD OldModel = _controlfp(RoundMethod, _MCW_RC);
|
|
|
|
SQrootResult.W = (long)(0x7FFFFFFF / sqrt(SQrootResult.W));
|
|
|
|
OldModel = _controlfp(OldModel, _MCW_RC);
|
|
|
|
}
|
|
|
|
for (count = 31; count > 0; count--) {
|
|
|
|
if ((SQrootResult.W & (1 << count))) {
|
|
|
|
SQrootResult.W &= (0xFFFF8000 >> (31 - count) );
|
|
|
|
count = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (neg == TRUE) {
|
|
|
|
SQrootResult.W = ~SQrootResult.W;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
for ( count = 0; count < 8; count++ ) {
|
|
|
|
RSP_ACCUM[count].HW[1] = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[count]];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa].HW[7 - (RSPOpC.rd & 0x7)] = SQrootResult.UHW[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VRSQL (void) {
|
|
|
|
int count, neg;
|
|
|
|
|
|
|
|
SQrootResult.UW = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[(RSPOpC.rd & 0x7)]] | SQroot.W;
|
|
|
|
if (SQrootResult.UW == 0) {
|
|
|
|
SQrootResult.UW = 0x7FFFFFFF;
|
|
|
|
} else if (SQrootResult.UW == 0xFFFF8000) {
|
|
|
|
SQrootResult.UW = 0xFFFF0000;
|
|
|
|
} else {
|
|
|
|
if (SQrootResult.W < 0) {
|
|
|
|
neg = TRUE;
|
|
|
|
if (SQrootResult.UHW[1] == 0xFFFF && SQrootResult.HW[0] < 0) {
|
|
|
|
SQrootResult.W = ~SQrootResult.W + 1;
|
|
|
|
} else {
|
|
|
|
SQrootResult.W = ~SQrootResult.W;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
neg = FALSE;
|
|
|
|
}
|
|
|
|
for (count = 31; count > 0; count--) {
|
|
|
|
if ((SQrootResult.W & (1 << count))) {
|
|
|
|
SQrootResult.W &= (0xFF800000 >> (31 - count) );
|
|
|
|
count = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
{
|
|
|
|
DWORD OldModel = _controlfp(_RC_CHOP, _MCW_RC);
|
|
|
|
SQrootResult.W = (long)(0x7FFFFFFF / sqrt(SQrootResult.W));
|
|
|
|
OldModel = _controlfp(OldModel, _MCW_RC);
|
|
|
|
}
|
|
|
|
for (count = 31; count > 0; count--) {
|
|
|
|
if ((SQrootResult.W & (1 << count))) {
|
|
|
|
SQrootResult.W &= (0xFFFF8000 >> (31 - count) );
|
|
|
|
count = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (neg == TRUE) {
|
|
|
|
SQrootResult.W = ~SQrootResult.W;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
for ( count = 0; count < 8; count++ ) {
|
|
|
|
RSP_ACCUM[count].HW[1] = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[count]];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa].HW[7 - (RSPOpC.rd & 0x7)] = SQrootResult.UHW[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VRSQH (void) {
|
|
|
|
int count;
|
|
|
|
|
|
|
|
SQroot.UHW[1] = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[(RSPOpC.rd & 0x7)]];
|
|
|
|
for ( count = 0; count < 8; count++ ) {
|
|
|
|
RSP_ACCUM[count].HW[1] = RSP_Vect[RSPOpC.rt].UHW[EleSpec[RSPOpC.rs].B[count]];
|
|
|
|
}
|
|
|
|
RSP_Vect[RSPOpC.sa].UHW[7 - (RSPOpC.rd & 0x7)] = SQrootResult.UHW[1];
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Vector_VNOOP (void) {}
|
|
|
|
|
2021-03-19 06:38:30 +00:00
|
|
|
// LC2 functions
|
|
|
|
|
2016-01-27 09:11:59 +00:00
|
|
|
void RSP_Opcode_LBV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 0)) & 0xFFF;
|
|
|
|
RSP_LBV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LSV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 1)) & 0xFFF;
|
|
|
|
RSP_LSV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LLV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 2)) & 0xFFF;
|
|
|
|
RSP_LLV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LDV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 3)) & 0xFFF;
|
|
|
|
RSP_LDV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LQV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_LQV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LRV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_LRV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LPV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 3)) & 0xFFF;
|
|
|
|
RSP_LPV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LUV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 3)) & 0xFFF;
|
|
|
|
RSP_LUV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LHV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_LHV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LFV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_LFV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_LTV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_LTV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
2021-03-19 06:38:30 +00:00
|
|
|
// SC2 functions
|
|
|
|
|
2016-01-27 09:11:59 +00:00
|
|
|
void RSP_Opcode_SBV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 0)) & 0xFFF;
|
|
|
|
RSP_SBV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SSV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 1)) & 0xFFF;
|
|
|
|
RSP_SSV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SLV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 2)) & 0xFFF;
|
|
|
|
RSP_SLV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SDV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 3)) & 0xFFF;
|
|
|
|
RSP_SDV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SQV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_SQV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SRV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_SRV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SPV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 3)) & 0xFFF;
|
|
|
|
RSP_SPV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SUV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 3)) & 0xFFF;
|
|
|
|
RSP_SUV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SHV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_SHV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SFV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_SFV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_STV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_STV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
|
|
|
void RSP_Opcode_SWV ( void ) {
|
|
|
|
uint32_t Address = (uint32_t)(RSP_GPR[RSPOpC.base].W + (RSPOpC.voffset << 4)) & 0xFFF;
|
|
|
|
RSP_SWV_DMEM( Address, RSPOpC.rt, RSPOpC.del);
|
|
|
|
}
|
|
|
|
|
2021-05-18 11:51:36 +00:00
|
|
|
// Other functions
|
2016-01-27 09:11:59 +00:00
|
|
|
|
|
|
|
void rsp_UnknownOpcode (void) {
|
|
|
|
char Message[200];
|
|
|
|
int response;
|
|
|
|
|
|
|
|
if (InRSPCommandsWindow) {
|
|
|
|
SetRSPCommandViewto( *PrgCount );
|
2021-03-19 06:38:30 +00:00
|
|
|
DisplayError("Unhandled Opcode\n%s\n\nStopping emulation", RSPOpcodeName(RSPOpC.Hex,*PrgCount));
|
2016-01-27 09:11:59 +00:00
|
|
|
} else {
|
2021-03-19 06:38:30 +00:00
|
|
|
sprintf(Message,"Unhandled Opcode\n%s\n\nStopping emulation.\n\nWOuld you like to open the debugger?",
|
2016-01-27 09:11:59 +00:00
|
|
|
RSPOpcodeName(RSPOpC.Hex,*PrgCount));
|
2023-06-01 07:41:26 +00:00
|
|
|
response = MessageBoxA(NULL,Message,"Error", MB_YESNO | MB_ICONERROR);
|
2016-01-27 09:11:59 +00:00
|
|
|
if (response == IDYES) {
|
|
|
|
Enter_RSP_Commands_Window ();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
ExitThread(0);
|
|
|
|
}
|