Add CP/M 3 file i/o (initial version)

[z180-stamp.git] / avr / timer.c

diff --git a/avr/timer.c b/avr/timer.c
index 56c7bedd5d0609f548c762cdff549e19e8046e2b..f45f2675564f0f26028774de91c63b0ae395f5d5 100644 (file)
--- a/avr/timer.c
+++ b/avr/timer.c
@@ -1,64 +1,54 @@
 /*
+ * (C) Copyright 2014 Leo C. <erbl259-lmu@yahoo.de>
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
  */
 
-
 #include "common.h"
-
-//#include <avr/power.h>
-//#include <avr/pgmspace.h>
 #include <avr/interrupt.h>
 #include <util/atomic.h>
-
-//#include <stdio.h>
-
-
+#include "time.h"
 #include "timer.h"
 
 /* timer interrupt/overflow counter */
-volatile uint32_t timestamp;
-
-
-/*---------------------------------------------------------*/
-/* 1000Hz timer interrupt generated by OC2A                */
-/*---------------------------------------------------------*/
+/* counts up every ms. */
+static volatile
+uint32_t timestamp;
 
-ISR(TIMER2_COMPA_vect)
+/*
+ * 1000Hz timer interrupt generated by OC3A
+ */
+ISR(TIMER3_COMPA_vect)
 {
        static int_fast8_t tick_10ms;
-       int_fast8_t i;
+       static int_fast8_t tick_1s;
+       int_fast8_t i, j;
 
+       extern void disk_timerproc(void);
 
        timestamp++;
 
        i = tick_10ms + 1;
        if (i == 10) {
-               i = 0;
                Stat |= S_10MS_TO;
 
                /* Drive timer procedure of low level disk I/O module */
-               //disk_timerproc();
+               disk_timerproc();
+
+               j = tick_1s - 1;
+               if (j == 0) {
+                       system_tick();
+                       j = 100;
+               }
+               tick_1s = j;
+               i = 0;
        }
        tick_10ms = i;
-
 }
 
 
-
 /*--------------------------------------------------------------------------*/
 
-#if 0
-
-void do_10ms(void)
-{
-               if (to_counter)
-                       to_counter--;
-}
-
-#endif
-
-/*--------------------------------------------------------------------------*/
-
-
 #if 0
 void timer_setup(void)
 {
@@ -75,14 +65,14 @@ void timer_setup(void)
 }
 #endif
 
+/*--------------------------------------------------------------------------*/
+
 uint32_t get_timer(uint32_t base)
 {
        uint32_t ret;
-
        ATOMIC_BLOCK(ATOMIC_FORCEON)
        {
                ret = timestamp;
        }
        return ret - base;
 }
-