bsp.cpp

Quantum Platform(QP) is a family of very lightweight, state machine-based frameworks for embedded sy

//////////////////////////////////////////////////////////////////////////////
// Product: QDPP example, DOS, Large model, Turbo C++ 1.01
// Last Updated for Version: 3.3.00
// Date of the Last Update:  Jan 24, 2007
//
//                    Q u a n t u m     L e a P s
//                    ---------------------------
//                    innovating embedded systems
//
// Copyright (C) 2002-2007 Quantum Leaps, LLC. All rights reserved.
//
// This software may be distributed and modified under the terms of the GNU
// General Public License version 2 (GPL) as published by the Free Software
// Foundation and appearing in the file GPL.TXT included in the packaging of
// this file. Please note that GPL Section 2[b] requires that all works based
// on this software must also be made publicly available under the terms of
// the GPL ("Copyleft").
//
// Alternatively, this software may be distributed and modified under the
// terms of Quantum Leaps commercial licenses, which expressly supersede
// the GPL and are specifically designed for licensees interested in
// retaining the proprietary status of their code.
//
// Contact information:
// Quantum Leaps Web site:  http://www.quantum-leaps.com
// e-mail:                  [e-mail]
//////////////////////////////////////////////////////////////////////////////
#include "qf_port.h"
#include "qdpp.h"
#include "qassert.h"

#include <conio.h>
#include <stdlib.h>
#include <stdio.h>
#include <time.h>

// Local-scope objects -------------------------------------------------------
static void interrupt (*l_dosTmrISR)(...);
static void interrupt (*l_dosKbdISR)(...);
static void interrupt (*l_dosSpareISR)(...);

#define TMR_VECTOR      0x08
#define KBD_VECTOR      0x09
#define SPARE_VECTOR    0x81

//............................................................................
static void interrupt tmrISR(...) {
    QF_INT_UNLOCK(ignore);                                // unlock interrupts
    QF::tick();                                //<-- process the QF clock tick
    QF_INT_LOCK(ignore);                              // lock interrupts again
    geninterrupt(SPARE_VECTOR);        // invoke the DOS timer ISR, see NOTE01
}
//............................................................................
static void interrupt kbdISR(...) {
    uint8_t key = inport(0x60);  // key scan code from the 8042 kbd controller
    uint8_t kcr = inport(0x61);               // get keyboard control register
    outportb(0x61, (uint8_t)(kcr | 0x80));      // toggle acknowledge bit high
    outportb(0x61, kcr);                         // toggle acknowledge bit low
    QF_INT_UNLOCK(ignore);                                // unlock interrupts

    if (key == (uint8_t)129) {                             // ESC key pressed?
        QF::publish(Q_NEW(QEvent, TERMINATE_SIG));
    }

    QF_INT_LOCK(ignore);                              // lock interrupts again
    outportb(0x20, 0x20);                  // write EOC to the master 8259 PIC
}
//............................................................................
void QF::init(void) {
}
//............................................................................
void QF::start(void) {
                                         // save the origingal DOS vectors ...
    l_dosTmrISR   = getvect(TMR_VECTOR);
    l_dosKbdISR   = getvect(KBD_VECTOR);
    l_dosSpareISR = getvect(SPARE_VECTOR);

    QF_INT_LOCK(ignore);
    setvect(TMR_VECTOR, &tmrISR);
    setvect(KBD_VECTOR, &kbdISR);
    setvect(SPARE_VECTOR, l_dosTmrISR);
    QF_INT_UNLOCK(ignore);
}
//............................................................................
void QF::onIdle(void) {             /* NOTE: entered with interrupts LOCKED */
    enable();                            /* must at least unlock interrupts */
}
//............................................................................
void QF::exit(void) {
                                       // restore the original DOS vectors ...
    QF_INT_LOCK(ignore);
    setvect(TMR_VECTOR, l_dosTmrISR);
    setvect(KBD_VECTOR, l_dosKbdISR);
    setvect(SPARE_VECTOR, l_dosSpareISR);
    QF_INT_UNLOCK(ignore);

    _exit(0);                                                   // exit to DOS
}
//............................................................................
void Q_assert_handler(char const Q_ROM * const Q_ROM_VAR file, int line) {
    fprintf(stderr, "Assertion failed in %s, line %d", file, line);
    QF::exit();
}
//............................................................................
void displyPhilStat(uint8_t n, char const *stat) {
    printf("Philosopher %2d is %s\n", (int)n, stat);
}

//////////////////////////////////////////////////////////////////////////////
//
// NOTE01:
// The tick ISR generates at the end the software interrupt to invoke the
// original DOS tick ISR handler, which was installed at the spare vector
// 0x81. The DOS tick ISR handler generates the EOI (End-Of-Interrupt)
// to the master 8259 PIC.