/*
 * Interrupts
 *
 * Handle interrupts, the levels.
 *
 * 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/>.
 *
 *  Created on: 26.02.2013
 *      Author: Markus Fröschle
 */

#include <stdint.h>
#include "MCF5475.h"
#include "bas_utils.h"
#include "interrupts.h"

extern uint8_t _rtl_vbr[];
#define VBR	((uint32_t **) &_rtl_vbr[0])

/*
 * register an interrupt handler at the Coldfire interrupt controller and add the handler to the interrupt vector table
 */
int register_handler(uint8_t priority, uint8_t intr, void (*func)())
{
	int i;
	uint8_t level = 0b01111111;
	uint32_t **adr = VBR;

	intr &= 63;
	priority &= 7;

	if (intr <= 0)
		return -1;

	for (i = 1; i < 64; i++)
		if (i != intr)
		{
			if ((MCF_INTC_ICR(i) & 7) == priority)
				CLEAR_BIT_NO(level, (MCF_INTC_ICR(i) >> 3) & 7);
		}

	for (i = 0; 1 < 7; i++)
		if (level & (1 << i))
			break;

	if (i >= 7)
		return -1;

	/*
	 * Make sure priority level is high, before changing registers
	 */
	__asm__ volatile (
			"move.w sr,d0\n\t"
			"move.w d0,-(sp) \n\t"
			"move.w #0x2700,sr\n\t"
			:
			:
			: "sp","d0","memory"
	);

	if (intr < 32)
		CLEAR_BIT(MCF_INTC_IMRL, (1 << intr));
	else
		CLEAR_BIT(MCF_INTC_IMRH, (1 << (intr - 32)));

	MCF_INTC_ICR(intr) = MCF_INTC_ICR_IP(priority) | MCF_INTC_ICR_IL(i);

	adr[64 + intr] = (uint32_t *) func;	/* first 64 vectors are system exceptions */

	/*
	 * Return the saved priority level
	 */
	__asm__ volatile (
			"move.w (sp)+,d2\n\t"
			"move.w d2,sr\n\t"
			:
			:
			: "sp","d2","memory"
	);

	return 0;
}

__attribute__((interrupt)) void pci_arb_interrupt(void)
{
	xprintf("XLBARB slave error interrupt\r\n");
	MCF_XLB_XARB_SR |= ~MCF_XLB_XARB_SR_SEA;
}