2020-07-12 11:45:36 -07:00
|
|
|
/*
|
2021-03-29 08:24:45 -07:00
|
|
|
ChibiOS - Copyright (C) 2006,2007,2008,2009,2010,2011,2012,2013,2014,
|
|
|
|
2015,2016,2017,2018,2019,2020,2021 Giovanni Di Sirio.
|
2020-07-12 11:45:36 -07:00
|
|
|
|
|
|
|
This file is part of ChibiOS.
|
|
|
|
|
|
|
|
ChibiOS is free software; you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
2021-03-29 08:24:45 -07:00
|
|
|
the Free Software Foundation version 3 of the License.
|
2020-07-12 11:45:36 -07:00
|
|
|
|
|
|
|
ChibiOS 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/>.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/**
|
2020-07-13 00:36:30 -07:00
|
|
|
* @file ARMv6-M/chcore.c
|
|
|
|
* @brief ARMv6-M port code.
|
2020-07-12 11:45:36 -07:00
|
|
|
*
|
2020-07-13 00:36:30 -07:00
|
|
|
* @addtogroup ARMv6_M_CORE
|
2020-07-12 11:45:36 -07:00
|
|
|
* @{
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "ch.h"
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Module local definitions. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Module exported variables. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Module local types. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Module local variables. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Module local functions. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
2020-07-13 00:36:30 -07:00
|
|
|
/*===========================================================================*/
|
|
|
|
/* Module interrupt handlers. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
#if (CORTEX_ALTERNATE_SWITCH == FALSE) || defined(__DOXYGEN__)
|
|
|
|
/**
|
|
|
|
* @brief NMI vector.
|
|
|
|
* @details The NMI vector is used for exception mode re-entering after a
|
|
|
|
* context switch.
|
|
|
|
*/
|
|
|
|
/*lint -save -e9075 [8.4] All symbols are invoked from asm context.*/
|
|
|
|
void NMI_Handler(void) {
|
|
|
|
/*lint -restore*/
|
|
|
|
|
|
|
|
/* The port_extctx structure is pointed by the PSP register.*/
|
|
|
|
struct port_extctx *ctxp = (struct port_extctx *)__get_PSP();
|
|
|
|
|
|
|
|
/* Discarding the current exception context and positioning the stack to
|
|
|
|
point to the real one.*/
|
|
|
|
ctxp++;
|
|
|
|
|
|
|
|
/* Writing back the modified PSP value.*/
|
|
|
|
__set_PSP((uint32_t)ctxp);
|
|
|
|
|
|
|
|
/* Restoring the normal interrupts status.*/
|
|
|
|
port_unlock_from_isr();
|
|
|
|
}
|
|
|
|
#endif /* !CORTEX_ALTERNATE_SWITCH */
|
|
|
|
|
|
|
|
#if (CORTEX_ALTERNATE_SWITCH == TRUE) || defined(__DOXYGEN__)
|
|
|
|
/**
|
|
|
|
* @brief PendSV vector.
|
|
|
|
* @details The PendSV vector is used for exception mode re-entering after a
|
|
|
|
* context switch.
|
|
|
|
*/
|
|
|
|
/*lint -save -e9075 [8.4] All symbols are invoked from asm context.*/
|
|
|
|
void PendSV_Handler(void) {
|
|
|
|
/*lint -restore*/
|
|
|
|
|
|
|
|
/* The port_extctx structure is pointed by the PSP register.*/
|
|
|
|
struct port_extctx *ctxp = (struct port_extctx *)__get_PSP();
|
|
|
|
|
|
|
|
/* Discarding the current exception context and positioning the stack to
|
|
|
|
point to the real one.*/
|
|
|
|
ctxp++;
|
|
|
|
|
|
|
|
/* Writing back the modified PSP value.*/
|
|
|
|
__set_PSP((uint32_t)ctxp);
|
|
|
|
}
|
|
|
|
#endif /* CORTEX_ALTERNATE_SWITCH */
|
|
|
|
|
2020-07-12 11:45:36 -07:00
|
|
|
/*===========================================================================*/
|
|
|
|
/* Module exported functions. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
2020-07-13 00:36:30 -07:00
|
|
|
/**
|
|
|
|
* @brief Port-related initialization code.
|
|
|
|
*
|
|
|
|
* @param[in, out] oip pointer to the @p os_instance_t structure
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
void port_init(os_instance_t *oip) {
|
|
|
|
|
|
|
|
(void)oip;
|
|
|
|
|
|
|
|
NVIC_SetPriority(PendSV_IRQn, CORTEX_PRIORITY_PENDSV);
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief IRQ epilogue code.
|
|
|
|
*
|
|
|
|
* @param[in] lr value of the @p LR register on ISR entry
|
|
|
|
*/
|
|
|
|
void __port_irq_epilogue(uint32_t lr) {
|
|
|
|
|
|
|
|
if (lr != 0xFFFFFFF1U) {
|
|
|
|
struct port_extctx *ectxp;
|
|
|
|
|
|
|
|
port_lock_from_isr();
|
|
|
|
|
|
|
|
/* The extctx structure is pointed by the PSP register.*/
|
|
|
|
ectxp = (struct port_extctx *)__get_PSP();
|
|
|
|
|
|
|
|
/* Adding an artificial exception return context, there is no need to
|
|
|
|
populate it fully.*/
|
|
|
|
ectxp--;
|
|
|
|
|
|
|
|
/* Writing back the modified PSP value.*/
|
|
|
|
__set_PSP((uint32_t)ectxp);
|
|
|
|
|
|
|
|
/* Setting up a fake XPSR register value.*/
|
|
|
|
ectxp->xpsr = 0x01000000U;
|
|
|
|
|
|
|
|
/* The exit sequence is different depending on if a preemption is
|
|
|
|
required or not.*/
|
|
|
|
if (chSchIsPreemptionRequired()) {
|
|
|
|
/* Preemption is required we need to enforce a context switch.*/
|
|
|
|
ectxp->pc = (uint32_t)__port_switch_from_isr;
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
/* Preemption not required, we just need to exit the exception
|
|
|
|
atomically.*/
|
|
|
|
ectxp->pc = (uint32_t)__port_exit_from_isr;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Note, returning without unlocking is intentional, this is done in
|
|
|
|
order to keep the rest of the context switch atomic.*/
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2020-07-12 11:45:36 -07:00
|
|
|
/** @} */
|