git.mutantstargoat.com Git - xdos/blob - src/dos/timer.c

   1 /*
   2 pit8254 timer code for DOS programs.
   3 Copyright (C) 2011-2014  John Tsiombikas <nuclear@member.fsf.org>
   4
   5 This program is free software: you can redistribute it and/or modify
   6 it under the terms of the GNU General Public License as published by
   7 the Free Software Foundation, either version 3 of the License, or
   8 (at your option) any later version.
   9
  10 This program is distributed in the hope that it will be useful,
  11 but WITHOUT ANY WARRANTY; without even the implied warranty of
  12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13 GNU General Public License for more details.
  14
  15 You should have received a copy of the GNU General Public License
  16 along with this program.  If not, see <http://www.gnu.org/licenses/>.
  17 */
  18 #include <stdio.h>
  19 #include <stdlib.h>
  20 #include <conio.h>
  21 #include <dos.h>
  22 #include <i86.h>
  23 #include "pit8254.h"
  24
  25 #ifdef BORLANDC
  26 #error borland unsupported
  27 #endif
  28
  29 #define PIT_TIMER_INTR  8
  30 #define DOS_TIMER_INTR  0x1c
  31
  32 /* macro to divide and round to the nearest integer */
  33 #define DIV_ROUND(a, b) \
  34         ((a) / (b) + ((a) % (b)) / ((b) / 2))
  35
  36 static void set_timer_reload(int reload_val);
  37 static void cleanup(void);
  38 static void __interrupt __far timer_irq();
  39 static void __interrupt __far dos_timer_intr();
  40
  41 static void (__interrupt __far *prev_timer_intr)();
  42
  43 static unsigned long ticks;
  44 static unsigned long tick_interval, ticks_per_dos_intr;
  45 static int inum;
  46
  47 void init_timer(int res_hz)
  48 {
  49         _disable();
  50
  51         if(res_hz > 0) {
  52                 int reload_val = DIV_ROUND(OSC_FREQ_HZ, res_hz);
  53                 set_timer_reload(reload_val);
  54
  55                 tick_interval = DIV_ROUND(1000, res_hz);
  56                 ticks_per_dos_intr = DIV_ROUND(65535L, reload_val);
  57
  58                 inum = PIT_TIMER_INTR;
  59                 prev_timer_intr = _dos_getvect(inum);
  60                 _dos_setvect(inum, timer_irq);
  61         } else {
  62                 tick_interval = 55;
  63
  64                 inum = DOS_TIMER_INTR;
  65                 prev_timer_intr = _dos_getvect(inum);
  66                 _dos_setvect(inum, dos_timer_intr);
  67         }
  68         _enable();
  69
  70         atexit(cleanup);
  71 }
  72
  73 static void cleanup(void)
  74 {
  75         if(!prev_timer_intr) {
  76                 return; /* init hasn't ran, there's nothing to cleanup */
  77         }
  78
  79         _disable();
  80         if(inum == PIT_TIMER_INTR) {
  81                 /* restore the original timer frequency */
  82                 set_timer_reload(65535);
  83         }
  84
  85         /* restore the original interrupt handler */
  86         _dos_setvect(inum, prev_timer_intr);
  87         _enable();
  88 }
  89
  90 void reset_timer(void)
  91 {
  92         ticks = 0;
  93 }
  94
  95 unsigned long get_msec(void)
  96 {
  97         return ticks * tick_interval;
  98 }
  99
 100 static void set_timer_reload(int reload_val)
 101 {
 102         outp(PORT_CMD, CMD_CHAN0 | CMD_ACCESS_BOTH | CMD_OP_SQWAVE);
 103         outp(PORT_DATA0, reload_val & 0xff);
 104         outp(PORT_DATA0, (reload_val >> 8) & 0xff);
 105 }
 106
 107 static void __interrupt __far dos_timer_intr()
 108 {
 109         ticks++;
 110         _chain_intr(prev_timer_intr);   /* DOES NOT RETURN */
 111 }
 112
 113 /* first PIC command port */
 114 #define PIC1_CMD        0x20
 115 /* end of interrupt control word */
 116 #define OCW2_EOI        (1 << 5)
 117
 118 static void __interrupt __far timer_irq()
 119 {
 120         static unsigned long dos_ticks;
 121
 122         ticks++;
 123
 124         if(++dos_ticks >= ticks_per_dos_intr) {
 125                 /* I suppose the dos irq handler does the EOI so I shouldn't
 126                  * do it if I am to call the previous function
 127                  */
 128                 dos_ticks = 0;
 129                 _chain_intr(prev_timer_intr);   /* XXX DOES NOT RETURN */
 130                 return; /* just for clarity */
 131         }
 132
 133         /* send EOI to the PIC */
 134         outp(PIC1_CMD, OCW2_EOI);
 135 }