9413a7a814
Some targets (Cortex M) require more complicated calculations for turning the stored stack pointer back into a process stack pointer. For example, the Cortex M stores a bit in the auto-stacked xPSR indicating that alignment had to be performed and an additional 4 byte padding is present before the exception stacking. This change only sets up the framework for Cortex-M unstacking and does not add Cortex-M support. Note: this also fixes the alignment calculation nearly addressed by change #2301 entitled rtos/rtos.c: fix stack alignment calculation. Updated calculation is in rtos_generic_stack_align. Change-Id: I0f662cad0df81cbe5866219ad0fef980dcb3e44f Signed-off-by: Andrew Ruder <andrew.ruder@elecsyscorp.com> Cc: Paul Fertser <fercerpav@gmail.com> Cc: Andreas Fritiofson <andreas.fritiofson@gmail.com> Cc: Evan Hunter <evanhunter920@gmail.com> Cc: Jon Burgess <jburgess777@gmail.com> Reviewed-on: http://openocd.zylin.com/3002 Reviewed-by: Andreas Fritiofson <andreas.fritiofson@gmail.com> Tested-by: jenkins
86 lines
3.5 KiB
C
86 lines
3.5 KiB
C
/***************************************************************************
|
|
* Copyright (C) 2012 by Matthias Blaicher *
|
|
* Matthias Blaicher - matthias@blaicher.com *
|
|
* *
|
|
* Copyright (C) 2011 by Broadcom Corporation *
|
|
* Evan Hunter - ehunter@broadcom.com *
|
|
* *
|
|
* This program is free 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. *
|
|
* *
|
|
* 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, write to the *
|
|
* Free Software Foundation, Inc., *
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. *
|
|
***************************************************************************/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include "rtos.h"
|
|
#include "target/armv7m.h"
|
|
|
|
static const struct stack_register_offset rtos_chibios_arm_v7m_stack_offsets[ARMV7M_NUM_CORE_REGS] = {
|
|
{ -1, 32 }, /* r0 */
|
|
{ -1, 32 }, /* r1 */
|
|
{ -1, 32 }, /* r2 */
|
|
{ -1, 32 }, /* r3 */
|
|
{ 0x00, 32 }, /* r4 */
|
|
{ 0x04, 32 }, /* r5 */
|
|
{ 0x08, 32 }, /* r6 */
|
|
{ 0x0c, 32 }, /* r7 */
|
|
{ 0x10, 32 }, /* r8 */
|
|
{ 0x14, 32 }, /* r9 */
|
|
{ 0x18, 32 }, /* r10 */
|
|
{ 0x1c, 32 }, /* r11 */
|
|
{ -1, 32 }, /* r12 */
|
|
{ -2, 32 }, /* sp */
|
|
{ -1, 32 }, /* lr */
|
|
{ 0x20, 32 }, /* pc */
|
|
{ -1, 32 }, /* xPSR */
|
|
};
|
|
|
|
const struct rtos_register_stacking rtos_chibios_arm_v7m_stacking = {
|
|
0x24, /* stack_registers_size */
|
|
-1, /* stack_growth_direction */
|
|
ARMV7M_NUM_CORE_REGS, /* num_output_registers */
|
|
NULL, /* stack_alignment */
|
|
rtos_chibios_arm_v7m_stack_offsets /* register_offsets */
|
|
};
|
|
|
|
static const struct stack_register_offset rtos_chibios_arm_v7m_stack_offsets_w_fpu[ARMV7M_NUM_CORE_REGS] = {
|
|
{ -1, 32 }, /* r0 */
|
|
{ -1, 32 }, /* r1 */
|
|
{ -1, 32 }, /* r2 */
|
|
{ -1, 32 }, /* r3 */
|
|
{ 0x40, 32 }, /* r4 */
|
|
{ 0x44, 32 }, /* r5 */
|
|
{ 0x48, 32 }, /* r6 */
|
|
{ 0x4c, 32 }, /* r7 */
|
|
{ 0x50, 32 }, /* r8 */
|
|
{ 0x54, 32 }, /* r9 */
|
|
{ 0x58, 32 }, /* r10 */
|
|
{ 0x5c, 32 }, /* r11 */
|
|
{ -1, 32 }, /* r12 */
|
|
{ -2, 32 }, /* sp */
|
|
{ -1, 32 }, /* lr */
|
|
{ 0x60, 32 }, /* pc */
|
|
{ -1, 32 }, /* xPSR */
|
|
};
|
|
|
|
const struct rtos_register_stacking rtos_chibios_arm_v7m_stacking_w_fpu = {
|
|
0x64, /* stack_registers_size */
|
|
-1, /* stack_growth_direction */
|
|
ARMV7M_NUM_CORE_REGS, /* num_output_registers */
|
|
NULL, /* stack_alignment */
|
|
rtos_chibios_arm_v7m_stack_offsets_w_fpu /* register_offsets */
|
|
};
|