X-Git-Url: http://cloudbase.mooo.com/gitweb/z180-stamp.git/blobdiff_plain/209025e847108189669989a3715667aae4f17b54..dbc1de70e1824cf1a649d892db5746b86b34b4e7:/avr/main.c

diff --git a/avr/main.c b/avr/main.c
index 1fba3cb..486e15c 100644
--- a/avr/main.c
+++ b/avr/main.c
@@ -84,7 +84,7 @@ void print_reset_reason(void)
 
 ISR(INT5_vect)
 {
-	Stat |= S_MSG_PENDING;
+	Stat |= S_MSG_PENDING + S_IO_0X40;
 }
 
 ISR(INT6_vect)
@@ -110,7 +110,7 @@ void setup_avr(void)
 		_BV(PRUSART3) | _BV(PRUSART2) | _BV(PRUSART1);
 
 
-	/* disable analog comparator */
+	/* Disable analog comparator */
 	ACSR = _BV(ACD);
 	/* Ports */
 
@@ -118,11 +118,8 @@ void setup_avr(void)
 	CLKPR = _BV(CLKPCE);
 	CLKPR = 0;
 
-	/* Timer */
-	PRR1 &= ~_BV(PRTIM4);
-	OCR4A = F_CPU / 1000 - 1;	/* Timer4: 1000Hz interval */
-	TCCR4B = (0b00<<WGM42)|(0b001<<CS40); /* Normal Mode, Prescaler 1 */
-	TIMSK4 = _BV(OCIE4A);		/* Enable Output Compare A interrupt */
+	/* System timer */
+	setup_timer();
 
 	/* INT5, INT6: falling edge */
 	EICRB = (EICRB & ~((0b11 << ISC50) | (0b11 << ISC60))) |