Subversion Repositories kiss-board

/* This file is part of test microkernel for OpenRISC 1000. */

/* (C) 2001 Simon Srot, srot@opencores.org */

#include "support.h"

#include "spr_defs.h"

#include "debug.h"

#include "int.h"

static IHND int_handlers[MAX_INT_HANDLERS] __attribute__ ((section(".bss")));

//void (*vector_0x000)(void) = dummy_main;

//void (*vector_0x100)(void) = dummy_main;

//void (*vector_0x200)(void) = dummy_main;

//void (*vector_0x300)(void) = dummy_main;

//void (*vector_0x400)(void) = dummy_main;

//void (*vector_0x500)(void) = tick_main;               // tick.c

//void (*vector_0x600)(void) = dummy_main;

//void (*vector_0x700)(void) = dummy_main;

//void (*vector_0x800)(void) = int_main;                // int.c

//void (*vector_0x900)(void) = dummy_main;

//void (*vector_0xa00)(void) = dummy_main;

//void (*vector_0xb00)(void) = dummy_main;

//void (*vector_0xc00)(void) = dummy_main;

//void (*vector_0xd00)(void) = dummy_main;

//void (*vector_0xe00)(void) = dummy_main;

//void (*vector_0xf00)(void) = dummy_main;

//

// dummy excption

//

void dummy0x000_main(){

        unsigned long int epcr,eear,esr;

        epcr    = mfspr(SPR_EPCR_BASE);

        eear    = mfspr(SPR_EEAR_BASE);

        esr     = mfspr(SPR_ESR_BASE);

        DEBUG_INTEGER(epcr,8);

        DEBUG_PRINT("\n");

        DEBUG_INTEGER(eear,8);

        DEBUG_PRINT("\n");

        DEBUG_INTEGER(esr,8);

        DEBUG_PRINT("\n");

        return;

}

void dummy0x100_main(){ DEBUG_PRINT("1"); return; }

void dummy0x200_main(){ DEBUG_PRINT("2"); return; }

void dummy0x300_main(){ DEBUG_PRINT("3"); return; }

void dummy0x400_main(){ DEBUG_PRINT("4"); return; }

void dummy0x500_main(){ DEBUG_PRINT("5"); return; }

void dummy0x600_main(){ DEBUG_PRINT("6"); return; }

void dummy0x700_main(){ DEBUG_PRINT("7"); return; }

void dummy0x800_main(){ DEBUG_PRINT("8"); return; }

void dummy0x900_main(){ DEBUG_PRINT("9"); return; }

void dummy0xa00_main(){ DEBUG_PRINT("a"); return; }

void dummy0xb00_main(){ DEBUG_PRINT("b"); return; }

void dummy0xc00_main(){ DEBUG_PRINT("c"); return; }

void dummy0xd00_main(){ DEBUG_PRINT("d"); return; }

void dummy0xe00_main(){ DEBUG_PRINT("e"); return; }

void dummy0xf00_main(){ DEBUG_PRINT("f"); return; }

void dummy_main(){

        unsigned long int epcr,eear,esr;

        epcr    = mfspr(SPR_EPCR_BASE);

        eear    = mfspr(SPR_EEAR_BASE);

        esr     = mfspr(SPR_ESR_BASE);

        DEBUG_INTEGER(epcr,8);

        DEBUG_PRINT("\n");

        DEBUG_INTEGER(eear,8);

        DEBUG_PRINT("\n");

        DEBUG_INTEGER(esr,8);

        DEBUG_PRINT("\n");

        return;

}

int int_init(){

        unsigned long int i;

        // external interrupt

        for(i = 0; i < MAX_INT_HANDLERS; i++) {

                int_handlers[i].handler = 0;

                int_handlers[i].arg = 0;

        }

        return 0;

}

int int_add(unsigned long vect, void (* handler)(void *), void *arg){

        if(vect >= MAX_INT_HANDLERS) return -1;

        int_handlers[vect].handler = handler;

        int_handlers[vect].arg = arg;

        mtspr(SPR_PICMR, mfspr(SPR_PICMR) | (0x00000001L << vect));

        return 0;

}

int int_disable(unsigned long vect){

        if(vect >= MAX_INT_HANDLERS) return -1;

        mtspr(SPR_PICMR, mfspr(SPR_PICMR) & ~(0x00000001L << vect));

        return 0;

}

int int_enable(unsigned long vect){

        if(vect >= MAX_INT_HANDLERS) return -1;

        mtspr(SPR_PICMR, mfspr(SPR_PICMR) | (0x00000001L << vect));

        return 0;

}

void int_main(void){

        { // external interrupt from exception 0x800

                unsigned long picsr = mfspr(SPR_PICSR);

                unsigned long i = 0;

                mtspr(SPR_PICSR, 0); // need?

                while(i < MAX_INT_HANDLERS) {

                        if((picsr & (0x01L << i)) && (int_handlers[i].handler != 0)) {

                                (*int_handlers[i].handler)(int_handlers[i].arg);

                                mtspr(SPR_PICSR, mfspr(SPR_PICSR) & ~(0x00000001L << i));

                        }

                        i++;

                }

        }

}