![Graeme Russ](/assets/img/avatar_default.png)
Rewrite interrupt handling functionality for the i386 port. Separated functionality into separate CPU and Architecture components. It appears as if the i386 interrupt handler functionality was intended to allow multiple handlers to be installed for a given interrupt. Unfortunately, this functionality was not fully implemented and also had the problem that irq_free_handler() does not allow the passing of the handler function pointer and therefore could never be used to free specific handlers that had been installed for a given IRQ. There were also various issues with array bounds not being fully tested. I had two objectives in mind for the new implementation: 1) Keep the implementation as similar as possible to existing implementations. To that end, I have used the leon2/3 implementations as the reference 2) Seperate CPU and Architecture specific elements. All specific i386 interrupt functionality is now in cpu/i386/ with the high level API and architecture specific code in lib_i386. Functionality specific to the PC/AT architecture (i.e. cascaded i8259 PICs) has been further split out into an individual file to allow for the implementation of the PIC architecture of the SC520 CPU (supports more IRQs) Signed-off-by: Graeme Russ <graeme.russ at gmail.com>
166 lines
3.7 KiB
C
166 lines
3.7 KiB
C
/*
|
|
* (C) Copyright 2009
|
|
* Graeme Russ, graeme.russ@gmail.com
|
|
*
|
|
* (C) Copyright 2002
|
|
* Daniel Engström, Omicron Ceti AB, daniel@omicron.se.
|
|
*
|
|
* See file CREDITS for list of people who contributed to this
|
|
* project.
|
|
*
|
|
* 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 2 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, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
* MA 02111-1307 USA
|
|
*/
|
|
|
|
/*
|
|
* This file provides the interrupt handling functionality for systems
|
|
* based on the standard PC/AT architecture using two cascaded i8259
|
|
* Programmable Interrupt Controllers.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <asm/io.h>
|
|
#include <asm/i8259.h>
|
|
#include <asm/ibmpc.h>
|
|
#include <asm/interrupt.h>
|
|
|
|
#if CONFIG_SYS_NUM_IRQS != 16
|
|
#error "CONFIG_SYS_NUM_IRQS must equal 16 if CONFIG_SYS_NUM_IRQS is defined"
|
|
#endif
|
|
|
|
DECLARE_INTERRUPT(0);
|
|
DECLARE_INTERRUPT(1);
|
|
DECLARE_INTERRUPT(3);
|
|
DECLARE_INTERRUPT(4);
|
|
DECLARE_INTERRUPT(5);
|
|
DECLARE_INTERRUPT(6);
|
|
DECLARE_INTERRUPT(7);
|
|
DECLARE_INTERRUPT(8);
|
|
DECLARE_INTERRUPT(9);
|
|
DECLARE_INTERRUPT(10);
|
|
DECLARE_INTERRUPT(11);
|
|
DECLARE_INTERRUPT(12);
|
|
DECLARE_INTERRUPT(13);
|
|
DECLARE_INTERRUPT(14);
|
|
DECLARE_INTERRUPT(15);
|
|
|
|
int interrupt_init(void)
|
|
{
|
|
u8 i;
|
|
|
|
disable_interrupts();
|
|
|
|
/* Setup interrupts */
|
|
set_vector(0x20, irq_0);
|
|
set_vector(0x21, irq_1);
|
|
set_vector(0x23, irq_3);
|
|
set_vector(0x24, irq_4);
|
|
set_vector(0x25, irq_5);
|
|
set_vector(0x26, irq_6);
|
|
set_vector(0x27, irq_7);
|
|
set_vector(0x28, irq_8);
|
|
set_vector(0x29, irq_9);
|
|
set_vector(0x2a, irq_10);
|
|
set_vector(0x2b, irq_11);
|
|
set_vector(0x2c, irq_12);
|
|
set_vector(0x2d, irq_13);
|
|
set_vector(0x2e, irq_14);
|
|
set_vector(0x2f, irq_15);
|
|
|
|
/* Mask all interrupts */
|
|
outb(0xff, MASTER_PIC + IMR);
|
|
outb(0xff, SLAVE_PIC + IMR);
|
|
|
|
/* Master PIC */
|
|
/* Place master PIC interrupts at INT20 */
|
|
/* ICW3, One slave PIC is present */
|
|
outb(ICW1_SEL|ICW1_EICW4, MASTER_PIC + ICW1);
|
|
outb(0x20, MASTER_PIC + ICW2);
|
|
outb(IR2, MASTER_PIC + ICW3);
|
|
outb(ICW4_PM, MASTER_PIC + ICW4);
|
|
|
|
for (i = 0; i < 8; i++)
|
|
outb(OCW2_SEOI | i, MASTER_PIC + OCW2);
|
|
|
|
/* Slave PIC */
|
|
/* Place slave PIC interrupts at INT28 */
|
|
/* Slave ID */
|
|
outb(ICW1_SEL|ICW1_EICW4, SLAVE_PIC + ICW1);
|
|
outb(0x28, SLAVE_PIC + ICW2);
|
|
outb(0x02, SLAVE_PIC + ICW3);
|
|
outb(ICW4_PM, SLAVE_PIC + ICW4);
|
|
|
|
for (i = 0; i < 8; i++)
|
|
outb(OCW2_SEOI | i, SLAVE_PIC + OCW2);
|
|
|
|
/*
|
|
* Enable cascaded interrupts by unmasking the cascade IRQ pin of
|
|
* the master PIC
|
|
*/
|
|
unmask_irq (2);
|
|
|
|
enable_interrupts();
|
|
|
|
return 0;
|
|
}
|
|
|
|
void mask_irq(int irq)
|
|
{
|
|
int imr_port;
|
|
|
|
if (irq >= CONFIG_SYS_NUM_IRQS)
|
|
return;
|
|
|
|
if (irq > 7)
|
|
imr_port = SLAVE_PIC + IMR;
|
|
else
|
|
imr_port = MASTER_PIC + IMR;
|
|
|
|
outb(inb(imr_port) | (1 << (irq & 7)), imr_port);
|
|
}
|
|
|
|
void unmask_irq(int irq)
|
|
{
|
|
int imr_port;
|
|
|
|
if (irq >= CONFIG_SYS_NUM_IRQS)
|
|
return;
|
|
|
|
if (irq > 7)
|
|
imr_port = SLAVE_PIC + IMR;
|
|
else
|
|
imr_port = MASTER_PIC + IMR;
|
|
|
|
outb(inb(imr_port) & ~(1 << (irq & 7)), imr_port);
|
|
}
|
|
|
|
void specific_eoi(int irq)
|
|
{
|
|
if (irq >= CONFIG_SYS_NUM_IRQS)
|
|
return;
|
|
|
|
if (irq > 7) {
|
|
/*
|
|
* IRQ is on the slave - Issue a corresponding EOI to the
|
|
* slave PIC and an EOI for IRQ2 (the cascade interrupt)
|
|
* on the master PIC
|
|
*/
|
|
outb(OCW2_SEOI | (irq & 7), SLAVE_PIC + OCW2);
|
|
irq = SEOI_IR2;
|
|
}
|
|
|
|
outb(OCW2_SEOI | irq, MASTER_PIC + OCW2);
|
|
}
|