bacnet_stack/bacnet-stack/ports/dos/timer.c

/**************************************************************************
*
* Copyright (C) 2007 Steve Karg <skarg@users.sourceforge.net>
*
* Permission is hereby granted, free of charge, to any person obtaining
* a copy of this software and associated documentation files (the
* "Software"), to deal in the Software without restriction, including
* without limitation the rights to use, copy, modify, merge, publish,
* distribute, sublicense, and/or sell copies of the Software, and to
* permit persons to whom the Software is furnished to do so, subject to
* the following conditions:
*
* The above copyright notice and this permission notice shall be included
* in all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
*
*********************************************************************/
#include <stdint.h>
#include <stdio.h>
#include <dos.h>

/* global variable counts milliseconds */
volatile unsigned long Timer_Milliseconds;
/* MS/TP Silence Timer */
static volatile int SilenceTime;
/* counts ticks */
volatile unsigned long Timer_Milliseconds;

#define RTC_CMD_ADDR	0x70	// RTC internal register offset goes here 
#define RTC_DAT_ADDR	0x71	// RTC internal register R/W access here

static uint8_t RTC_RS_Convert(
    uint16_t hertz)
{
    uint8_t RS = 0;
    /* from DS12887A datasheet
    SELECT BITS     tPI PERIODIC  
    REGISTER A      INTERRUPT    SQW OUTPUT
    RS3 RS2 RS1 RS0 RATE         FREQUENCY
    --- --- --- --- ------------ ----------
     0   0   0   0  None         0Hz
     0   0   0   1  3.90625ms    256Hz
     0   0   1   0  7.8125ms     128Hz
     0   0   1   1  122.070µs    8192Hz
     0   1   0   0  244.141µs    4096Hz
     0   1   0   1  488.281µs    2048Hz
     0   1   1   0  976.5625µs   1024Hz
     0   1   1   1  1.953125ms   512Hz
     1   0   0   0  3.90625ms    256Hz
     1   0   0   1  7.8125ms     128Hz
     1   0   1   0  15.625ms     64Hz
     1   0   1   1  31.25ms      32Hz
     1   1   0   0  62.5ms       16Hz
     1   1   0   1  125ms        8Hz
     1   1   1   0  250ms        4Hz
     1   1   1   1  500ms        2Hz    
    */
    /* FIXME: create a clever formula to replace switch */
    switch (hertz) {
        case 8192: RS = 3; break;
        case 4096: RS = 4; break;
        case 2048: RS = 5; break;
        case 1024: RS = 6; break;
        case 512: RS = 7; break;
        case 256: RS = 8; break;
        case 128: RS = 9; break;
        case 64: RS = 10; break;
        case 32: RS = 11; break;
        case 16: RS = 12; break;
        case 8: RS = 13; break;
        case 4: RS = 14; break;
        case 2: RS = 15; break;
        default:
            break;
    }
        
    return RS;
}

/* setting for 8192 interrupts per second 
   which is an interrupt every 122uS. */
#define INT_FREQ 8192

static void interrupt Timer_Interrupt_Handler(
    void)
{
    static uint16_t Timer_Ticks = 0;
    static uint16_t Elapsed_Milliseconds = 0;
    uint16_t milliseconds = 0;
    uint16_t diff = 0;
    uint8_t temp_reg;

    Timer_Ticks++;
    milliseconds = (Timer_Ticks * 1000)/INT_FREQ;
    diff = milliseconds - Elapsed_Milliseconds;
    if (diff >= 1) {
        Elapsed_Milliseconds = milliseconds;
        Timer_Milliseconds++;
        if (SilenceTime < 60000)
            SilenceTime++;
    }
    /* max resolution */
    if (Timer_Ticks >= INT_FREQ) {
        Timer_Ticks = 0;
        Elapsed_Milliseconds = 0;
    }

    /* clear interrupt */    
    outportb( RTC_CMD_ADDR, 0x0C );	// select RTC register C
    temp_reg = inportb( RTC_DAT_ADDR );		// read   RTC register C
    /* signal end of interrupt to slave PIC */
    outportb( 0xA0, 0x20 );
    /* signal end of interrupt to master PIC */
    outportb( 0x20, 0x20 );
}

/* previous interrrupt vector */
static void interrupt(*OldVector)();		

void Timer_Cleanup(void)
{
    setvect(0x70,OldVector);		
}

void Timer_Init(
    void)
{
    uint8_t RC = RTC_RS_Convert(INT_FREQ);
    
    /*  get old interrupt vector to re-install on exit */
    OldVector = getvect(0x70);	
    /* disable interrupts */
    disable();
    /* set RTC int. vector for our routine */
    setvect(0x70,Timer_Interrupt_Handler);
    /* set register B with PIE enabled */
    outportb( RTC_CMD_ADDR, 0x0B );
    outportb( RTC_DAT_ADDR, 0x42 );
    /* set register A to our frequency */
    outportb( RTC_CMD_ADDR, 0x0A );
    outportb( RTC_DAT_ADDR, (0x20 | (RC & 0x0F)) );
    /* re-enable system interrupts */
    enable();
    atexit(Timer_Cleanup);
}

int Timer_Silence(
    void)
{
    uint16_t time_value;
    
    disable();
    time_value = SilenceTime;
    enable();

    return time_value;
}

void Timer_Silence_Reset(
    void)
{
    disable();
    SilenceTime = 0;
    enable();
}