rtos: Freescale MQX rtos support
[fw/openocd] / src / rtos / rtos_mqx_stackings.c
1 /***************************************************************************
2  *   Copyright (C) 2014 by Marian Cingel                                   *
3  *   cingel.marian@gmail.com                                               *
4  *                                                                         *
5  *   This program is free software; you can redistribute it and/or modify  *
6  *   it under the terms of the GNU General Public License as published by  *
7  *   the Free Software Foundation; either version 2 of the License, or     *
8  *   (at your option) any later version.                                   *
9  *                                                                         *
10  *   This program is distributed in the hope that it will be useful,       *
11  *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
12  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
13  *   GNU General Public License for more details.                          *
14  *                                                                         *
15  *   You should have received a copy of the GNU General Public License     *
16  *   along with this program; if not, write to the                         *
17  *   Free Software Foundation, Inc.                                        *
18  ***************************************************************************/
19
20 #ifdef HAVE_CONFIG_H
21 #include "config.h"
22 #endif
23
24 #include "rtos.h"
25 #include "target/armv7m.h"
26
27
28 /*
29  * standard exception stack
30  * ( stack base, higher memory address )
31  * - xpsr               - 0x48
32  * - pc                 - 0x44
33  * - lr                 - 0x40
34  * - r12                - 0x3C
35  * - r3                 - 0x38
36  * - r2                 - 0x34
37  * - r1                 - 0x30
38  * - r0                 - 0x2C
39  * extended stack in svc_pending handler
40  * - lr                 - 0x28
41  * - r11                - 0x24
42  * - r10                - 0x20
43  * - r9                 - 0x1C
44  * - r8                 - 0x18
45  * - r7                 - 0x14
46  * - r6                 - 0x10
47  * - r5                 - 0x0C
48  * - r4                 - 0x08
49  * - BASEPRI    - 0x04
50  * - SHPR3              - 0x00 ( contains pend_svc exception priority )
51  * ( stack head, lower address, stored in 'task->STACK_PTR' )
52  */
53
54 static const struct stack_register_offset rtos_mqx_arm_v7m_stack_offsets[ARMV7M_NUM_CORE_REGS] = {
55         { 0x2C, 32 }, /* r0   */
56         { 0x30, 32 }, /* r1   */
57         { 0x34, 32 }, /* r2   */
58         { 0x38, 32 }, /* r3   */
59         { 0x08, 32 }, /* r4   */
60         { 0x0C, 32 }, /* r5   */
61         { 0x10, 32 }, /* r6   */
62         { 0x14, 32 }, /* r7   */
63         { 0x18, 32 }, /* r8   */
64         { 0x1C, 32 }, /* r9   */
65         { 0x20, 32 }, /* r10  */
66         { 0x24, 32 }, /* r11  */
67         { 0x3C, 32 }, /* r12  */
68         {  -2 , 32 }, /* sp   */
69         { 0x28, 32 }, /* lr   */
70         { 0x44, 32 }, /* pc   */
71         { 0x48, 32 }, /* xPSR */
72 };
73
74 const struct rtos_register_stacking rtos_mqx_arm_v7m_stacking = {
75         0x4C,                                   /* stack_registers_size, calculate offset base address */
76         -1,                                             /* stack_growth_direction */
77         ARMV7M_NUM_CORE_REGS,   /* num_output_registers */
78         0,                                              /* stack_alignment */
79         rtos_mqx_arm_v7m_stack_offsets  /* register_offsets */
80 };
81