← Back to branch summary

~ubuntu-branches/ubuntu/maverick/u-boot-omap3/maverick

« back to all changes in this revision

Viewing changes to lib_i386/pcat_interrupts.c

  • Committer: Bazaar Package Importer
  • Author(s): Oliver Grawert
  • Date: 2010-03-22 15:06:23 UTC
  • Revision ID: james.westby@ubuntu.com-20100322150623-i21g8rgiyl5dohag
Tags: upstream-2010.3git20100315
Import upstream version 2010.3git20100315

Show diffs side-by-side

added added

removed removed

Lines of Context:
lib_i386/pcat_interrupts.c
 
1
/*
 
2
 * (C) Copyright 2009
 
3
 * Graeme Russ, graeme.russ@gmail.com
 
4
 *
 
5
 * (C) Copyright 2002
 
6
 * Daniel Engstr�m, Omicron Ceti AB, daniel@omicron.se.
 
7
 *
 
8
 * See file CREDITS for list of people who contributed to this
 
9
 * project.
 
10
 *
 
11
 * This program is free software; you can redistribute it and/or
 
12
 * modify it under the terms of the GNU General Public License as
 
13
 * published by the Free Software Foundation; either version 2 of
 
14
 * the License, or (at your option) any later version.
 
15
 *
 
16
 * This program is distributed in the hope that it will be useful,
 
17
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 
18
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 
19
 * GNU General Public License for more details.
 
20
 *
 
21
 * You should have received a copy of the GNU General Public License
 
22
 * along with this program; if not, write to the Free Software
 
23
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 
24
 * MA 02111-1307 USA
 
25
 */
 
26
 
 
27
/*
 
28
 * This file provides the interrupt handling functionality for systems
 
29
 * based on the standard PC/AT architecture using two cascaded i8259
 
30
 * Programmable Interrupt Controllers.
 
31
 */
 
32
 
 
33
#include <common.h>
 
34
#include <asm/io.h>
 
35
#include <asm/i8259.h>
 
36
#include <asm/ibmpc.h>
 
37
#include <asm/interrupt.h>
 
38
 
 
39
#if CONFIG_SYS_NUM_IRQS != 16
 
40
#error "CONFIG_SYS_NUM_IRQS must equal 16 if CONFIG_SYS_NUM_IRQS is defined"
 
41
#endif
 
42
 
 
43
int interrupt_init(void)
 
44
{
 
45
        u8 i;
 
46
 
 
47
        disable_interrupts();
 
48
 
 
49
        /* Mask all interrupts */
 
50
        outb(0xff, MASTER_PIC + IMR);
 
51
        outb(0xff, SLAVE_PIC + IMR);
 
52
 
 
53
        /* Master PIC */
 
54
        /* Place master PIC interrupts at INT20 */
 
55
        /* ICW3, One slave PIC is present */
 
56
        outb(ICW1_SEL|ICW1_EICW4, MASTER_PIC + ICW1);
 
57
        outb(0x20, MASTER_PIC + ICW2);
 
58
        outb(IR2, MASTER_PIC + ICW3);
 
59
        outb(ICW4_PM, MASTER_PIC + ICW4);
 
60
 
 
61
        for (i = 0; i < 8; i++)
 
62
                outb(OCW2_SEOI | i, MASTER_PIC + OCW2);
 
63
 
 
64
        /* Slave PIC */
 
65
        /* Place slave PIC interrupts at INT28 */
 
66
        /* Slave ID */
 
67
        outb(ICW1_SEL|ICW1_EICW4, SLAVE_PIC + ICW1);
 
68
        outb(0x28, SLAVE_PIC + ICW2);
 
69
        outb(0x02, SLAVE_PIC + ICW3);
 
70
        outb(ICW4_PM, SLAVE_PIC + ICW4);
 
71
 
 
72
        for (i = 0; i < 8; i++)
 
73
                outb(OCW2_SEOI | i, SLAVE_PIC + OCW2);
 
74
 
 
75
        /*
 
76
         * Enable cascaded interrupts by unmasking the cascade IRQ pin of
 
77
         * the master PIC
 
78
         */
 
79
        unmask_irq (2);
 
80
 
 
81
        enable_interrupts();
 
82
 
 
83
        return 0;
 
84
}
 
85
 
 
86
void mask_irq(int irq)
 
87
{
 
88
        int imr_port;
 
89
 
 
90
        if (irq >= CONFIG_SYS_NUM_IRQS)
 
91
                return;
 
92
 
 
93
        if (irq > 7)
 
94
                imr_port = SLAVE_PIC + IMR;
 
95
        else
 
96
                imr_port = MASTER_PIC + IMR;
 
97
 
 
98
        outb(inb(imr_port) | (1 << (irq & 7)), imr_port);
 
99
}
 
100
 
 
101
void unmask_irq(int irq)
 
102
{
 
103
        int imr_port;
 
104
 
 
105
        if (irq >= CONFIG_SYS_NUM_IRQS)
 
106
                return;
 
107
 
 
108
        if (irq > 7)
 
109
                imr_port = SLAVE_PIC + IMR;
 
110
        else
 
111
                imr_port = MASTER_PIC + IMR;
 
112
 
 
113
        outb(inb(imr_port) & ~(1 << (irq & 7)), imr_port);
 
114
}
 
115
 
 
116
void specific_eoi(int irq)
 
117
{
 
118
        if (irq >= CONFIG_SYS_NUM_IRQS)
 
119
                return;
 
120
 
 
121
        if (irq > 7) {
 
122
                /*
 
123
                 *  IRQ is on the slave - Issue a corresponding EOI to the
 
124
                 *  slave PIC and an EOI for IRQ2 (the cascade interrupt)
 
125
                 *  on the master PIC
 
126
                 */
 
127
                outb(OCW2_SEOI | (irq & 7), SLAVE_PIC + OCW2);
 
128
                irq = SEOI_IR2;
 
129
        }
 
130
 
 
131
        outb(OCW2_SEOI | irq, MASTER_PIC + OCW2);
 
132
}