nuclear@1: /*
nuclear@22: pit8254 timer code for DOS programs.
nuclear@22: Copyright (C) 2011-2014  John Tsiombikas <nuclear@member.fsf.org>
nuclear@1: 
nuclear@1: This program is free software: you can redistribute it and/or modify
nuclear@1: it under the terms of the GNU General Public License as published by
nuclear@1: the Free Software Foundation, either version 3 of the License, or
nuclear@1: (at your option) any later version.
nuclear@1: 
nuclear@1: This program is distributed in the hope that it will be useful,
nuclear@1: but WITHOUT ANY WARRANTY; without even the implied warranty of
nuclear@1: MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
nuclear@1: GNU General Public License for more details.
nuclear@1: 
nuclear@1: You should have received a copy of the GNU General Public License
nuclear@1: along with this program.  If not, see <http://www.gnu.org/licenses/>.
nuclear@1: */
nuclear@1: #include <stdio.h>
nuclear@1: #include <stdlib.h>
nuclear@1: #include <conio.h>
nuclear@1: #include <dos.h>
nuclear@1: #include <i86.h>
nuclear@1: #include "pit8254.h"
nuclear@1: 
nuclear@22: #ifdef BORLANDC
nuclear@22: #error borland unsupported
nuclear@22: #endif
nuclear@22: 
nuclear@1: #define PIT_TIMER_INTR	8
nuclear@1: #define DOS_TIMER_INTR	0x1c
nuclear@1: 
nuclear@1: /* macro to divide and round to the nearest integer */
nuclear@1: #define DIV_ROUND(a, b) \
nuclear@1: 	((a) / (b) + ((a) % (b)) / ((b) / 2))
nuclear@1: 
nuclear@1: static void set_timer_reload(int reload_val);
nuclear@1: static void cleanup(void);
nuclear@1: static void __interrupt __far timer_irq();
nuclear@1: static void __interrupt __far dos_timer_intr();
nuclear@1: 
nuclear@1: static void (__interrupt __far *prev_timer_intr)();
nuclear@1: 
nuclear@1: static unsigned long ticks;
nuclear@1: static unsigned long tick_interval, ticks_per_dos_intr;
nuclear@1: static int inum;
nuclear@1: 
nuclear@1: void init_timer(int res_hz)
nuclear@1: {
nuclear@1: 	_disable();
nuclear@1: 
nuclear@1: 	if(res_hz > 0) {
nuclear@1: 		int reload_val = DIV_ROUND(OSC_FREQ_HZ, res_hz);
nuclear@1: 		set_timer_reload(reload_val);
nuclear@1: 
nuclear@1: 		tick_interval = DIV_ROUND(1000, res_hz);
nuclear@1: 		ticks_per_dos_intr = DIV_ROUND(65535L, reload_val);
nuclear@1: 
nuclear@1: 		inum = PIT_TIMER_INTR;
nuclear@1: 		prev_timer_intr = _dos_getvect(inum);
nuclear@1: 		_dos_setvect(inum, timer_irq);
nuclear@1: 	} else {
nuclear@1: 		tick_interval = 55;
nuclear@1: 
nuclear@1: 		inum = DOS_TIMER_INTR;
nuclear@1: 		prev_timer_intr = _dos_getvect(inum);
nuclear@1: 		_dos_setvect(inum, dos_timer_intr);
nuclear@1: 	}
nuclear@1: 	_enable();
nuclear@1: 
nuclear@1: 	atexit(cleanup);
nuclear@1: }
nuclear@1: 
nuclear@1: static void cleanup(void)
nuclear@1: {
nuclear@1: 	if(!prev_timer_intr) {
nuclear@1: 		return; /* init hasn't ran, there's nothing to cleanup */
nuclear@1: 	}
nuclear@1: 
nuclear@1: 	_disable();
nuclear@1: 	if(inum == PIT_TIMER_INTR) {
nuclear@1: 		/* restore the original timer frequency */
nuclear@1: 		set_timer_reload(65535);
nuclear@1: 	}
nuclear@1: 
nuclear@1: 	/* restore the original interrupt handler */
nuclear@1: 	_dos_setvect(inum, prev_timer_intr);
nuclear@1: 	_enable();
nuclear@1: }
nuclear@1: 
nuclear@1: void reset_timer(void)
nuclear@1: {
nuclear@1: 	ticks = 0;
nuclear@1: }
nuclear@1: 
nuclear@1: unsigned long get_msec(void)
nuclear@1: {
nuclear@1: 	return ticks * tick_interval;
nuclear@1: }
nuclear@1: 
nuclear@1: static void set_timer_reload(int reload_val)
nuclear@1: {
nuclear@1: 	outp(PORT_CMD, CMD_CHAN0 | CMD_ACCESS_BOTH | CMD_OP_SQWAVE);
nuclear@1: 	outp(PORT_DATA0, reload_val & 0xff);
nuclear@1: 	outp(PORT_DATA0, (reload_val >> 8) & 0xff);
nuclear@1: }
nuclear@1: 
nuclear@1: static void __interrupt __far dos_timer_intr()
nuclear@1: {
nuclear@1: 	ticks++;
nuclear@1: 	_chain_intr(prev_timer_intr);	/* DOES NOT RETURN */
nuclear@1: }
nuclear@1: 
nuclear@1: /* first PIC command port */
nuclear@1: #define PIC1_CMD	0x20
nuclear@1: /* end of interrupt control word */
nuclear@1: #define OCW2_EOI	(1 << 5)
nuclear@1: 
nuclear@1: static void __interrupt __far timer_irq()
nuclear@1: {
nuclear@1: 	static unsigned long dos_ticks;
nuclear@1: 
nuclear@1: 	ticks++;
nuclear@1: 
nuclear@1: 	if(++dos_ticks >= ticks_per_dos_intr) {
nuclear@1: 		/* I suppose the dos irq handler does the EOI so I shouldn't
nuclear@1: 		 * do it if I am to call the previous function
nuclear@1: 		 */
nuclear@1: 		dos_ticks = 0;
nuclear@1: 		_chain_intr(prev_timer_intr);	/* XXX DOES NOT RETURN */
nuclear@1: 		return;	/* just for clarity */
nuclear@1: 	}
nuclear@1: 
nuclear@1: 	/* send EOI to the PIC */
nuclear@1: 	outp(PIC1_CMD, OCW2_EOI);
nuclear@1: }