137 lines
3.8 KiB
C
137 lines
3.8 KiB
C
#include <internals/gint.h>
|
|
#include <modules/timer.h>
|
|
#include <modules/rtc.h>
|
|
#include <gint.h>
|
|
#include <timer.h>
|
|
#include <7305.h>
|
|
#include <rtc.h>
|
|
|
|
/*
|
|
gint_reg()
|
|
Returns the address of a common register. All common registers exist
|
|
on both platforms but they may hold different values for the same
|
|
information (f.i. EXPEVT may not return the same value for a given
|
|
exception on both 7705 and 7305).
|
|
*/
|
|
volatile void *gint_reg_7305(gint_register_t reg)
|
|
{
|
|
switch(reg)
|
|
{
|
|
case register_tea: return (void *)0xff00000c;
|
|
case register_mmucr: return (void *)0xff000010;
|
|
case register_tra: return (void *)0xff000020;
|
|
case register_expevt: return (void *)0xff000024;
|
|
case register_intevt: return (void *)0xff000028;
|
|
default: return NULL;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
//---
|
|
// Register saves, setup, interrupt locks, register restoration.
|
|
//---
|
|
|
|
void gint_save_7305(environment_7305_t *e)
|
|
{
|
|
// Saving interrupt priorities.
|
|
e->IPR[0] = INTX.IPRA.WORD;
|
|
e->IPR[1] = INTX.IPRB.WORD;
|
|
e->IPR[2] = INTX.IPRC.WORD;
|
|
e->IPR[3] = INTX.IPRD.WORD;
|
|
e->IPR[4] = INTX.IPRE.WORD;
|
|
e->IPR[5] = INTX.IPRF.WORD;
|
|
e->IPR[6] = INTX.IPRG.WORD;
|
|
e->IPR[7] = INTX.IPRH.WORD;
|
|
e->IPR[8] = INTX.IPRI.WORD;
|
|
e->IPR[9] = INTX.IPRJ.WORD;
|
|
e->IPR[10] = INTX.IPRK.WORD;
|
|
e->IPR[11] = INTX.IPRL.WORD;
|
|
|
|
// Saving RTC registers.
|
|
e->RCR1 = RTC.RCR1->byte;
|
|
e->RCR2 = RTC.RCR2->byte;
|
|
|
|
// Saving TMU registers.
|
|
e->TMU0 = *(TMU.timers[0]);
|
|
e->TMU1 = *(TMU.timers[1]);
|
|
e->TMU2 = *(TMU.timers[2]);
|
|
e->TSTR = TMU.TSTR->byte;
|
|
|
|
// Saving port data used to access the keyboard.
|
|
e->PMCR = *((volatile uint16_t *)0xa4050116);
|
|
e->PMDR = *((volatile uint8_t *)0xa4050136);
|
|
e->PNCR = *((volatile uint16_t *)0xa4050118);
|
|
e->PNDR = *((volatile uint8_t *)0xa4050138);
|
|
e->PZCR = *((volatile uint16_t *)0xa405014c);
|
|
e->PZDR = *((volatile uint8_t *)0xa405016c);
|
|
e->key = *((volatile uint8_t *)0xa40501c6);
|
|
}
|
|
|
|
void gint_lock_and_setup_7305(void)
|
|
{
|
|
// Disabling everything by default to avoid freezing on non-handled
|
|
// interrupts.
|
|
INTX.IPRA.WORD = 0x0000;
|
|
INTX.IPRB.WORD = 0x0000;
|
|
INTX.IPRC.WORD = 0x0000;
|
|
INTX.IPRD.WORD = 0x0000;
|
|
INTX.IPRE.WORD = 0x0000;
|
|
INTX.IPRF.WORD = 0x0000;
|
|
INTX.IPRG.WORD = 0x0000;
|
|
INTX.IPRH.WORD = 0x0000;
|
|
INTX.IPRI.WORD = 0x0000;
|
|
INTX.IPRJ.WORD = 0x0000;
|
|
INTX.IPRK.WORD = 0x0000;
|
|
INTX.IPRL.WORD = 0x0000;
|
|
|
|
// Allowing RTC and timer to schedule automatic tasks such as keyboard
|
|
// analysis.
|
|
INTX.IPRK._RTC = 10;
|
|
INTX.IPRA.TMU0_0 = 12;
|
|
INTX.IPRA.TMU0_1 = 12;
|
|
INTX.IPRA.TMU0_2 = 12;
|
|
|
|
// Don't enable the RTC interrupt by default.
|
|
RTC.RCR2->byte = 0x09;
|
|
}
|
|
|
|
void gint_restore_and_unlock_7305(environment_7305_t *e)
|
|
{
|
|
// Restoring the interrupt priorities.
|
|
INTX.IPRA.WORD = e->IPR[0];
|
|
INTX.IPRB.WORD = e->IPR[1];
|
|
INTX.IPRC.WORD = e->IPR[2];
|
|
INTX.IPRD.WORD = e->IPR[3];
|
|
INTX.IPRE.WORD = e->IPR[4];
|
|
INTX.IPRF.WORD = e->IPR[5];
|
|
INTX.IPRG.WORD = e->IPR[6];
|
|
INTX.IPRH.WORD = e->IPR[7];
|
|
INTX.IPRI.WORD = e->IPR[8];
|
|
INTX.IPRJ.WORD = e->IPR[9];
|
|
INTX.IPRK.WORD = e->IPR[10];
|
|
INTX.IPRL.WORD = e->IPR[11];
|
|
|
|
// Restoring RTC registers.
|
|
RTC.RCR1->byte = e->RCR1;
|
|
RTC.RCR2->byte = e->RCR2;
|
|
|
|
// Restoring TMU registers.
|
|
*(TMU.timers[0]) = e->TMU0;
|
|
*(TMU.timers[1]) = e->TMU1;
|
|
*(TMU.timers[2]) = e->TMU2;
|
|
TMU.TSTR->byte = e->TSTR;
|
|
|
|
// Restoring keyboard-related I/O port registers. However the backlight
|
|
// pin is in PNDR and we would like the backlight to persist when we
|
|
// leave the application, so we just keep this bit.
|
|
*((volatile uint16_t *)0xa4050116) = e->PMCR;
|
|
*((volatile uint8_t *)0xa4050136) = e->PMDR;
|
|
*((volatile uint16_t *)0xa4050118) = e->PNCR;
|
|
*((volatile uint8_t *)0xa4050138) &= 0x10;
|
|
*((volatile uint8_t *)0xa4050138) |= (e->PNDR & ~0x10);
|
|
*((volatile uint16_t *)0xa405014c) = e->PZCR;
|
|
*((volatile uint8_t *)0xa405016c) = e->PZDR;
|
|
*((volatile uint8_t *)0xa40501c6) = e->key;
|
|
}
|