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, see <http://www.gnu.org/licenses/>. *
  17  ***************************************************************************/
  18
  19 #ifdef HAVE_CONFIG_H
  20 #include "config.h"
  21 #endif
  22
  23 #include "rtos.h"
  24 #include "target/armv7m.h"
  25
  26
  27 /*
  28  * standard exception stack
  29  * ( stack base, higher memory address )
  30  * - xpsr               - 0x48
  31  * - pc                 - 0x44
  32  * - lr                 - 0x40
  33  * - r12                - 0x3C
  34  * - r3                 - 0x38
  35  * - r2                 - 0x34
  36  * - r1                 - 0x30
  37  * - r0                 - 0x2C
  38  * extended stack in svc_pending handler
  39  * - lr                 - 0x28
  40  * - r11                - 0x24
  41  * - r10                - 0x20
  42  * - r9                 - 0x1C
  43  * - r8                 - 0x18
  44  * - r7                 - 0x14
  45  * - r6                 - 0x10
  46  * - r5                 - 0x0C
  47  * - r4                 - 0x08
  48  * - BASEPRI    - 0x04
  49  * - SHPR3              - 0x00 ( contains pend_svc exception priority )
  50  * ( stack head, lower address, stored in 'task->STACK_PTR' )
  51  */
  52
  53 static const struct stack_register_offset rtos_mqx_arm_v7m_stack_offsets[ARMV7M_NUM_CORE_REGS] = {
  54         { ARMV7M_R0,   0x2C, 32 }, /* r0   */
  55         { ARMV7M_R1,   0x30, 32 }, /* r1   */
  56         { ARMV7M_R2,   0x34, 32 }, /* r2   */
  57         { ARMV7M_R3,   0x38, 32 }, /* r3   */
  58         { ARMV7M_R4,   0x08, 32 }, /* r4   */
  59         { ARMV7M_R5,   0x0C, 32 }, /* r5   */
  60         { ARMV7M_R6,   0x10, 32 }, /* r6   */
  61         { ARMV7M_R7,   0x14, 32 }, /* r7   */
  62         { ARMV7M_R8,   0x18, 32 }, /* r8   */
  63         { ARMV7M_R9,   0x1C, 32 }, /* r9   */
  64         { ARMV7M_R10,  0x20, 32 }, /* r10  */
  65         { ARMV7M_R11,  0x24, 32 }, /* r11  */
  66         { ARMV7M_R12,  0x3C, 32 }, /* r12  */
  67         { ARMV7M_R13,    -2, 32 }, /* sp   */
  68         { ARMV7M_R14,  0x28, 32 }, /* lr   */
  69         { ARMV7M_PC,   0x44, 32 }, /* pc   */
  70         { ARMV7M_xPSR, 0x48, 32 }, /* xPSR */
  71 };
  72
  73 const struct rtos_register_stacking rtos_mqx_arm_v7m_stacking = {
  74         .stack_registers_size = 0x4C,                                   /* calculate offset base address */
  75         .stack_growth_direction = -1,
  76         .num_output_registers = ARMV7M_NUM_CORE_REGS,
  77         .register_offsets = rtos_mqx_arm_v7m_stack_offsets
  78 };