Files
VCCPlusOSS/sdk/cmoc/ssc/route.c
T

53 lines
1.5 KiB
C

// SPDX-License-Identifier: GPL-3.0-or-later
#include <vcc/ssc.h>
// C2 mode and level occupy bits 5..3. Bits 2..0 select the PIA data
// register, interrupt edge and interrupt enable. Bits 7..6 are IRQ flags.
#define PIA_MUX_LOW (*(unsigned char *)0xFF01)
#define PIA_MUX_HIGH (*(unsigned char *)0xFF03)
#define PIA_SOUND (*(unsigned char *)0xFF23)
#define C2_LOW 0x30
#define C2_HIGH 0x38
unsigned int ssc_route_audio(void)
{
unsigned char flags, low, high, sound;
unsigned int saved;
// Keep an interrupt handler from changing a control register between our
// read and write. The exact incoming interrupt masks are restored.
asm {
tfr cc,a
orcc #$50
sta :flags
}
low = PIA_MUX_LOW;
high = PIA_MUX_HIGH;
sound = PIA_SOUND;
saved = ((unsigned int)(low & 0x38) << 3) | (high & 0x38) | ((sound & 0x38) >> 3);
PIA_MUX_LOW = (low & 7) | C2_LOW;
PIA_MUX_HIGH = (high & 7) | C2_HIGH;
PIA_SOUND = (sound & 7) | C2_HIGH;
asm {
lda :flags
tfr a,cc
}
return saved;
}
void ssc_restore_audio(unsigned int saved)
{
unsigned char flags;
asm {
tfr cc,a
orcc #$50
sta :flags
}
PIA_MUX_LOW = (PIA_MUX_LOW & 7) | (unsigned char)((saved >> 3) & 0x38);
PIA_MUX_HIGH = (PIA_MUX_HIGH & 7) | (unsigned char)(saved & 0x38);
PIA_SOUND = (PIA_SOUND & 7) | (unsigned char)((saved << 3) & 0x38);
asm {
lda :flags
tfr a,cc
}
}