X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fcpu%2Favr%2Fdrv%2Ftimer_avr.c;h=ee63e76f8d419846eca22e64845a8f3d527a4556;hb=517cca1528492422030102f6c1a6691420c1c1a0;hp=4920934756467a5b271be1c04610ce0cb80060b4;hpb=a997259423a94b2f21d3cd995b9bdeee5e17bef3;p=bertos.git

diff --git a/bertos/cpu/avr/drv/timer_avr.c b/bertos/cpu/avr/drv/timer_avr.c
index 49209347..ee63e76f 100644
--- a/bertos/cpu/avr/drv/timer_avr.c
+++ b/bertos/cpu/avr/drv/timer_avr.c
@@ -26,14 +26,13 @@
  * invalidate any other reasons why the executable file might be covered by
  * the GNU General Public License.
  *
- * Copyright 2005 Develer S.r.l. (http://www.develer.com/)
+ * Copyright 2005, 2010 Develer S.r.l. (http://www.develer.com/)
  *
  * -->
  *
- * \version $Id$
- *
  * \author Bernie Innocenti <bernie@codewiz.org>
  * \author Francesco Sacchi <batt@develer.com>
+ * \author Luca Ottaviano <lottaviano@develer.com>
  *
  * \brief Low-level timer module for AVR (implementation).
  *
@@ -48,21 +47,20 @@
 #include <cpu/types.h>
 #include <cpu/irq.h>
 
-#include <avr/interrupt.h>
 #include <avr/io.h>
 
-#if CPU_AVR_ATMEGA1281 || CPU_AVR_ATMEGA168
+#if CPU_AVR_ATMEGA1281 || CPU_AVR_ATMEGA1280 || CPU_AVR_ATMEGA168 || CPU_AVR_ATMEGA328P || CPU_AVR_ATMEGA2560
 	#define REG_TIFR0 TIFR0
 	#define REG_TIFR1 TIFR1
 	#define REG_TIFR2 TIFR2
-	#if CPU_AVR_ATMEGA1281
+	#if CPU_AVR_ATMEGA1281 || CPU_AVR_ATMEGA1280 || CPU_AVR_ATMEGA2560
 		#define REG_TIFR3 TIFR3
 	#endif
 
 	#define REG_TIMSK0 TIMSK0
 	#define REG_TIMSK1 TIMSK1
 	#define REG_TIMSK2 TIMSK2
-	#if CPU_AVR_ATMEGA1281
+	#if CPU_AVR_ATMEGA1281 || CPU_AVR_ATMEGA1280 || CPU_AVR_ATMEGA2560
 		#define REG_TIMSK3 TIMSK3
 	#endif
 
@@ -84,6 +82,7 @@
 	#define REG_TIFR0 TIFR
 	#define REG_TIFR1 TIFR
 	#define REG_TIFR2 TIFR
+	#define REG_TIFR3 TIFR
 
 	#define REG_TIMSK0 TIMSK
 	#define REG_TIMSK1 TIMSK
@@ -118,7 +117,7 @@
 /** HW dependent timer initialization  */
 #if (CONFIG_TIMER == TIMER_ON_OUTPUT_COMPARE0)
 
-	static void timer_hw_init(void)
+	void timer_hw_init(void)
 	{
 		cpu_flags_t flags;
 		IRQ_SAVE_DISABLE(flags);
@@ -138,7 +137,7 @@
 			#else
 				#error Unsupported value of TIMER_PRESCALER
 			#endif
-		;
+
 		TCNT0 = 0x00;                 /* Initialization of Timer/Counter */
 		REG_OCR0A = OCR_DIVISOR;           /* Timer/Counter Output Compare Register */
 
@@ -149,14 +148,9 @@
 		IRQ_RESTORE(flags);
 	}
 
-	INLINE hptime_t timer_hw_hpread(void)
-	{
-		return TCNT0;
-	}
-
 #elif (CONFIG_TIMER == TIMER_ON_OVERFLOW1)
 
-	static void timer_hw_init(void)
+	void timer_hw_init(void)
 	{
 		cpu_flags_t flags;
 		IRQ_SAVE_DISABLE(flags);
@@ -188,13 +182,8 @@
 		IRQ_RESTORE(flags);
 	}
 
-	INLINE hptime_t timer_hw_hpread(void)
-	{
-		return TCNT1;
-	}
-
 #elif (CONFIG_TIMER == TIMER_ON_OUTPUT_COMPARE2)
-	static void timer_hw_init(void)
+	void timer_hw_init(void)
 	{
 		cpu_flags_t flags;
 		IRQ_SAVE_DISABLE(flags);
@@ -216,7 +205,7 @@
 		/* Clear on Compare match & prescaler = 64, internal sys clock.
 		   When changing prescaler change TIMER_HW_HPTICKS_PER_SEC too */
 		TCNT2 = 0x00;         /* initialization of Timer/Counter */
-		REG_OCR2A = OCR_DIVISOR;   /* Timer/Counter Output Compare Register */
+		REG_OCR2A = (uint8_t)OCR_DIVISOR;   /* Timer/Counter Output Compare Register */
 
 		/* Enable timer interrupts: Timer/Counter2 Output Compare (OCIE2) */
 		REG_TIMSK2 &= ~BV(TOIE2);
@@ -225,13 +214,13 @@
 		IRQ_RESTORE(flags);
 	}
 
-	INLINE hptime_t timer_hw_hpread(void)
-	{
-		return TCNT2;
-	}
 #elif (CONFIG_TIMER == TIMER_ON_OVERFLOW3)
 
-	static void timer_hw_init(void)
+	#if CPU_AVR_ATMEGA168 || CPU_AVR_ATMEGA328P || CPU_AVR_ATMEGA32
+		#error For select target there is not TIMER_ON_OVERFLOW3, please select an other one.
+	#endif
+
+	void timer_hw_init(void)
 	{
 		cpu_flags_t flags;
 		IRQ_SAVE_DISABLE(flags);
@@ -259,16 +248,11 @@
 		TCNT3 = 0x00;
 
 		/* Enable timer interrupt: Timer/Counter3 Overflow */
-		REG_TIMSK3 = |= BV(TOIE3);
+		REG_TIMSK3 |= BV(TOIE3);
 
 		IRQ_RESTORE(flags);
 	}
 
-	INLINE hptime_t timer_hw_hpread(void)
-	{
-		return TCNT3;
-	}
-
 #else
 	#error Unimplemented value for CONFIG_TIMER
 #endif /* CONFIG_TIMER */