//**************************************************************************** // Product: DPP example // Last Updated for Version: 5.0.0 // Date of the Last Update: Aug 24, 2013 // // Q u a n t u m L e a P s // --------------------------- // innovating embedded systems // // Copyright (C) 2002-2013 Quantum Leaps, LLC. All rights reserved. // // This program is open source software: you can redistribute it and/or // modify it under the terms of the GNU General Public License as published // by the Free Software Foundation, either version 2 of the License, or // (at your option) any later version. // // Alternatively, this program may be distributed and modified under the // terms of Quantum Leaps commercial licenses, which expressly supersede // the GNU General Public License and are specifically designed for // licensees interested in retaining the proprietary status of their code. // // This program is distributed in the hope that it will be useful, // but WITHOUT ANY WARRANTY; without even the implied warranty of // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the // GNU General Public License for more details. // // You should have received a copy of the GNU General Public License // along with this program. If not, see . // // Contact information: // Quantum Leaps Web sites: http://www.quantum-leaps.com // http://www.state-machine.com // e-mail: info@quantum-leaps.com //**************************************************************************** #include "qp_port.h" #include "dpp.h" #include "bsp.h" #include #include //**************************************************************************** namespace DPP { Q_DEFINE_THIS_FILE // local variables ----------------------------------------------------------- static uint32_t l_rnd; // random seed #ifdef Q_SPY enum { PHILO_STAT = QP::QS_USER }; static uint8_t const l_clock_tick = 0U; #endif //............................................................................ void BSP_init(void) { printf("Dining Philosopher Problem example" "\nQEP %s\nQF %s\n" "Press 'p' to pause/un-pause\n" "Press ESC to quit...\n", QP::QEP::getVersion(), QP::QF::getVersion()); BSP_randomSeed(1234U); Q_ALLEGE(QS_INIT((void *)0)); QS_RESET(); QS_OBJ_DICTIONARY(&l_clock_tick); // must be called *after* QF::init() QS_USR_DICTIONARY(PHILO_STAT); } //............................................................................ void BSP_terminate(int16_t result) { (void)result; QP::QF::stop(); // stop the main "ticker thread" } //............................................................................ void BSP_displayPhilStat(uint8_t n, char const *stat) { printf("Philosopher %2d is %s\n", (int)n, stat); QS_BEGIN(PHILO_STAT, AO_Philo[n]) // application-specific record begin QS_U8(1, n); // Philosopher number QS_STR(stat); // Philosopher status QS_END() } //............................................................................ void BSP_displayPaused(uint8_t paused) { printf("Paused is %s\n", paused ? "ON" : "OFF"); } //............................................................................ uint32_t BSP_random(void) { // a very cheap pseudo-random-number generator // "Super-Duper" Linear Congruential Generator (LCG) // LCG(2^32, 3*7*11*13*23, 0, seed) // l_rnd = l_rnd * (3*7*11*13*23); return l_rnd >> 8; } //............................................................................ void BSP_randomSeed(uint32_t seed) { l_rnd = seed; } } // namespace DPP //**************************************************************************** namespace QP { //............................................................................ void QF::onStartup(void) { QF_setTickRate(DPP::BSP_TICKS_PER_SEC); // set the desired tick rate } //............................................................................ void QF::onCleanup(void) { } //............................................................................ void QF_onClockTick(void) { QF::TICK(&DPP::l_clock_tick); // perform the QF clock tick processing if (_kbhit()) { // any key pressed? int ch = _getch(); if (ch == '\33') { // see if the ESC key pressed QF::PUBLISH(Q_NEW(QEvt, DPP::TERMINATE_SIG), &DPP::l_clock_tick); } else if (ch == 'p') { QF::PUBLISH(Q_NEW(QEvt, DPP::PAUSE_SIG), &DPP::l_clock_tick); } } } //............................................................................ extern "C" void Q_onAssert(char const Q_ROM * const file, int line) { fprintf(stderr, "Assertion failed in %s, line %d", file, line); QF::stop(); } //---------------------------------------------------------------------------- #ifdef Q_SPY // define QS callbacks #include #define WIN32_LEAN_AND_MEAN #include // Win32 API #include "qspy.h" // QSPY interface static bool l_running; //............................................................................ static DWORD WINAPI idleThread(LPVOID par) { // signature for CreateThread() (void)par; SetThreadPriority(GetCurrentThread(), THREAD_PRIORITY_IDLE); l_running = true; while (l_running) { uint16_t nBytes = 256; uint8_t const *block; QF_CRIT_ENTRY(dummy); block = QS::getBlock(&nBytes); QF_CRIT_EXIT(dummy); if (block != (uint8_t *)0) { QSPY_parse(block, nBytes); } Sleep(50); // wait for a while } return 0; // return success } //............................................................................ bool QS::onStartup(void const *arg) { static uint8_t qsBuf[4*1024]; // 4K buffer for Quantum Spy initBuf(qsBuf, sizeof(qsBuf)); (void)arg; QSPY_config(QP_VERSION, // version QS_OBJ_PTR_SIZE, // objPtrSize QS_FUN_PTR_SIZE, // funPtrSize QS_TIME_SIZE, // tstampSize Q_SIGNAL_SIZE, // sigSize, QF_EVENT_SIZ_SIZE, // evtSize QF_EQUEUE_CTR_SIZE, // queueCtrSize QF_MPOOL_CTR_SIZE, // poolCtrSize QF_MPOOL_SIZ_SIZE, // poolBlkSize QF_TIMEEVT_CTR_SIZE,// tevtCtrSize (void *)0, // matFile, (void *)0, (QSPY_CustParseFun)0); // customized parser function QS_FILTER_ON(QS_ALL_RECORDS); // QS_FILTER_OFF(QS_QEP_STATE_EMPTY); // QS_FILTER_OFF(QS_QEP_STATE_ENTRY); // QS_FILTER_OFF(QS_QEP_STATE_EXIT); // QS_FILTER_OFF(QS_QEP_STATE_INIT); // QS_FILTER_OFF(QS_QEP_INIT_TRAN); // QS_FILTER_OFF(QS_QEP_INTERN_TRAN); // QS_FILTER_OFF(QS_QEP_TRAN); // QS_FILTER_OFF(QS_QEP_IGNORED); // QS_FILTER_OFF(QS_QEP_DISPATCH); // QS_FILTER_OFF(QS_QEP_UNHANDLED); QS_FILTER_OFF(QS_QF_ACTIVE_ADD); QS_FILTER_OFF(QS_QF_ACTIVE_REMOVE); QS_FILTER_OFF(QS_QF_ACTIVE_SUBSCRIBE); // QS_FILTER_OFF(QS_QF_ACTIVE_UNSUBSCRIBE); QS_FILTER_OFF(QS_QF_ACTIVE_POST_FIFO); // QS_FILTER_OFF(QS_QF_ACTIVE_POST_LIFO); QS_FILTER_OFF(QS_QF_ACTIVE_GET); QS_FILTER_OFF(QS_QF_ACTIVE_GET_LAST); QS_FILTER_OFF(QS_QF_EQUEUE_INIT); QS_FILTER_OFF(QS_QF_EQUEUE_POST_FIFO); QS_FILTER_OFF(QS_QF_EQUEUE_POST_LIFO); QS_FILTER_OFF(QS_QF_EQUEUE_GET); QS_FILTER_OFF(QS_QF_EQUEUE_GET_LAST); QS_FILTER_OFF(QS_QF_MPOOL_INIT); QS_FILTER_OFF(QS_QF_MPOOL_GET); QS_FILTER_OFF(QS_QF_MPOOL_PUT); QS_FILTER_OFF(QS_QF_PUBLISH); QS_FILTER_OFF(QS_QF_NEW); QS_FILTER_OFF(QS_QF_GC_ATTEMPT); QS_FILTER_OFF(QS_QF_GC); QS_FILTER_OFF(QS_QF_TICK); QS_FILTER_OFF(QS_QF_TIMEEVT_ARM); QS_FILTER_OFF(QS_QF_TIMEEVT_AUTO_DISARM); QS_FILTER_OFF(QS_QF_TIMEEVT_DISARM_ATTEMPT); QS_FILTER_OFF(QS_QF_TIMEEVT_DISARM); QS_FILTER_OFF(QS_QF_TIMEEVT_REARM); QS_FILTER_OFF(QS_QF_TIMEEVT_POST); QS_FILTER_OFF(QS_QF_CRIT_ENTRY); QS_FILTER_OFF(QS_QF_CRIT_EXIT); QS_FILTER_OFF(QS_QF_ISR_ENTRY); QS_FILTER_OFF(QS_QF_ISR_EXIT); return CreateThread(NULL, 1024, &idleThread, (void *)0, 0, NULL) != (HANDLE)0; // return the status of creating the idle thread } //............................................................................ void QS::onCleanup(void) { l_running = false; QSPY_stop(); } //............................................................................ void QS::onFlush(void) { uint16_t nBytes = 1000U; uint8_t const *block; while ((block = getBlock(&nBytes)) != (uint8_t *)0) { QSPY_parse(block, nBytes); nBytes = 1000U; } } //............................................................................ QSTimeCtr QS::onGetTime(void) { return (QSTimeCtr)clock(); } //............................................................................ void QSPY_onPrintLn(void) { fputs(QSPY_line, stdout); fputc('\n', stdout); } #endif // Q_SPY //---------------------------------------------------------------------------- } // namespace QP