你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

【经验分享】STM32 OS PendSV与堆栈操作

[复制链接]
STMCU小助手 发布时间:2022-1-16 18:03
一、什么是PendSV
PendSV是可悬起异常,如果我们把它配置最低优先级,那么如果同时有多个异常被触发,它会在其他异常执行完毕后再执行,而且任何异常都可以中断它。更详细的内容在《Cortex-M3 权威指南》里有介绍,下面我摘抄了一段。

OS 可以利用它“缓期执行”一个异常——直到其它重要的任务完成后才执行动 作。悬起 PendSV 的方法是:手工往 NVIC的 PendSV悬起寄存器中写 1。悬起后,如果优先级不够 高,则将缓期等待执行。
PendSV的典型使用场合是在上下文切换时(在不同任务之间切换)。例如,一个系统中有两个就绪的任务,上下文切换被触发的场合可以是:
1、执行一个系统调用
2、系统滴答定时器(SYSTICK)中断,(轮转调度中需要)
让我们举个简单的例子来辅助理解。假设有这么一个系统,里面有两个就绪的任务,并且通过SysTick异常启动上下文切换。但若在产生 SysTick 异常时正在响应一个中断,则 SysTick异常会抢占其 ISR。在这种情况下,OS是不能执行上下文切换的,否则将使中断请求被延迟,而且在真实系统中延迟时间还往往不可预知——任何有一丁点实时要求的系统都决不能容忍这 种事。因此,在 CM3 中也是严禁没商量——如果 OS 在某中断活跃时尝试切入线程模式,将触犯用法fault异常。
为解决此问题,早期的 OS 大多会检测当前是否有中断在活跃中,只有在无任何中断需要响应 时,才执行上下文切换(切换期间无法响应中断)。然而,这种方法的弊端在于,它可以把任务切 换动作拖延很久(因为如果抢占了 IRQ,则本次 SysTick在执行后不得作上下文切换,只能等待下 一次SysTick异常),尤其是当某中断源的频率和SysTick异常的频率比较接近时,会发生“共振”, 使上下文切换迟迟不能进行。现在好了,PendSV来完美解决这个问题了。PendSV异常会自动延迟上下文切换的请求,直到 其它的 ISR都完成了处理后才放行。为实现这个机制,需要把 PendSV编程为最低优先级的异常。如果 OS检测到某 IRQ正在活动并且被 SysTick抢占,它将悬起一个 PendSV异常,以便缓期执行 上下文切换。
使用 PendSV 控制上下文切换个中事件的流水账记录如下:
1. 任务 A呼叫 SVC来请求任务切换(例如,等待某些工作完成)
2. OS接收到请求,做好上下文切换的准备,并且悬起一个 PendSV异常。
3. 当 CPU退出 SVC后,它立即进入 PendSV,从而执行上下文切换。
4. 当 PendSV执行完毕后,将返回到任务 B,同时进入线程模式。
5. 发生了一个中断,并且中断服务程序开始执行
6. 在 ISR执行过程中,发生 SysTick异常,并且抢占了该 ISR。
7. OS执行必要的操作,然后悬起 PendSV异常以作好上下文切换的准备。
8. 当 SysTick退出后,回到先前被抢占的 ISR中,ISR继续执行
9. ISR执行完毕并退出后,PendSV服务例程开始执行,并且在里面执行上下文切换
10. 当 PendSV执行完毕后,回到任务 A,同时系统再次进入线程模式。

我们在uCOS的PendSV的处理代码中可以看到:
  1. OS_CPU_PendSVHandler
  2.     CPSID I ; 关中断
  3.     ;保存上文
  4.     ;.......................
  5.     ;切换下文
  6.     CPSIE I ;开中断
  7.     BX LR ;异常返回
复制代码

