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         NULL,                                   /* stack_alignment */
  79         rtos_mqx_arm_v7m_stack_offsets  /* register_offsets */
  80 };
  81