interrupts.c

Go to the documentation of this file.

//*****************************************************************************
// Author               : Christian Illy
// Created              : 12.09.2012
// Version              : 0.1
// Target MCU   : Fujitsu MB96300 series
//
//  This program 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.
//
//  This program 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 this program.  If not, see <http://www.gnu.org/licenses/>.
//
//*****************************************************************************
#include "mb96348hs.h"
#include "interrupts.h"

extern void InitIrqLevels(void);

#pragma segment DATA=ivt,locate=0x7270
#pragma segment FAR_DATA=ivt,locate=0x7270
static IRQHandler ivt[100];

static uint8_t initialized = 0;

void interrupts_init(void) {
        uint16_t i;

        if (initialized == 0) {
                interrupts_disable();
                InitIrqLevels();

                for (i = 0; i < 100; i++) {
                        ivt[i] = *((IRQHandler*) (0xFFFC00ul + 0x270ul + i * 4ul));
                }

                TBR = ((long) (&ivt[0]) & 0xfffc00l) >> 8;

                initialized = 1;

                interrupts_enable();
        }
}

void interrupts_setHandler(uint8_t interruptNr, uint8_t interruptLevel, IRQHandler handler) {
        if ((interruptNr < 12) || (interruptNr > 96))
                return;
        if (interruptLevel > 7)
                return;

        if (initialized == 0)
                interrupts_init();

        ICR = (interruptNr << 8) | interruptLevel;

        ivt[99 - interruptNr] = handler;
}

void interrupts_disableInterrupt(uint8_t interruptNr) {
        if ((interruptNr < 12) || (interruptNr > 96))
                return;

        if (initialized == 0)
                interrupts_init();

        ICR = (interruptNr << 8) | 7;
}