Remove unneeded instruction in AVR timer.
[bertos.git] / bertos / cpu / avr / drv / timer_mega.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 2005, 2010 Develer S.r.l. (http://www.develer.com/)
30  *
31  * -->
32  *
33  * \author Bernie Innocenti <bernie@codewiz.org>
34  * \author Francesco Sacchi <batt@develer.com>
35  * \author Luca Ottaviano <lottaviano@develer.com>
36  *
37  * \brief Low-level timer module for AVR MEGA (implementation).
38  *
39  * This module is automatically included so no need to include
40  * in test list.
41  * notest: avr
42  */
43
44 #include <drv/timer_mega.h>
45 #include <cfg/macros.h> // BV()
46
47 #include <cpu/types.h>
48 #include <cpu/irq.h>
49
50 #include <avr/io.h>
51
52 #if CPU_AVR_ATMEGA1281 || CPU_AVR_ATMEGA1280 || CPU_AVR_ATMEGA168 || CPU_AVR_ATMEGA328P || CPU_AVR_ATMEGA2560
53         #define REG_TIFR0 TIFR0
54         #define REG_TIFR1 TIFR1
55         #define REG_TIFR2 TIFR2
56         #if CPU_AVR_ATMEGA1281 || CPU_AVR_ATMEGA1280 || CPU_AVR_ATMEGA2560
57                 #define REG_TIFR3 TIFR3
58         #endif
59
60         #define REG_TIMSK0 TIMSK0
61         #define REG_TIMSK1 TIMSK1
62         #define REG_TIMSK2 TIMSK2
63         #if CPU_AVR_ATMEGA1281 || CPU_AVR_ATMEGA1280 || CPU_AVR_ATMEGA2560
64                 #define REG_TIMSK3 TIMSK3
65         #endif
66
67         #define REG_TCCR0A TCCR0A
68         #define REG_TCCR0B TCCR0B
69
70         #define REG_TCCR2A TCCR2A
71         #define REG_TCCR2B TCCR2B
72
73         #define REG_OCR0A  OCR0A
74         #define REG_OCR2A  OCR2A
75
76         #define BIT_OCF0A  OCF0A
77         #define BIT_OCF2A  OCF2A
78
79         #define BIT_OCIE0A OCIE0A
80         #define BIT_OCIE2A OCIE2A
81 #else
82         #define REG_TIFR0 TIFR
83         #define REG_TIFR1 TIFR
84         #define REG_TIFR2 TIFR
85         #define REG_TIFR3 TIFR
86
87         #define REG_TIMSK0 TIMSK
88         #define REG_TIMSK1 TIMSK
89         #define REG_TIMSK2 TIMSK
90         #define REG_TIMSK3 ETIMSK
91
92         #define REG_TCCR0A TCCR0
93         #define REG_TCCR0B TCCR0
94
95         #define REG_TCCR2A TCCR2
96         #define REG_TCCR2B TCCR2
97
98         #define REG_OCR0A  OCR0
99         #define REG_OCR2A  OCR2
100
101         #define BIT_OCF0A  OCF0
102         #define BIT_OCF2A  OCF2
103
104         #define BIT_OCIE0A OCIE0
105         #define BIT_OCIE2A OCIE2
106 #endif
107
108 #if CPU_AVR_ATMEGA128 || CPU_AVR_ATMEGA64 || CPU_AVR_ATMEGA103
109     /* These ATMega have different prescaler options. */
110     #define TIMER0_PRESCALER_64 BV(CS02)
111     #define TIMER2_PRESCALER_64 (BV(CS21) | BV(CS20))
112 #else
113     #define TIMER0_PRESCALER_64 (BV(CS01) | BV(CS00))
114     #define TIMER2_PRESCALER_64 BV(CS22)
115 #endif
116
117 /** HW dependent timer initialization  */
118 #if (CONFIG_TIMER == TIMER_ON_OUTPUT_COMPARE0)
119
120         void timer_hw_init(void)
121         {
122                 cpu_flags_t flags;
123                 IRQ_SAVE_DISABLE(flags);
124
125                 /* Reset Timer flags */
126                 REG_TIFR0 = BV(BIT_OCF0A) | BV(TOV0);
127
128                 /* Setup Timer/Counter interrupt */
129                 REG_TCCR0A = 0; // TCCR2 reg could be separate or a unique register with both A & B values, this is needed to
130                 REG_TCCR0B = 0;
131
132                 REG_TCCR0A = BV(WGM01);             /* Clear on Compare match */
133                         #if TIMER_PRESCALER == 64
134                         REG_TCCR0B |= TIMER0_PRESCALER_64;
135                         #else
136                                 #error Unsupported value of TIMER_PRESCALER
137                         #endif
138
139                 TCNT0 = 0x00;                 /* Initialization of Timer/Counter */
140                 REG_OCR0A = OCR_DIVISOR;           /* Timer/Counter Output Compare Register */
141
142                 /* Enable timer interrupts: Timer/Counter2 Output Compare (OCIE2) */
143                 REG_TIMSK0 &= ~BV(TOIE0);
144                 REG_TIMSK0 |= BV(BIT_OCIE0A);
145
146                 IRQ_RESTORE(flags);
147         }
148
149 #elif (CONFIG_TIMER == TIMER_ON_OVERFLOW1)
150
151         void timer_hw_init(void)
152         {
153                 cpu_flags_t flags;
154                 IRQ_SAVE_DISABLE(flags);
155
156                 /* Reset Timer overflow flag */
157                 REG_TIFR1 |= BV(TOV1);
158
159                 /* Fast PWM mode, 9 bit, 24 kHz, no prescaling. */
160                 #if (TIMER_PRESCALER == 1) && (TIMER_HW_BITS == 9)
161                         TCCR1A |= BV(WGM11);
162                         TCCR1A &= ~BV(WGM10);
163                         TCCR1B |= BV(WGM12) | BV(CS10);
164                         TCCR1B &= ~(BV(WGM13) | BV(CS11) | BV(CS12));
165                 /* Fast PWM mode, 8 bit, 24 kHz, no prescaling. */
166                 #elif (TIMER_PRESCALER == 1) && (TIMER_HW_BITS == 8)
167                         TCCR1A |= BV(WGM10);
168                         TCCR1A &= ~BV(WGM11);
169                         TCCR1B |= BV(WGM12) | BV(CS10);
170                         TCCR1B &= ~(BV(WGM13) | BV(CS11) | BV(CS12));
171                 #else
172                         #error Unsupported value of TIMER_PRESCALER or TIMER_HW_BITS
173                 #endif
174
175                 TCNT1 = 0x00;         /* initialization of Timer/Counter */
176
177                 /* Enable timer interrupt: Timer/Counter1 Overflow */
178                 REG_TIMSK1 |= BV(TOIE1);
179
180                 IRQ_RESTORE(flags);
181         }
182
183 #elif (CONFIG_TIMER == TIMER_ON_OUTPUT_COMPARE2)
184         void timer_hw_init(void)
185         {
186                 cpu_flags_t flags;
187                 IRQ_SAVE_DISABLE(flags);
188
189                 /* Reset Timer flags */
190                 REG_TIFR2 = BV(BIT_OCF2A) | BV(TOV2);
191
192                 /* Setup Timer/Counter interrupt */
193                 REG_TCCR2A = 0; // TCCR2 reg could be separate or a unique register with both A & B values, this is needed to
194                 REG_TCCR2B = 0; // ensure correct initialization.
195
196                 REG_TCCR2A = BV(WGM21);
197                 #if TIMER_PRESCALER == 64
198                         REG_TCCR2B |= TIMER2_PRESCALER_64;
199                 #else
200                         #error Unsupported value of TIMER_PRESCALER
201                 #endif
202
203                 /* Clear on Compare match & prescaler = 64, internal sys clock.
204                    When changing prescaler change TIMER_HW_HPTICKS_PER_SEC too */
205                 TCNT2 = 0x00;         /* initialization of Timer/Counter */
206                 REG_OCR2A = (uint8_t)OCR_DIVISOR;   /* Timer/Counter Output Compare Register */
207
208                 /* Enable timer interrupts: Timer/Counter2 Output Compare (OCIE2) */
209                 REG_TIMSK2 &= ~BV(TOIE2);
210                 REG_TIMSK2 |= BV(BIT_OCIE2A);
211
212                 IRQ_RESTORE(flags);
213         }
214
215 #elif (CONFIG_TIMER == TIMER_ON_OVERFLOW3)
216
217         #if CPU_AVR_ATMEGA168 || CPU_AVR_ATMEGA328P || CPU_AVR_ATMEGA32
218                 #error For select target there is not TIMER_ON_OVERFLOW3, please select an other one.
219         #endif
220
221         void timer_hw_init(void)
222         {
223                 cpu_flags_t flags;
224                 IRQ_SAVE_DISABLE(flags);
225
226                 /* Reset Timer overflow flag */
227                 REG_TIFR3 |= BV(TOV3);
228
229                 /* Fast PWM mode, 9 bit, 24 kHz, no prescaling. */
230                 #if (TIMER_PRESCALER == 1) && (TIMER_HW_BITS == 9)
231                         TCCR3A |= BV(WGM31);
232                         TCCR3A &= ~BV(WGM30);
233                         TCCR3B |= BV(WGM32) | BV(CS30);
234                         TCCR3B &= ~(BV(WGM33) | BV(CS31) | BV(CS32));
235                 /* Fast PWM mode, 8 bit, 24 kHz, no prescaling. */
236                 #elif (TIMER_PRESCALER == 1) && (TIMER_HW_BITS == 8)
237                         TCCR3A |= BV(WGM30);
238                         TCCR3A &= ~BV(WGM31);
239                         TCCR3B |= BV(WGM32) | BV(CS30);
240                         TCCR3B &= ~(BV(WGM33) | BV(CS31) | BV(CS32));
241                 #else
242                         #error Unsupported value of TIMER_PRESCALER or TIMER_HW_BITS
243                 #endif
244
245                 /* initialization of Timer/Counter */
246                 TCNT3 = 0x00;
247
248                 /* Enable timer interrupt: Timer/Counter3 Overflow */
249                 REG_TIMSK3 |= BV(TOIE3);
250
251                 IRQ_RESTORE(flags);
252         }
253
254 #else
255         #error Unimplemented value for CONFIG_TIMER
256 #endif /* CONFIG_TIMER */
257