discarded - writing exception handlers in C turned out going not as well as assumed
This commit is contained in:
Markus Fröschle
@@ -1,204 +0,0 @@
|
|||||||
/*
|
|
||||||
* exceptions.c
|
|
||||||
*
|
|
||||||
* This file is part of BaS_gcc.
|
|
||||||
*
|
|
||||||
* BaS_gcc 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 3 of the License, or
|
|
||||||
* (at your option) any later version.
|
|
||||||
*
|
|
||||||
* BaS_gcc 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 BaS_gcc. If not, see <http://www.gnu.org/licenses/>.
|
|
||||||
*
|
|
||||||
* derived from original BaS assembler sources:
|
|
||||||
* Copyright 2010 - 2012 F. Aschwanden
|
|
||||||
* Copyright 2013 M. Froeschle
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
#include "bas_printf.h"
|
|
||||||
#include "bas_string.h"
|
|
||||||
#include "startcf.h"
|
|
||||||
#include "interrupts.h"
|
|
||||||
#include "exceptions.h"
|
|
||||||
#include "MCF5475.h"
|
|
||||||
|
|
||||||
#if MACHINE_FIREBEE
|
|
||||||
#include "firebee.h"
|
|
||||||
#elif MACHINE_M5484LITE
|
|
||||||
#include "m5484l.h"
|
|
||||||
#endif /* MACHINE_FIREBEE */
|
|
||||||
|
|
||||||
|
|
||||||
#define DEBUG_EXC
|
|
||||||
#ifdef DEBUG_EXC
|
|
||||||
#define debug_printf(format, arg...) do { xprintf("DEBUG: " format "\r\n", ##arg); } while (0)
|
|
||||||
#else
|
|
||||||
#define debug_printf(format, arg...) do { ; } while (0)
|
|
||||||
#endif /* DEBUG_EXC */
|
|
||||||
|
|
||||||
typedef void (*exception_handler)(uint32_t fs, uint32_t vector);
|
|
||||||
|
|
||||||
static inline uint32_t set_vbr(uint32_t value)
|
|
||||||
{
|
|
||||||
extern uint32_t rt_vbr;
|
|
||||||
uint32_t ret = rt_vbr;
|
|
||||||
|
|
||||||
__asm__ __volatile__(
|
|
||||||
"movec %[value],VBR\n\t"
|
|
||||||
: /* no output */
|
|
||||||
: [value] "r" (value)
|
|
||||||
: /* no clobber */
|
|
||||||
);
|
|
||||||
rt_vbr = value;
|
|
||||||
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void std_exception_handler(uint32_t fs, uint32_t vector)
|
|
||||||
{
|
|
||||||
register uint32_t d0 asm("d0");
|
|
||||||
register uint32_t d1 asm("d1");
|
|
||||||
register uint32_t a0 asm("a0");
|
|
||||||
register uint32_t a1 asm("a1");
|
|
||||||
|
|
||||||
uint32_t old_ipl;
|
|
||||||
extern uint32_t rt_vbr;
|
|
||||||
|
|
||||||
old_ipl = set_ipl(7);
|
|
||||||
|
|
||||||
#if MACHINE_FIREBEE
|
|
||||||
if (DIP_SWITCH & (1 << 7))
|
|
||||||
{
|
|
||||||
xprintf("protect mode selected by DIP switch, but not implemented\r\n");
|
|
||||||
}
|
|
||||||
#endif /* MACHINE_FIREBEE */
|
|
||||||
|
|
||||||
vector &= 0x3fc; /* mask out vector number */
|
|
||||||
|
|
||||||
debug_printf("vector number = 0x%x\r\n", vector);
|
|
||||||
|
|
||||||
vector += rt_vbr; /* add vector base */
|
|
||||||
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) reset_exception_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) access_exception_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) irq1_exception_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) irq2_exception_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) irq3_exception_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) irq4_exception_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) irq5_exception_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) irq6_exception_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) irq7_exception_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) psc3_interrupt_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((interrupt)) gpt0_interrupt_handler(void)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
extern void __attribute__((interrupt)) xhdi_sd_install(void);
|
|
||||||
|
|
||||||
void vec_init(void)
|
|
||||||
{
|
|
||||||
exception_handler *VBR = (exception_handler *) &_RAMBAR0[0];
|
|
||||||
extern uint32_t _SUP_SP[]; /* supervisor stack pointer from linker script */
|
|
||||||
exception_handler *SUP_SP = (exception_handler *) &_SUP_SP[0];
|
|
||||||
|
|
||||||
extern uint32_t rt_mod;
|
|
||||||
extern uint32_t rt_ssp;
|
|
||||||
extern uint32_t rt_usp;
|
|
||||||
extern uint32_t rt_vbr;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
rt_mod = -1;
|
|
||||||
rt_ssp = 0;
|
|
||||||
rt_usp = 0;
|
|
||||||
rt_vbr = 0;
|
|
||||||
|
|
||||||
set_vbr((uint32_t) VBR);
|
|
||||||
|
|
||||||
/*
|
|
||||||
* set exception vectors
|
|
||||||
*/
|
|
||||||
for (i = 0; i < 256; i++)
|
|
||||||
{
|
|
||||||
VBR[i] = std_exception_handler;
|
|
||||||
}
|
|
||||||
|
|
||||||
VBR[0] = SUP_SP;
|
|
||||||
|
|
||||||
VBR[1] = reset_exception_handler;
|
|
||||||
VBR[2] = access_exception_handler;
|
|
||||||
|
|
||||||
#if MACHINE_FIREBEE /* DIP switch only on FireBee */
|
|
||||||
if (DIP_SWITCH & (1 << 7))
|
|
||||||
{
|
|
||||||
/* TODO: protect mode */
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
#endif /* MACHINE_FIREBEE */
|
|
||||||
|
|
||||||
VBR[0X80] = xhdi_sd_install; /* trap #0 exception handler for BaS driver vectors */
|
|
||||||
|
|
||||||
|
|
||||||
#if MACHINE_FIREBEE
|
|
||||||
/*
|
|
||||||
* ACP interrupts 1-7 (generated by the FPGA on the FireBee)
|
|
||||||
*/
|
|
||||||
VBR[0X104] = irq1_exception_handler;
|
|
||||||
VBR[0x108] = irq2_exception_handler;
|
|
||||||
VBR[0x10c] = irq3_exception_handler;
|
|
||||||
VBR[0x110] = irq4_exception_handler;
|
|
||||||
VBR[0x114] = irq5_exception_handler;
|
|
||||||
VBR[0x118] = irq6_exception_handler;
|
|
||||||
VBR[0x11c] = irq7_exception_handler;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* install PSC vectors (used for PIC communication on the FireBee
|
|
||||||
*/
|
|
||||||
VBR[INT_SOURCE_PSC3 + 64] = psc3_interrupt_handler;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* install timer vector (used for video page copy on the FireBee
|
|
||||||
*/
|
|
||||||
VBR[INT_SOURCE_GPT0 + 64] = gpt0_interrupt_handler;
|
|
||||||
#endif /* MACHINE_FIREBEE */
|
|
||||||
}
|
|
||||||
|
|
||||||
Reference in New Issue
Block a user