它在异常一开始就关闭了中端,结束时开启中断,中间的代码为临界区代码,即不可被中断的操作。PendSV异常是任务切换的堆栈部分的核心,由他来完成上下文切换。PendSV的操作也很简单,主要有设置优先级和触发异常两部分:
  1. NVIC_INT_CTRL EQU 0xE000ED04 ; 中断控制寄存器
  2. NVIC_SYSPRI14 EQU 0xE000ED22 ; 系统优先级寄存器(优先级14).
  3. NVIC_PENDSV_PRI EQU 0xFF ; PendSV优先级(最低). NVIC_PENDSVSET EQU 0x10000000 ; PendSV触发值

  4. ; 设置PendSV的异常中断优先级

  5. LDR R0, =NVIC_SYSPRI14
  6. LDR R1, =NVIC_PENDSV_PRI
  7. STRB R1, [R0] ; 触发PendSV异常
  8. LDR R0, =NVIC_INT_CTRL
  9. LDR R1, =NVIC_PENDSVSET
  10. STR R1, [R0]
复制代码

二、堆栈操作
Cortex M4有两个堆栈寄存器,主堆栈指针(MSP)与进程堆栈指针(PSP),而且任一时刻只能使用其中的一个。MSP为复位后缺省使用的堆栈指针,异常永远使用MSP,如果手动开启PSP,那么线程使用PSP,否则也使用MSP。怎么开启PSP?
  1. MSR     PSP, R0                                             ; Load PSP with new process SP
  2.     ORR     LR, LR, #0x04                                   ; Ensure exception return uses process stack
复制代码

很容易就看出来了,置LR的位2为1,那么异常返回后,线程使用PSP。
写OS首先要将内存分配搞明白,单片机内存本来就很小,所以我们当然要斤斤计较一下。在OS运行之前,我们首先要初始化MSP和PSP,
  1. EXTERN  OS_CPU_ExceptStkBase
  2.    ;PSP清零,作为首次上下文切换的标志
  3.    MOVS    R0, #0
  4.    MSR     PSP, R0
  5.    ;将MSP设为我们为其分配的内存地址
  6.    LDR     R0, =OS_CPU_ExceptStkBase
  7.    LDR     R1, [R0]
  8.    MSR     MSP, R1
复制代码

然后就是PendSV上下文切换中的堆栈操作了,如果不使用FPU,则进入异常自动压栈xPSR,PC,LR,R12,R0-R3,我们还要把R4-R11入栈。如果开启了FPU,自动压栈的寄存器还有S0-S15,还需吧S16-S31压栈。
  1. MRS     R0, PSP
  2.     SUBS   R0, R0, #0x20        ;压入R4-R11
  3.     STM     R0, {R4-R11}

  4.     LDR     R1, =Cur_TCB_Point    ;当前任务的指针
  5.     LDR     R1, [R1]
  6.     STR     R0, [R1]            ; 更新任务堆栈指针
复制代码

出栈类似,但要注意顺序
  1. LDR     R1, =TCB_Point    ;要切换的任务指针
  2.     LDR     R2, [R1]
  3.     LDR     R0, [R2]          ; R0为要切换的任务堆栈地址
  4.   
  5.     LDM     R0, {R4-R11}     ; 弹出R4-R11
  6.     ADDS    R0, R0, #0x20

  7.     MSR     PSP, R0        ;更新PSP
复制代码

