Add support for old init.
[bertos.git] / bertos / cpu / arm / drv / timer_at91.c
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 2007 Develer S.r.l. (http://www.develer.com/)
30  *
31  * -->
32  *
33  * \author Francesco Sacchi <batt@develer.com>
34  *
35  * \brief Low-level timer module for Atmel AT91 (inplementation).
36  */
37
38 #include "timer_at91.h"
39 #include <io/arm.h>
40 #include "sysirq_at91.h"
41
42 #include <cfg/macros.h> // BV()
43 #include <cfg/module.h>
44 #include <cpu/irq.h>
45 #include <cpu/types.h>
46
47
48 /** HW dependent timer initialization  */
49 #if (CONFIG_TIMER == TIMER_ON_PIT)
50
51         ISR_PROTO_CONTEXT_SWITCH(timer_handler);
52
53         void timer_hw_init(void)
54         {
55                 sysirq_init();
56
57                 cpu_flags_t flags;
58
59                 MOD_CHECK(sysirq);
60
61                 IRQ_SAVE_DISABLE(flags);
62
63                 PIT_MR = TIMER_HW_CNT;
64                 /* Register system interrupt handler. */
65                 sysirq_setHandler(SYSIRQ_PIT, timer_handler);
66
67                 /* Enable interval timer and interval timer interrupts */
68                 PIT_MR |= BV(PITEN);
69                 sysirq_setEnable(SYSIRQ_PIT, true);
70
71                 /* Reset counters, this is needed to start timer and interrupt flags */
72                 uint32_t dummy = PIVR;
73                 (void) dummy;
74
75                 IRQ_RESTORE(flags);
76         }
77
78 #else
79         #error Unimplemented value for CONFIG_TIMER
80 #endif /* CONFIG_TIMER */