d92adf8abf
This patch adds support for p packet responses by targets configured with RTOS support. This change required moving to a rtos_reg struct, which is similar to struct reg used by targets, which resulted in needing to update each stacking with register numbers. This patch also allows targets with non-linear register numbers to function with RTOSes as well. Change-Id: I5b189d74110d6b6f2fa851a67ab0762ae6b1832f Signed-off-by: Steven Stallion <stallion@squareup.com> Reviewed-on: http://openocd.zylin.com/4121 Tested-by: jenkins Reviewed-by: Matthias Welwarsky <matthias@welwarsky.de>
84 lines
3.7 KiB
C
84 lines
3.7 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, see <http://www.gnu.org/licenses/>. *
|
|
***************************************************************************/
|
|
|
|
#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] = {
|
|
{ ARMV7M_R0, -1, 32 }, /* r0 */
|
|
{ ARMV7M_R1, -1, 32 }, /* r1 */
|
|
{ ARMV7M_R2, -1, 32 }, /* r2 */
|
|
{ ARMV7M_R3, -1, 32 }, /* r3 */
|
|
{ ARMV7M_R4, 0x00, 32 }, /* r4 */
|
|
{ ARMV7M_R5, 0x04, 32 }, /* r5 */
|
|
{ ARMV7M_R6, 0x08, 32 }, /* r6 */
|
|
{ ARMV7M_R7, 0x0c, 32 }, /* r7 */
|
|
{ ARMV7M_R8, 0x10, 32 }, /* r8 */
|
|
{ ARMV7M_R9, 0x14, 32 }, /* r9 */
|
|
{ ARMV7M_R10, 0x18, 32 }, /* r10 */
|
|
{ ARMV7M_R11, 0x1c, 32 }, /* r11 */
|
|
{ ARMV7M_R12, -1, 32 }, /* r12 */
|
|
{ ARMV7M_R13, -2, 32 }, /* sp */
|
|
{ ARMV7M_R14, -1, 32 }, /* lr */
|
|
{ ARMV7M_PC, 0x20, 32 }, /* pc */
|
|
{ ARMV7M_xPSR, -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] = {
|
|
{ ARMV7M_R0, -1, 32 }, /* r0 */
|
|
{ ARMV7M_R1, -1, 32 }, /* r1 */
|
|
{ ARMV7M_R2, -1, 32 }, /* r2 */
|
|
{ ARMV7M_R3, -1, 32 }, /* r3 */
|
|
{ ARMV7M_R4, 0x40, 32 }, /* r4 */
|
|
{ ARMV7M_R5, 0x44, 32 }, /* r5 */
|
|
{ ARMV7M_R6, 0x48, 32 }, /* r6 */
|
|
{ ARMV7M_R7, 0x4c, 32 }, /* r7 */
|
|
{ ARMV7M_R8, 0x50, 32 }, /* r8 */
|
|
{ ARMV7M_R9, 0x54, 32 }, /* r9 */
|
|
{ ARMV7M_R10, 0x58, 32 }, /* r10 */
|
|
{ ARMV7M_R11, 0x5c, 32 }, /* r11 */
|
|
{ ARMV7M_R12, -1, 32 }, /* r12 */
|
|
{ ARMV7M_R13, -2, 32 }, /* sp */
|
|
{ ARMV7M_R14, -1, 32 }, /* lr */
|
|
{ ARMV7M_PC, 0x60, 32 }, /* pc */
|
|
{ ARMV7M_xPSR, -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 */
|
|
};
|