mirror of
https://github.com/QuantumLeaps/qpcpp.git
synced 2025-01-14 05:42:57 +08:00
80d9bcd6fb
Added QP Functional Safety (FuSa) Subsystem Memory Isolation with MPU Added QAsm abstract state machine base class Added memory marker to QEvt and rearranged memory layout Updated: QP-FreeRTOS, QP-ESP-IDF,QP-Zephyr Added drift-free ticking for QP-POSIX Reorganized documentation Updated 3rd_party
126 lines
4.4 KiB
C++
126 lines
4.4 KiB
C++
//============================================================================
|
|
// Product: Board Support Package (BSP) for the Calculator example
|
|
// Last Updated for Version: 6.9.0
|
|
// Date of the Last Update: 2020-08-25
|
|
//
|
|
// Q u a n t u m L e a P s
|
|
// ------------------------
|
|
// Modern Embedded Software
|
|
//
|
|
// Copyright (C) 2005-2020 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 3 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 <www.gnu.org/licenses/>.
|
|
//
|
|
// Contact information:
|
|
// <www.state-machine.com/licensing>
|
|
// <info@state-machine.com>
|
|
//============================================================================
|
|
#include "qpcpp.hpp"
|
|
#include "bsp.hpp"
|
|
|
|
#include "safe_std.h" // portable "safe" <stdio.h>/<string.h> facilities
|
|
#include <stdlib.h>
|
|
|
|
using namespace QP;
|
|
using namespace std;
|
|
|
|
#define DISP_WIDTH 15
|
|
|
|
/* helper macros to "stringify" values */
|
|
#define VAL(x) #x
|
|
#define STRINGIFY(x) VAL(x)
|
|
|
|
static char l_display[DISP_WIDTH + 1]; // the calculator display
|
|
static int l_len; // number of displayed characters
|
|
|
|
//............................................................................
|
|
void BSP_clear(void) {
|
|
memset(l_display, ' ', DISP_WIDTH - 1);
|
|
l_display[DISP_WIDTH - 1] = '0';
|
|
l_display[DISP_WIDTH] = '\0';
|
|
l_len = 0;
|
|
}
|
|
//............................................................................
|
|
void BSP_insert(int keyId) {
|
|
if (l_len == 0) {
|
|
l_display[DISP_WIDTH - 1] = (char)keyId;
|
|
++l_len;
|
|
}
|
|
else if (l_len < (DISP_WIDTH - 1)) {
|
|
MEMMOVE_S(&l_display[0], DISP_WIDTH, &l_display[1], DISP_WIDTH - 1);
|
|
l_display[DISP_WIDTH - 1] = (char)keyId;
|
|
++l_len;
|
|
}
|
|
}
|
|
//............................................................................
|
|
void BSP_display(double value) {
|
|
SNPRINTF_S(l_display, DISP_WIDTH, "%10.7g", value);
|
|
}
|
|
//............................................................................
|
|
void BSP_display_error(char const *err) {
|
|
STRNCPY_S(l_display, DISP_WIDTH, err);
|
|
}
|
|
//............................................................................
|
|
void BSP_negate(void) {
|
|
BSP_clear();
|
|
l_display[DISP_WIDTH - 2] = '-';
|
|
}
|
|
//............................................................................
|
|
void BSP_show_display(void) {
|
|
PRINTF_S("\n[%" STRINGIFY(DISP_WIDTH) "s] ", l_display);
|
|
}
|
|
//............................................................................
|
|
void BSP_exit(void) {
|
|
PRINTF_S("\n%s\n", "Bye! Bye!");
|
|
fflush(stdout);
|
|
QF::onCleanup();
|
|
exit(0);
|
|
}
|
|
//............................................................................
|
|
double BSP_get_value(void) {
|
|
return strtod(l_display, (char **)0);
|
|
}
|
|
//............................................................................
|
|
void BSP_message(char const *msg) {
|
|
PRINTF_S("%s", msg);
|
|
}
|
|
|
|
namespace QP {
|
|
/*..........................................................................*/
|
|
void QF::onStartup(void) {
|
|
QF::consoleSetup();
|
|
}
|
|
/*..........................................................................*/
|
|
void QF::onCleanup(void) {
|
|
QF::consoleCleanup();
|
|
}
|
|
/*..........................................................................*/
|
|
void QF::onClockTick(void) {
|
|
}
|
|
|
|
} // namespace QP
|
|
|
|
//............................................................................
|
|
// this function is used by the QP embedded systems-friendly assertions
|
|
extern "C" Q_NORETURN Q_onError(char const * const module, int_t const loc) {
|
|
FPRINTF_S(stderr, "Assertion failed in %s:%d", module, loc);
|
|
QF::onCleanup();
|
|
exit(-1);
|
|
}
|