X-Git-Url: http://cloudbase.mooo.com/gitweb/z180-stamp.git/blobdiff_plain/fc30b18e2023806ace24dd857ed851c491f81e50..6035a17b2becc788c0daaf440deb6cc37d364029:/avr/main.c

diff --git a/avr/main.c b/avr/main.c
index a09f05c..65622cc 100644
--- a/avr/main.c
+++ b/avr/main.c
@@ -26,7 +26,7 @@ static uint8_t mcusr;
 /*--------------------------------------------------------------------------*/
 #if DEBUG
 
-__attribute__ ((naked)) __attribute__ ((section (".init3"))) 
+__attribute__ ((naked)) __attribute__ ((section (".init3")))
 void preset_ram (void)
 {
 	for (uint8_t *p = RAMSTART; p <= (uint8_t *) RAMEND; p++)
@@ -68,7 +68,7 @@ void setup_avr(void)
 	/* TODO: move to init section? */
 	mcusr = MCUSR;
 	MCUSR = 0;
-	
+
 	/* WD */
 
 	/* CPU */
@@ -77,9 +77,9 @@ void setup_avr(void)
 	MCUCR = _BV(JTD);
 	MCUCR = _BV(JTD);
 
-	/* disable unused periphels */
-	PRR0 = _BV(PRTIM2) | _BV(PRTIM0) | _BV(PRADC);
-	PRR1 = _BV(PRTIM5) | _BV(PRTIM4) | _BV(PRTIM3) | 
+	/* disable unused peripherals */
+	PRR0 = _BV(PRTIM0) | _BV(PRADC);
+	PRR1 = _BV(PRTIM5) | _BV(PRTIM4) | _BV(PRTIM3) |
 		_BV(PRUSART3) | _BV(PRUSART2) | _BV(PRUSART1);
 
 	/* disable analog comparator */
@@ -92,9 +92,10 @@ void setup_avr(void)
 
 	/* Timer */
 
-	OCR1A = F_CPU / 8 / 1000 - 1; // Timer1: 1000Hz interval (OC1A)
-	TCCR1B = 0b00001010;
-	TIMSK1 = _BV(OCIE1A); // Enable TC1.oca interrupt
+	OCR2A = F_CPU / 256 / 1000 - 1; /* Timer2: 1000Hz interval (OC2A) */
+	TCCR2A = (0b10 << WGM20);	/* CTC Mode */
+	TCCR2B = (0b110 << CS20);	/* Prescaler 256 */
+	TIMSK2 = _BV(OCIE2A);		/* Enable TC2.oca interrupt */
 }
 
 static
@@ -111,7 +112,7 @@ static int  stored_bootdelay;
 
 /***************************************************************************
  * Watch for 'delay' seconds for autoboot stop.
- * returns: 0 - no key, allow autoboot 
+ * returns: 0 - no key, allow autoboot
  *          1 - got key, abort
  */
 
@@ -207,7 +208,7 @@ int main(void)
 
 	if (reset_reason_is_power_on())
 		_delay_ms(CONFIG_PWRON_DELAY);
-	
+
 	serial_setup(getenv_ulong(PSTR("baudrate"), 10, CONFIG_BAUDRATE));
 	sei();
 
@@ -215,7 +216,7 @@ int main(void)
 	debug("\n=========================<  (RE)START DEBUG  >=========================\n");
 	print_reset_reason();
 #endif
-		
+
 #if DEBUG
 	unsigned long i_speed = getenv_ulong(PSTR("i2c_clock"), 10, CONFIG_SYS_I2C_CLOCK);
 	debug("### Setting I2C clock Frequency to %lu Hz.\n", i_speed);
@@ -225,6 +226,7 @@ int main(void)
 #endif
 
 	printf_P(PSTR("\n(ATMEGA1281+HD64180)_stamp Tester\n"));
-	
+
+
 	main_loop();
 }