WebSVN – HelenOS – Diff – /trunk/kernel/arch/ppc32/src/drivers/pic.c


/*
 * Copyright (c) 2006 Ondrej Palkovsky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/** @addtogroup ppc32  
 * @{
 */
/** @file
 */
 
 
#include <arch/asm.h>
#include <arch/drivers/pic.h>
#include <byteorder.h>
#include <bitops.h>
 
static volatile uint32_t *pic;
 
void pic_init(uintptr_t base, size_t size)
{
    pic = (uint32_t *) hw_map(base, size);
}
 
void pic_enable_interrupt(int intnum)
{
    if (intnum < 32) {
        pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] | (1 << intnum);
    } else {
        pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] | (1 << (intnum - 32));
    }
   
}
 
void pic_disable_interrupt(int intnum)
{
    if (intnum < 32) {
        pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] & (~(1 << intnum));
    } else {
        pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] & (~(1 << (intnum - 32)));
    }
}
 
void pic_ack_interrupt(int intnum)
{
    if (intnum < 32)
        pic[PIC_ACK_LOW] = 1 << intnum;
    else
        pic[PIC_ACK_HIGH] = 1 << (intnum - 32);
}
 
/** Return number of pending interrupt */
int pic_get_pending(void)
{
    int pending;
 
    pending = pic[PIC_PENDING_LOW];
    if (pending)
        return fnzb32(pending);
   
    pending = pic[PIC_PENDING_HIGH];
    if (pending)
        return fnzb32(pending) + 32;
   
    return -1;
}
 
/** @}
 */
 

Subversion Repositories HelenOS

(root)/trunk/kernel/arch/ppc32/src/drivers/pic.c – Rev 1944 → 2071

Rev 1944		Rev 2071
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/asm.h>	36	#include <arch/asm.h>
37	#include <arch/drivers/pic.h>	37	#include <arch/drivers/pic.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;	41	static volatile uint32_t *pic;
42		42
43	void pic_init(uintptr_t base, size_t size)	43	void pic_init(uintptr_t base, size_t size)
44	{	44	{
45	pic = (uint32_t *) hw_map(base, size);	45	pic = (uint32_t *) hw_map(base, size);
46	}	46	}
47		47
48	void pic_enable_interrupt(int intnum)	48	void pic_enable_interrupt(int intnum)
49	{	49	{
50	if (intnum < 32) {	50	if (intnum < 32) {
51	pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] \| (1 << intnum);	51	pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] \| (1 << intnum);
52	} else {	52	} else {
53	pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] \| (1 << (intnum - 32));	53	pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] \| (1 << (intnum - 32));
54	}	54	}
55		55
56	}	56	}
57		57
58	void pic_disable_interrupt(int intnum)	58	void pic_disable_interrupt(int intnum)
59	{	59	{
60	if (intnum < 32) {	60	if (intnum < 32) {
61	pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] & (~(1 << intnum));	61	pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] & (~(1 << intnum));
62	} else {	62	} else {
63	pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] & (~(1 << (intnum - 32)));	63	pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] & (~(1 << (intnum - 32)));
64	}	64	}
65	}	65	}
66		66
67	void pic_ack_interrupt(int intnum)	67	void pic_ack_interrupt(int intnum)
68	{	68	{
69	if (intnum < 32)	69	if (intnum < 32)
70	pic[PIC_ACK_LOW] = 1 << intnum;	70	pic[PIC_ACK_LOW] = 1 << intnum;
71	else	71	else
72	pic[PIC_ACK_HIGH] = 1 << (intnum - 32);	72	pic[PIC_ACK_HIGH] = 1 << (intnum - 32);
73	}	73	}
74		74
75	/** Return number of pending interrupt */	75	/** Return number of pending interrupt */
76	int pic_get_pending(void)	76	int pic_get_pending(void)
77	{	77	{
78	int pending;	78	int pending;
79		79
80	pending = pic[PIC_PENDING_LOW];	80	pending = pic[PIC_PENDING_LOW];
81	if (pending)	81	if (pending)
82	return fnzb32(pending);	82	return fnzb32(pending);
83		83
84	pending = pic[PIC_PENDING_HIGH];	84	pending = pic[PIC_PENDING_HIGH];
85	if (pending)	85	if (pending)
86	return fnzb32(pending) + 32;	86	return fnzb32(pending) + 32;
87		87
88	return -1;	88	return -1;
89	}	89	}
90		90
91	/** @}	91	/** @}
92	*/	92	*/
93		93