fb11e647
 vrobic
reseau statique a...
|
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
|
/*
* Copyright (C) 2015 Freie Universitรคt Berlin
*
* This file is subject to the terms and conditions of the GNU Lesser General
* Public License v2.1. See the file LICENSE in the top level directory for more
* details.
*/
/**
* @ingroup cpu_lpc2387
* @{
*
* @file
* @brief Implementation of the low-level timer driver for the LPC2387
*
* @author Hauke Petersen <hauke.petersen@fu-berlin.de>
* @}
*/
#include <stdint.h>
#include <string.h>
#include "periph_conf.h"
#include "periph_cpu.h"
#include "periph/timer.h"
/**
* @brief Check the board config to make sure we do not exceed max number of
* timers
*/
#if TIMER_NUMOF > 3
#error "ERROR in timer configuration: too many timers defined"
#endif
/**
* @brief Interrupt context information for configured timers
*/
static timer_isr_ctx_t isr_ctx[TIMER_NUMOF];
/**
* @brief Forward declarations for interrupt functions
* @{
*/
void tim_isr_0(void);
void tim_isr_1(void);
void tim_isr_2(void);
void tim_isr_3(void);
/** @} */
/**
* @brief Get the base pointer of a timer
*/
static inline lpc23xx_timer_t *get_dev(tim_t tim)
{
switch (tim) {
case 0:
return TMR0;
#if TIMER_NUMOF > 1
case 1:
return TMR1;
#endif
#if TIMER_NUMOF > 2
case 2:
return TMR2;
#endif
#if TIMER_NUMOF > 3
case 3:
return TMR3;
#endif
default:
return NULL;
}
}
static inline void pwr_clk_and_isr(tim_t tim)
{
switch (tim) {
case 0:
PCONP |= (1 << 1);
PCLKSEL0 &= ~(0x03 << 2);
PCLKSEL0 |= (0x01 << 2);
install_irq(TIMER0_INT, &tim_isr_0, 1);
break;
#if TIMER_NUMOF > 1
case 1:
PCONP |= (1 << 2);
PCLKSEL0 &= ~(0x03 << 4);
PCLKSEL0 |= (0x01 << 4);
install_irq(TIMER1_INT, &tim_isr_1, 1);
break;
#endif
#if TIMER_NUMOF > 2
case 2:
PCONP |= (1 << 22);
PCLKSEL1 &= ~(0x03 << 12);
PCLKSEL1 |= (0x01 << 12);
install_irq(TIMER2_INT, &tim_isr_2, 1);
break;
#endif
#if TIMER_NUMOF > 3
case 3:
PCONP |= (1 << 23);
PCLKSEL1 &= ~(0x03 << 14);
PCLKSEL1 |= (0x01 << 14);
install_irq(TIMER3_INT, &tim_isr_3, 1);
break;
#endif
}
}
int timer_init(tim_t tim, unsigned long freq, timer_cb_t cb, void *arg)
{
/* get the timers base register */
lpc23xx_timer_t *dev = get_dev(tim);
/* make sure the timer device is valid */
if (dev == NULL) {
return -1;
}
/* save the callback */
isr_ctx[tim].cb = cb;
isr_ctx[tim].arg = arg;
/* enable power, config periph clock and install ISR vector */
pwr_clk_and_isr(tim);
/* reset timer configuration (sets the timer to timer mode) */
dev->TCR = 0;
dev->CTCR = 0;
/* configure the prescaler */
dev->PR = (CLOCK_PCLK / freq) - 1;
/* enable timer */
dev->TCR = 1;
return 0;
}
int timer_set(tim_t tim, int channel, unsigned int timeout)
{
unsigned int now = timer_read(tim);
return timer_set_absolute(tim, channel, (timeout + now));
}
int timer_set_absolute(tim_t tim, int channel, unsigned int value)
{
if (((unsigned) tim >= TIMER_NUMOF) || ((unsigned) channel >= TIMER_CHAN_NUMOF)) {
return -1;
}
lpc23xx_timer_t *dev = get_dev(tim);
dev->MR[channel] = value;
dev->MCR |= (1 << (channel * 3));
return 0;
}
int timer_clear(tim_t tim, int channel)
{
if (((unsigned) tim >= TIMER_NUMOF) || ((unsigned) channel >= TIMER_CHAN_NUMOF)) {
return -1;
}
get_dev(tim)->MCR &= ~(1 << (channel * 3));
return 0;
}
unsigned int timer_read(tim_t tim)
{
return (unsigned int)(get_dev(tim)->TC);
}
void timer_start(tim_t tim)
{
get_dev(tim)->TCR = 1;
}
void timer_stop(tim_t tim)
{
get_dev(tim)->TCR = 0;
}
void timer_irq_enable(tim_t tim)
{
(void) tim;
/* TODO */
}
void timer_irq_disable(tim_t tim)
{
(void) tim;
/* TODO */
}
static inline void isr_handler(lpc23xx_timer_t *dev, int tim_num)
{
for (unsigned i = 0; i < TIMER_CHAN_NUMOF; i++) {
if (dev->IR & (1 << i)) {
dev->IR |= (1 << i);
dev->MCR &= ~(1 << (i * 3));
isr_ctx[tim_num].cb(isr_ctx[tim_num].arg, i);
}
}
/* we must not forget to acknowledge the handling of the interrupt */
VICVectAddr = 0;
}
void __attribute__((interrupt("IRQ"))) tim_isr_0(void)
{
isr_handler(TMR0, 0);
}
#if TIMER_NUMOF > 1
void __attribute__((interrupt("IRQ"))) tim_isr_1(void)
{
isr_handler(TMR1, 1);
}
#endif
#if TIMER_NUMOF > 2
void __attribute__((interrupt("IRQ"))) tim_isr_2(void)
{
isr_handler(TMR2, 2);
}
#endif
#if TIMER_NUMOF > 3
void __attribute__((interrupt("IRQ"))) tim_isr_3(void)
{
isr_handler(TMR3, 3);
}
#endif
|