134 lines
3.0 KiB
C
134 lines
3.0 KiB
C
/*
|
|
* Copyright (c) 2006-2022, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2009-01-05 Bernard first version
|
|
*/
|
|
|
|
#include <rthw.h>
|
|
#include <asm/ppc4xx.h>
|
|
#include <asm/processor.h>
|
|
|
|
/* interrupt nest */
|
|
extern volatile rt_atomic_t rt_interrupt_nest;
|
|
|
|
/* exception and interrupt handler table */
|
|
#define MAX_HANDLERS 32
|
|
struct rt_irq_desc isr_table[MAX_HANDLERS];
|
|
|
|
rt_uint32_t rt_interrupt_from_thread, rt_interrupt_to_thread;
|
|
rt_uint32_t rt_thread_switch_interrput_flag;
|
|
|
|
rt_isr_handler_t rt_hw_interrupt_handler(rt_uint32_t vector, void* param)
|
|
{
|
|
rt_kprintf("Unhandled interrupt %d occured!!!\n", vector);
|
|
return RT_NULL;
|
|
}
|
|
|
|
void uic_irq_ack(unsigned int vec)
|
|
{
|
|
mtdcr(uic0sr, UIC_MASK(vec));
|
|
}
|
|
|
|
void uic_int_handler (unsigned int vec)
|
|
{
|
|
rt_interrupt_enter();
|
|
|
|
/* Allow external interrupts to the CPU. */
|
|
if (isr_table [vec].handler != 0)
|
|
{
|
|
(*isr_table[vec].handler)(vec, isr_table[vec].param);
|
|
}
|
|
uic_irq_ack(vec);
|
|
|
|
rt_interrupt_leave();
|
|
}
|
|
|
|
/* handler for UIC interrupt */
|
|
void uic_interrupt(rt_uint32_t uic_base, int vec_base)
|
|
{
|
|
int vec;
|
|
rt_uint32_t uic_msr;
|
|
rt_uint32_t msr_shift;
|
|
|
|
/*
|
|
* Read masked interrupt status register to determine interrupt source
|
|
*/
|
|
uic_msr = get_dcr(uic_base + UIC_MSR);
|
|
msr_shift = uic_msr;
|
|
vec = vec_base;
|
|
|
|
while (msr_shift != 0)
|
|
{
|
|
if (msr_shift & 0x80000000)
|
|
uic_int_handler(vec);
|
|
|
|
/*
|
|
* Shift msr to next position and increment vector
|
|
*/
|
|
msr_shift <<= 1;
|
|
vec++;
|
|
}
|
|
}
|
|
|
|
rt_isr_handler_t rt_hw_interrupt_install(int vector, rt_isr_handler_t new_handler,
|
|
void* param, const char* name)
|
|
{
|
|
rt_base_t level;
|
|
rt_isr_handler_t old_handler;
|
|
|
|
if (((int)vector < 0) || ((int) vector >= MAX_HANDLERS))
|
|
{
|
|
return RT_NULL; /* out of range */
|
|
}
|
|
|
|
/* install the handler in the system interrupt table */
|
|
level = rt_hw_interrupt_disable(); /* lock interrupts to prevent races */
|
|
|
|
old_handler = isr_table[vector].handler;
|
|
isr_table[vector].handler = new_handler;
|
|
isr_table[vector].param = param;
|
|
|
|
rt_hw_interrupt_enable(level);
|
|
}
|
|
|
|
void rt_hw_interrupt_mask(int vector)
|
|
{
|
|
mtdcr(uic0er, mfdcr(uic0er) & ~UIC_MASK(vector));
|
|
}
|
|
|
|
void rt_hw_interrupt_unmask(int vector)
|
|
{
|
|
mtdcr(uic0er, mfdcr(uic0er) | UIC_MASK(vector));
|
|
}
|
|
|
|
void rt_hw_interrupt_init()
|
|
{
|
|
int vector;
|
|
rt_uint32_t pit_value;
|
|
|
|
pit_value = RT_TICK_PER_SECOND * (100000000 / RT_CPU_FREQ);
|
|
|
|
/* enable pit */
|
|
mtspr(SPRN_PIT, pit_value);
|
|
mtspr(SPRN_TCR, 0x4400000);
|
|
|
|
/* set default interrupt handler */
|
|
for (vector = 0; vector < MAX_HANDLERS; vector++)
|
|
{
|
|
isr_table [vector].handler = (rt_isr_handler_t)rt_hw_interrupt_handler;
|
|
isr_table [vector].param = RT_NULL;
|
|
}
|
|
|
|
/* initialize interrupt nest, and context in thread sp */
|
|
rt_interrupt_nest = 0;
|
|
rt_interrupt_from_thread = 0;
|
|
rt_interrupt_to_thread = 0;
|
|
rt_thread_switch_interrput_flag = 0;
|
|
}
|
|
|
|
/*@}*/
|