Subversion Repositories HelenOS

Rev

Rev 4153 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4153 Rev 4327
1
/*
1
/*
2
 * Copyright (c) 2006 Ondrej Palkovsky
2
 * Copyright (c) 2006 Ondrej Palkovsky
3
 * All rights reserved.
3
 * All rights reserved.
4
 *
4
 *
5
 * Redistribution and use in source and binary forms, with or without
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
6
 * modification, are permitted provided that the following conditions
7
 * are met:
7
 * are met:
8
 *
8
 *
9
 * - Redistributions of source code must retain the above copyright
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
13
 *   documentation and/or other materials provided with the distribution.
14
 * - The name of the author may not be used to endorse or promote products
14
 * - The name of the author may not be used to endorse or promote products
15
 *   derived from this software without specific prior written permission.
15
 *   derived from this software without specific prior written permission.
16
 *
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
27
 */
28
 
28
 
29
/** @addtogroup ppc32  
29
/** @addtogroup ppc32
30
 * @{
30
 * @{
31
 */
31
 */
32
/** @file
32
/** @file
33
 */
33
 */
34
 
34
 
35
 
35
 
36
#include <arch/drivers/pic.h>
36
#include <arch/drivers/pic.h>
37
#include <mm/page.h>
37
#include <mm/page.h>
38
#include <byteorder.h>
38
#include <byteorder.h>
39
#include <bitops.h>
39
#include <bitops.h>
40
 
40
 
41
static volatile uint32_t *pic = NULL;
41
static volatile uint32_t *pic = NULL;
42
 
42
 
43
void pic_init(uintptr_t base, size_t size)
43
void pic_init(uintptr_t base, size_t size, cir_t *cir, void **cir_arg)
44
{
44
{
45
    pic = (uint32_t *) hw_map(base, size);
45
    pic = (uint32_t *) hw_map(base, size);
-
 
46
    *cir = pic_ack_interrupt;
-
 
47
    *cir_arg = NULL;
46
}
48
}
47
 
49
 
48
void pic_enable_interrupt(int intnum)
50
void pic_enable_interrupt(inr_t intnum)
49
{
51
{
50
    if (pic) {
52
    if (pic) {
51
        if (intnum < 32)
53
        if (intnum < 32)
52
            pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] | (1 << intnum);
54
            pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] | (1 << intnum);
53
        else
55
        else
54
            pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] | (1 << (intnum - 32));
56
            pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] | (1 << (intnum - 32));
55
    }
57
    }
56
   
58
   
57
}
59
}
58
 
60
 
59
void pic_disable_interrupt(int intnum)
61
void pic_disable_interrupt(inr_t intnum)
60
{
62
{
61
    if (pic) {
63
    if (pic) {
62
        if (intnum < 32)
64
        if (intnum < 32)
63
            pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] & (~(1 << intnum));
65
            pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] & (~(1 << intnum));
64
        else
66
        else
65
            pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] & (~(1 << (intnum - 32)));
67
            pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] & (~(1 << (intnum - 32)));
66
    }
68
    }
67
}
69
}
68
 
70
 
69
void pic_ack_interrupt(int intnum)
71
void pic_ack_interrupt(void *arg, inr_t intnum)
70
{
72
{
71
    if (pic) {
73
    if (pic) {
72
        if (intnum < 32)
74
        if (intnum < 32)
73
            pic[PIC_ACK_LOW] = 1 << intnum;
75
            pic[PIC_ACK_LOW] = 1 << intnum;
74
        else
76
        else
75
            pic[PIC_ACK_HIGH] = 1 << (intnum - 32);
77
            pic[PIC_ACK_HIGH] = 1 << (intnum - 32);
76
    }
78
    }
77
}
79
}
78
 
80
 
79
/** Return number of pending interrupt */
81
/** Return number of pending interrupt */
80
int pic_get_pending(void)
82
int pic_get_pending(void)
81
{
83
{
82
    if (pic) {
84
    if (pic) {
83
        int pending;
85
        int pending;
84
       
86
       
85
        pending = pic[PIC_PENDING_LOW];
87
        pending = pic[PIC_PENDING_LOW];
86
        if (pending)
88
        if (pending)
87
            return fnzb32(pending);
89
            return fnzb32(pending);
88
       
90
       
89
        pending = pic[PIC_PENDING_HIGH];
91
        pending = pic[PIC_PENDING_HIGH];
90
        if (pending)
92
        if (pending)
91
            return fnzb32(pending) + 32;
93
            return fnzb32(pending) + 32;
92
    }
94
    }
93
   
95
   
94
    return -1;
96
    return -1;
95
}
97
}
96
 
98
 
97
/** @}
99
/** @}
98
 */
100
 */
99
 
101