三、OS实战
新建os_port.asm文件,内容如下:
  1. NVIC_INT_CTRL   EQU     0xE000ED04                              ; Interrupt control state register.
  2. NVIC_SYSPRI14   EQU     0xE000ED22                              ; System priority register (priority 14).
  3. NVIC_PENDSV_PRI EQU           0xFF                              ; PendSV priority value (lowest).
  4. NVIC_PENDSVSET  EQU     0x10000000                              ; Value to trigger PendSV exception.

  5.   RSEG CODE:CODE:NOROOT(2)
  6.   THUMB


  7.   EXTERN  g_OS_CPU_ExceptStkBase
  8.   
  9.   EXTERN  g_OS_Tcb_CurP
  10.   EXTERN  g_OS_Tcb_HighRdyP

  11.   PUBLIC OSStart_Asm
  12.   PUBLIC PendSV_Handler
  13.   PUBLIC OSCtxSw

  14. OSCtxSw
  15.     LDR     R0, =NVIC_INT_CTRL
  16.     LDR     R1, =NVIC_PENDSVSET
  17.     STR     R1, [R0]
  18.     BX      LR                                                ; Enable interrupts at processor level

  19. OSStart_Asm
  20.     LDR     R0, =NVIC_SYSPRI14                                  ; Set the PendSV exception priority
  21.     LDR     R1, =NVIC_PENDSV_PRI
  22.     STRB    R1, [R0]

  23.     MOVS    R0, #0                                              ; Set the PSP to 0 for initial context switch call
  24.     MSR     PSP, R0

  25.     LDR     R0, =g_OS_CPU_ExceptStkBase                           ; Initialize the MSP to the OS_CPU_ExceptStkBase
  26.     LDR     R1, [R0]
  27.     MSR     MSP, R1   

  28.     LDR     R0, =NVIC_INT_CTRL                                  ; Trigger the PendSV exception (causes context switch)
  29.     LDR     R1, =NVIC_PENDSVSET
  30.     STR     R1, [R0]

  31.     CPSIE   I                                                   ; Enable interrupts at processor level

  32. OSStartHang
  33.     B       OSStartHang                                         ; Should never get here
  34.    
  35.    

  36. PendSV_Handler
  37.     CPSID   I                                                   ; Prevent interruption during context switch
  38.     MRS     R0, PSP                                             ; PSP is process stack pointer
  39.     CBZ     R0, OS_CPU_PendSVHandler_nosave                     ; Skip register save the first time
  40.    
  41.     SUBS    R0, R0, #0x20                                       ; Save remaining regs r4-11 on process stack
  42.     STM     R0, {R4-R11}

  43.     LDR     R1, =g_OS_Tcb_CurP                                       ; OSTCBCur->OSTCBStkPtr = SP;
  44.     LDR     R1, [R1]
  45.     STR     R0, [R1]                                            ; R0 is SP of process being switched out

  46.                                                                 ; At this point, entire context of process has been saved
  47. OS_CPU_PendSVHandler_nosave
  48.     LDR     R0, =g_OS_Tcb_CurP                                       ; OSTCBCur  = OSTCBHighRdy;
  49.     LDR     R1, =g_OS_Tcb_HighRdyP
  50.     LDR     R2, [R1]
  51.     STR     R2, [R0]

  52.     LDR     R0, [R2]                                       ; R0 is new process SP; SP = OSTCBHighRdy->OSTCBStkPtr;
  53.   
  54.     LDM     R0, {R4-R11}                                        ; Restore r4-11 from new process stack
  55.     ADDS    R0, R0, #0x20
  56.             
  57.     MSR     PSP, R0                                             ; Load PSP with new process SP
  58.     ORR     LR, LR, #0x04                                       ; Ensure exception return uses process stack
  59.    
  60.     CPSIE   I
  61.     BX      LR                                                  ; Exception return will restore remaining context
  62.   
  63.     END
复制代码

