Add support for old init.
[bertos.git] / bertos / cpu / arm / drv / vic_lpc2.h
1 /**
2  * \file
3  * <!--
4  * This file is part of BeRTOS.
5  *
6  * Bertos is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
19  *
20  * As a special exception, you may use this file as part of a free software
21  * library without restriction.  Specifically, if other files instantiate
22  * templates or use macros or inline functions from this file, or you compile
23  * this file and link it with other files to produce an executable, this
24  * file does not by itself cause the resulting executable to be covered by
25  * the GNU General Public License.  This exception does not however
26  * invalidate any other reasons why the executable file might be covered by
27  * the GNU General Public License.
28  *
29  * Copyright 2010 Develer S.r.l. (http://www.develer.com/)
30  *
31  * -->
32  *
33  * \author Francesco Sacchi <batt@develer.com>
34  *
35  * \brief Vectored Interrupt Controller VIC driver.
36  */
37  
38 #ifndef DRV_VIC_LPC2_H
39 #define DRV_VIC_LPC2_H
40
41 #include <cfg/compiler.h>
42 #include <cpu/irq.h>
43
44 #if CPU_ARM_LPC2378
45         #include <io/lpc23xx.h>
46         #define vic_vector(i)   (*(&VICVectAddr0 + i))
47         #define vic_priority(i) (*(&VICVectCntl0 + i))
48         #define VIC_SRC_CNT 32
49         #define vic_enable(i)  do { ASSERT(i < VIC_SRC_CNT); VICIntEnable = BV(i); } while (0)
50         #define vic_disable(i) do { ASSERT(i < VIC_SRC_CNT); VICIntEnClr  = BV(i); } while (0)
51
52         typedef void vic_handler_t(void);
53         void vic_defaultHandler(void);
54
55         INLINE void vic_init(void)
56         {
57                 IRQ_DISABLE;
58                 /* Assign all sources to IRQ (not to FIQ) */
59                 VICIntSelect = 0;
60                 /* Disable all sw interrupts */
61                 VICSoftIntClr = 0xFFFFFFFF;
62                 /* Disable all interrupts */
63                 VICIntEnClr = 0xFFFFFFFF;
64
65                 for (int i = 0; i < VIC_SRC_CNT; i++)
66                         vic_vector(i) = (reg32_t)vic_defaultHandler;
67         }
68
69         INLINE void vic_setVector(int id, vic_handler_t *handler)
70         {
71                 ASSERT(id < VIC_SRC_CNT);
72                 vic_vector(id) = (reg32_t)handler;
73         }
74 #else
75         #error Unknown CPU
76 #endif
77
78 #endif /* DRV_VIC_LPC2_H */