This commit is contained in:
QL 2018-02-12 18:53:58 -05:00
parent 02a43e2546
commit 74e5d9feab
2 changed files with 515 additions and 0 deletions

View File

@ -0,0 +1,57 @@
/*
* Copyright (c) 2015-2016, Texas Instruments Incorporated
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* * Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
*
* * Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* * Neither the name of Texas Instruments Incorporated nor the names of
* its contributors may be used to endorse or promote products derived
* from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
* THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
* OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
* OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
/*
* ======== EK_TM4C123GXL.cmd ========
* Define the memory block start/length for the EK_TM4C123GXL M4
*/
MEMORY
{
FLASH (RX) : origin = 0x00000000, length = 0x00040000
SRAM (RWX) : origin = 0x20000000, length = 0x00008000
}
/* Section allocation in memory */
SECTIONS
{
.text : > FLASH
.const : > FLASH
.cinit : > FLASH
.pinit : > FLASH
.init_array : > FLASH
.data : > SRAM
.bss : > SRAM
.sysmem : > SRAM
.stack : > SRAM
}

458
src/qk/qk.c Normal file
View File

@ -0,0 +1,458 @@
/**
* @file
* @brief QK preemptive kernel core functions
* @ingroup qk
* @cond
******************************************************************************
* Last updated for version 5.9.7
* Last updated on 2017-08-18
*
* Q u a n t u m L e a P s
* ---------------------------
* innovating embedded systems
*
* Copyright (C) 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 <http://www.gnu.org/licenses/>.
*
* Contact information:
* https://state-machine.com
* mailto:info@state-machine.com
******************************************************************************
* @endcond
*/
#define QP_IMPL /* this is QP implementation */
#include "qf_port.h" /* QF port */
#include "qf_pkg.h" /* QF package-scope internal interface */
#include "qassert.h" /* QP embedded systems-friendly assertions */
#ifdef Q_SPY /* QS software tracing enabled? */
#include "qs_port.h" /* include QS port */
#else
#include "qs_dummy.h" /* disable the QS software tracing */
#endif /* Q_SPY */
/* protection against including this source file in a wrong project */
#ifndef qk_h
#error "Source file included in a project NOT based on the QK kernel"
#endif /* qk_h */
Q_DEFINE_THIS_MODULE("qk")
/* Public-scope objects *****************************************************/
QK_Attr QK_attr_; /* global attributes of the QK kernel */
/****************************************************************************/
/**
* @description
* Initializes QF and must be called exactly once before any other QF
* function. Typically, QF_init() is called from main() even before
* initializing the Board Support Package (BSP).
*
* @note QF_init() clears the internal QF variables, so that the framework
* can start correctly even if the startup code fails to clear the
* uninitialized data (as is required by the C Standard).
*/
void QF_init(void) {
QF_maxPool_ = (uint_fast8_t)0;
QF_subscrList_ = (QSubscrList *)0;
QF_maxPubSignal_ = (enum_t)0;
QF_bzero(&QF_timeEvtHead_[0], (uint_fast16_t)sizeof(QF_timeEvtHead_));
QF_bzero(&QF_active_[0], (uint_fast16_t)sizeof(QF_active_));
QF_bzero(&QK_attr_, (uint_fast16_t)sizeof(QK_attr_));
QK_attr_.actPrio = (uint8_t)0; /* priority of the QK idle loop */
QK_attr_.lockPrio = (uint8_t)QF_MAX_ACTIVE; /* scheduler locked */
#ifdef QK_INIT
QK_INIT(); /* port-specific initialization of the QK kernel */
#endif
}
/****************************************************************************/
/**
* @description
* This function stops the QF application. After calling this function,
* QF attempts to gracefully stop the application. This graceful shutdown
* might take some time to complete. The typical use of this function is
* for terminating the QF application to return back to the operating
* system or for handling fatal errors that require shutting down
* (and possibly re-setting) the system.
*
* @sa QF_onCleanup()
*/
void QF_stop(void) {
QF_onCleanup(); /* application-specific cleanup callback */
/* nothing else to do for the preemptive QK kernel */
}
/****************************************************************************/
/*! process all events posted during initialization */
static void initial_events(void); /* prototype */
static void initial_events(void) {
QK_attr_.lockPrio = (uint8_t)0; /* scheduler unlocked */
/* any active objects need to be scheduled before starting event loop? */
if (QK_sched_() != (uint_fast8_t)0) {
QK_activate_(); /* activate AOs to process all events posted so far */
}
}
/****************************************************************************/
/**
* @description
* QF_run() is typically called from your startup code after you initialize
* the QF and start at least one active object with QActive_start().
*
* @returns In QK, the QF_run() function does not return.
*/
int_t QF_run(void) {
QF_INT_DISABLE();
initial_events(); /* process all events posted during initialization */
QF_onStartup(); /* application-specific startup callback */
QF_INT_ENABLE();
/* the QK idle loop... */
for (;;) {
QK_onIdle(); /* application-specific QK on-idle callback */
}
#ifdef __GNUC__
return (int_t)0;
#endif
}
/****************************************************************************/
/**
* @description
* Starts execution of the AO and registers the AO with the framework.
* Also takes the top-most initial transition in the AO's state machine.
* This initial transition is taken in the callee's thread of execution.
*
* @param[in,out] me pointer (see @ref oop)
* @param[in] prio priority at which to start the active object
* @param[in] qSto pointer to the storage for the ring buffer of the
* event queue (used only with the built-in ::QEQueue)
* @param[in] qLen length of the event queue [events]
* @param[in] stkSto pointer to the stack storage (must be NULL in QK)
* @param[in] stkSize stack size [bytes]
* @param[in] ie pointer to the initial event (might be NULL).
*
* @note This function should be called via the macro QACTIVE_START().
*
* @usage
* The following example shows starting an AO when a per-task stack is needed:
* @include qf_start.c
*/
void QActive_start_(QActive * const me, uint_fast8_t prio,
QEvt const *qSto[], uint_fast16_t qLen,
void *stkSto, uint_fast16_t stkSize,
QEvt const *ie)
{
QF_CRIT_STAT_
/** @pre AO cannot be started from an ISR, the priority must be in range
* and the stack storage must not be provided, because the QK kernel does
* not need per-AO stacks.
*/
Q_REQUIRE_ID(300, (!QK_ISR_CONTEXT_())
&& ((uint_fast8_t)0 < prio)
&& (prio <= (uint_fast8_t)QF_MAX_ACTIVE)
&& (stkSto == (void *)0));
(void)stkSize; /* unused parameter */
QEQueue_init(&me->eQueue, qSto, qLen); /* initialize the built-in queue */
me->prio = (uint8_t)prio; /* set the QF priority of the AO */
QF_add_(me); /* make QF aware of this active object */
QHSM_INIT(&me->super, ie); /* take the top-most initial tran. (virtual) */
QS_FLUSH(); /* flush the trace buffer to the host */
/* See if this AO needs to be scheduled in case QK is already running */
QF_CRIT_ENTRY_();
if (QK_sched_() != (uint_fast8_t)0) { /* activation needed? */
QK_activate_();
}
QF_CRIT_EXIT_();
}
/****************************************************************************/
/**
* @description
* This function must be called from within the AO that needs to stop.
* In other words, an AO should stop itself rather than being stopped by
* someone else. This policy works best, because only the AO itself "knows"
* when it has reached the appropriate state for the shutdown.
*
* @note By the time the AO calls QActive_stop(), it should have unsubscribed
* from all events and no more events should be directly-posted to it.
*/
void QActive_stop(QActive * const me) {
QF_CRIT_STAT_
/** @pre QActive_stop() must be called from the AO that wants to stop. */
Q_REQUIRE_ID(400, (me == QF_active_[QK_attr_.actPrio]));
QF_remove_(me); /* remove this active object from the QF */
QF_CRIT_ENTRY_();
QPSet_remove(&QK_attr_.readySet, (uint_fast8_t)me->prio);
if (QK_sched_() != (uint_fast8_t)0) {
QK_activate_();
}
QF_CRIT_EXIT_();
}
/****************************************************************************/
/**
* @description
* This function locks the QK scheduler to the specified ceiling.
*
* @param[in] ceiling priority ceiling to which the QK scheduler
* needs to be locked
*
* @returns
* The previous QK Scheduler lock status, which is to be used to unlock
* the scheduler by restoring its previous lock status in QK_schedUnlock().
*
* @note
* QK_schedLock() must be always followed by the corresponding
* QK_schedUnlock().
*
* @sa QK_schedUnlock()
*
* @usage
* The following example shows how to lock and unlock the QK scheduler:
* @include qk_lock.c
*/
QSchedStatus QK_schedLock(uint_fast8_t ceiling) {
QSchedStatus stat;
QF_CRIT_STAT_
QF_CRIT_ENTRY_();
/** @pre The QK scheduler lock:
* - cannot be called from an ISR;
*/
Q_REQUIRE_ID(600, !QK_ISR_CONTEXT_());
/* first store the previous lock prio */
if ((uint_fast8_t)QK_attr_.lockPrio < ceiling) { /* raising lock prio? */
stat = ((QSchedStatus)QK_attr_.lockPrio << 8);
QK_attr_.lockPrio = (uint8_t)ceiling;
QS_BEGIN_NOCRIT_(QS_SCHED_LOCK, (void *)0, (void *)0)
QS_TIME_(); /* timestamp */
QS_2U8_((uint8_t)stat, /* the previous lock prio */
QK_attr_.lockPrio); /* the new lock prio */
QS_END_NOCRIT_()
/* add the previous lock holder priority */
stat |= (QSchedStatus)QK_attr_.lockHolder;
QK_attr_.lockHolder = QK_attr_.actPrio;
}
else {
stat = (QSchedStatus)0xFF;
}
QF_CRIT_EXIT_();
return stat; /* return the status to be saved in a stack variable */
}
/****************************************************************************/
/**
* @description
* This function unlocks the QK scheduler to the previous status.
*
* @param[in] stat previous QK Scheduler lock status returned from
* QK_schedLock()
* @note
* QK_schedUnlock() must always follow the corresponding QK_schedLock().
*
* @sa QK_schedLock()
*
* @usage
* The following example shows how to lock and unlock the QK scheduler:
* @include qk_lock.c
*/
void QK_schedUnlock(QSchedStatus stat) {
/* has the scheduler been actually locked by the last QK_schedLock()? */
if (stat != (QSchedStatus)0xFF) {
uint_fast8_t lockPrio = (uint_fast8_t)QK_attr_.lockPrio;
uint_fast8_t prevPrio = (uint_fast8_t)(stat >> 8);
QF_CRIT_STAT_
QF_CRIT_ENTRY_();
/** @pre The scheduler cannot be unlocked:
* - from the ISR context; and
* - the current lock priority must be greater than the previous
*/
Q_REQUIRE_ID(700, (!QK_ISR_CONTEXT_())
&& (lockPrio > prevPrio));
QS_BEGIN_NOCRIT_(QS_SCHED_UNLOCK, (void *)0, (void *)0)
QS_TIME_(); /* timestamp */
QS_2U8_((uint8_t)lockPrio, /* lock prio before unlocking */
(uint8_t)prevPrio); /* lock priority after unlocking */
QS_END_NOCRIT_()
/* restore the previous lock priority and lock holder */
QK_attr_.lockPrio = (uint8_t)prevPrio;
QK_attr_.lockHolder = (uint8_t)(stat & (QSchedStatus)0xFF);
/* find the highest-prio thread ready to run */
if (QK_sched_() != (uint_fast8_t)0) { /* priority found? */
QK_activate_(); /* activate any unlocked basic threads */
}
QF_CRIT_EXIT_();
}
}
/****************************************************************************/
/**
* @description
* The QK scheduler finds out the priority of the highest-priority AO
* that (1) has events to process and (2) has priority that is above the
* current priority.
*
* @returns the 1-based priority of the the active object, or zero if
* no eligible active object is ready to run.
*
* @attention
* QK_sched_() must be always called with interrupts **disabled** and
* returns with interrupts **disabled**.
*/
uint_fast8_t QK_sched_(void) {
uint_fast8_t p; /* for priority */
/* find the highest-prio AO with non-empty event queue */
QPSet_findMax(&QK_attr_.readySet, p);
/* is the highest-prio below the active priority? */
if (p <= (uint_fast8_t)QK_attr_.actPrio) {
p = (uint_fast8_t)0; /* active object not eligible */
}
else if (p <= (uint_fast8_t)QK_attr_.lockPrio) { /* below the lock prio?*/
p = (uint_fast8_t)0; /* active object not eligible */
}
else {
Q_ASSERT_ID(410, p <= (uint_fast8_t)QF_MAX_ACTIVE);
QK_attr_.nextPrio = (uint8_t)p; /* next AO to run */
}
return p;
}
/****************************************************************************/
/**
* @description
* QK_activate_() activates ready-to run AOs that are above the initial
* active priority (QK_attr_.actPrio).
*
* @note
* The activator might enable interrupts internally, but always returns with
* interrupts **disabled**.
*/
void QK_activate_(void) {
uint_fast8_t pin = (uint_fast8_t)QK_attr_.actPrio; /* save active prio */
uint_fast8_t p = (uint_fast8_t)QK_attr_.nextPrio; /* next prio to run */
QActive *a;
/* QS tracing or thread-local storage? */
#ifdef Q_SPY
uint_fast8_t pprev = pin;
#endif /* Q_SPY */
/* QK_attr_.nextPrio must be non-zero upon entry to QK_activate_() */
Q_REQUIRE_ID(500, p != (uint_fast8_t)0);
QK_attr_.nextPrio = (uint8_t)0; /* clear for the next time */
/* loop until no more ready-to-run AOs of higher prio than the initial */
do {
QEvt const *e;
a = QF_active_[p]; /* obtain the pointer to the AO */
QK_attr_.actPrio = (uint8_t)p; /* this becomes the active prio */
QS_BEGIN_NOCRIT_(QS_SCHED_NEXT, QS_priv_.locFilter[AO_OBJ], a)
QS_TIME_(); /* timestamp */
QS_2U8_((uint8_t)p, /* priority of the scheduled AO */
(uint8_t)pprev); /* previous priority */
QS_END_NOCRIT_()
#ifdef Q_SPY
if (p != pprev) { /* changing priorities? */
pprev = p; /* update previous priority */
}
#endif /* Q_SPY */
QF_INT_ENABLE(); /* unconditionally enable interrupts */
/* perform the run-to-completion (RTC) step...
* 1. retrieve the event from the AO's event queue, which by this
* time must be non-empty and QActive_get_() asserts it.
* 2. dispatch the event to the AO's state machine.
* 3. determine if event is garbage and collect it if so
*/
e = QActive_get_(a);
QHSM_DISPATCH(&a->super, e);
QF_gc(e);
QF_INT_DISABLE(); /* unconditionally disable interrupts */
if (a->eQueue.frontEvt == (QEvt const *)0) { /* empty queue? */
QPSet_remove(&QK_attr_.readySet, p);
}
/* find new highest-prio AO ready to run... */
QPSet_findMax(&QK_attr_.readySet, p);
/* is the new priority below the initial preemption threshold? */
if (p <= pin) {
p = (uint_fast8_t)0;
}
else if (p <= (uint_fast8_t)QK_attr_.lockPrio) {/* below lock prio? */
p = (uint_fast8_t)0; /* active object not eligible */
}
else {
Q_ASSERT_ID(510, p <= (uint_fast8_t)QF_MAX_ACTIVE);
}
} while (p != (uint_fast8_t)0);
QK_attr_.actPrio = (uint8_t)pin; /* restore the active priority */
#ifdef Q_SPY
if (pin != (uint_fast8_t)0) { /* resuming an active object? */
a = QF_active_[pin]; /* the pointer to the preempted AO */
QS_BEGIN_NOCRIT_(QS_SCHED_RESUME, QS_priv_.locFilter[AO_OBJ], a)
QS_TIME_(); /* timestamp */
QS_2U8_((uint8_t)pin, /* priority of the resumed AO */
(uint8_t)pprev); /* previous priority */
QS_END_NOCRIT_()
}
else { /* resuming priority==0 --> idle */
QS_BEGIN_NOCRIT_(QS_SCHED_IDLE, (void *)0, (void *)0)
QS_TIME_(); /* timestamp */
QS_U8_((uint8_t)pprev); /* previous priority */
QS_END_NOCRIT_()
}
#endif /* Q_SPY */
}