main.c内容如下:
  1. #include "stdio.h"
  2. #define OS_EXCEPT_STK_SIZE 1024
  3. #define TASK_1_STK_SIZE 1024
  4. #define TASK_2_STK_SIZE 1024

  5. typedef unsigned int OS_STK;
  6. typedef void (*OS_TASK)(void);

  7. typedef struct OS_TCB
  8. {
  9.   OS_STK *StkAddr;
  10. }OS_TCB,*OS_TCBP;


  11. OS_TCBP g_OS_Tcb_CurP;
  12. OS_TCBP g_OS_Tcb_HighRdyP;

  13. static OS_STK OS_CPU_ExceptStk[OS_EXCEPT_STK_SIZE];
  14. OS_STK *g_OS_CPU_ExceptStkBase;

  15. static OS_TCB TCB_1;
  16. static OS_TCB TCB_2;
  17. static OS_STK TASK_1_STK[TASK_1_STK_SIZE];
  18. static OS_STK TASK_2_STK[TASK_2_STK_SIZE];

  19. extern void OSStart_Asm(void);
  20. extern void OSCtxSw(void);

  21. void Task_Switch()
  22. {
  23.   if(g_OS_Tcb_CurP == &TCB_1)
  24.     g_OS_Tcb_HighRdyP=&TCB_2;
  25.   else
  26.     g_OS_Tcb_HighRdyP=&TCB_1;

  27.   OSCtxSw();
  28. }


  29. void task_1()
  30. {
  31.   printf("Task 1 Running!!!\n");
  32.   Task_Switch();
  33.   printf("Task 1 Running!!!\n");
  34.   Task_Switch();
  35. }

  36. void task_2()
  37. {
  38.   
  39.   printf("Task 2 Running!!!\n");
  40.   Task_Switch();
  41.   printf("Task 2 Running!!!\n");
  42.   Task_Switch();
  43. }

  44. void Task_End(void)
  45. {
  46.   printf("Task End\n");
  47.   while(1)
  48.   {}
  49. }

  50. void Task_Create(OS_TCB *tcb,OS_TASK task,OS_STK *stk)
  51. {
  52.     OS_STK  *p_stk;
  53.     p_stk      = stk;
  54.     p_stk      = (OS_STK *)((OS_STK)(p_stk) & 0xFFFFFFF8u);
  55.    
  56.     *(--p_stk) = (OS_STK)0x01000000uL;                          //xPSR
  57.     *(--p_stk) = (OS_STK)task;                                  // Entry Point
  58.     *(--p_stk) = (OS_STK)Task_End;                                     // R14 (LR)
  59.     *(--p_stk) = (OS_STK)0x12121212uL;                          // R12
  60.     *(--p_stk) = (OS_STK)0x03030303uL;                          // R3
  61.     *(--p_stk) = (OS_STK)0x02020202uL;                          // R2
  62.     *(--p_stk) = (OS_STK)0x01010101uL;                          // R1
  63.     *(--p_stk) = (OS_STK)0x00000000u;                           // R0
  64.    
  65.     *(--p_stk) = (OS_STK)0x11111111uL;                          // R11
  66.     *(--p_stk) = (OS_STK)0x10101010uL;                          // R10
  67.     *(--p_stk) = (OS_STK)0x09090909uL;                          // R9
  68.     *(--p_stk) = (OS_STK)0x08080808uL;                          // R8
  69.     *(--p_stk) = (OS_STK)0x07070707uL;                          // R7
  70.     *(--p_stk) = (OS_STK)0x06060606uL;                          // R6
  71.     *(--p_stk) = (OS_STK)0x05050505uL;                          // R5
  72.     *(--p_stk) = (OS_STK)0x04040404uL;                          // R4
  73.    
  74.     tcb->StkAddr=p_stk;
  75. }


  76. int main()
  77. {
  78.   
  79.   g_OS_CPU_ExceptStkBase = OS_CPU_ExceptStk + OS_EXCEPT_STK_SIZE - 1;
  80.   
  81.   Task_Create(&TCB_1,task_1,&TASK_1_STK[TASK_1_STK_SIZE-1]);
  82.   Task_Create(&TCB_2,task_2,&TASK_2_STK[TASK_1_STK_SIZE-1]);
  83.    
  84.   g_OS_Tcb_HighRdyP=&TCB_1;
  85.   
  86.   OSStart_Asm();
  87.   
  88.   return 0;
  89. }
复制代码

编译下载并调试:

02143746-b3794508e0a644a09cf863ef3da935ed.jpg

在此处设置断点
此时寄存器的值,可以看到R4-R11正是我们给的值,单步运行几次,可以看到进入了我们的任务task_1或task_2,任务里打印信息,然后调用Task_Switch进行切换,OSCtxSw触发PendSV异常。

02143747-3c53018b89dc48bb97ef1b9761c698ca.png

IO输出如下:

02143748-2d79fed2fb1e43c2bb90024f7679b5bd.jpg

至此我们成功实现了使用PenSV进行两个任务的互相切换。之后,我们使用使用SysTick实现比较完整的多任务切换。

收藏 评论0 发布时间:2022-1-16 18:03

举报

0个回答

所属标签

相似分享

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
STM32N6 AI生态系统
STM32MCU,MPU高性能GUI
ST ACEPACK电源模块
意法半导体生物传感器
STM32Cube扩展软件包
关注我们
st-img 微信公众号
st-img 手机版