Source/DSPSpy/real_dsp.cpp


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53

// Copyright 2009 Dolphin Emulator Project
// SPDX-License-Identifier: GPL-2.0-or-later

#include <gccore.h>
#include <ogc/dsp.h>
#include <ogc/irq.h>
#include <ogc/machine/asm.h>
#include <ogc/machine/processor.h>
#include <ogcsys.h>

#include "dsp_interface.h"
#include "real_dsp.h"

static vu16* const _dspReg = (u16*)0xCC005000;

// Handler for DSP interrupt.
static void dsp_irq_handler(u32 nIrq, void* pCtx)
{
  // Acknowledge interrupt?
  _dspReg[5] = (_dspReg[5] & ~(DSPCR_AIINT | DSPCR_ARINT)) | DSPCR_DSPINT;
}

void RealDSP::Init()
{
  _dspReg[5] = (_dspReg[5] & ~(DSPCR_AIINT | DSPCR_ARINT | DSPCR_DSPINT)) | DSPCR_DSPRESET;
  _dspReg[5] = (_dspReg[5] & ~(DSPCR_HALT | DSPCR_AIINT | DSPCR_ARINT | DSPCR_DSPINT));

  u32 level;
  _CPU_ISR_Disable(level);
  IRQ_Request(IRQ_DSP_DSP, dsp_irq_handler, nullptr);
  _CPU_ISR_Restore(level);
}

void RealDSP::Reset()
{
  // Reset the DSP.
  _dspReg[5] = (_dspReg[5] & ~(DSPCR_AIINT | DSPCR_ARINT | DSPCR_DSPINT)) | DSPCR_DSPRESET;
  _dspReg[5] = (_dspReg[5] & ~(DSPCR_HALT | DSPCR_AIINT | DSPCR_ARINT | DSPCR_DSPINT));
  _dspReg[5] |= DSPCR_RES;
  while (_dspReg[5] & DSPCR_RES)
    ;
  _dspReg[9] = 0x63;
}

u32 RealDSP::CheckMailTo()
{
  return DSP_CheckMailTo();
}

void RealDSP::SendMailTo(u32 mail)
{
  DSP_SendMailTo(mail);
}