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

【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持

[复制链接]
erabby 发布时间:2014-4-28 00:19
因项目需要使用STM32F417的硬件浮点单元,但当时Micrium的官方移植µC/OS-III V3.03.01 (2013/01/23)不支持FPU,因此需要修改代码添加FPU支持。
: v9 Q/ G! z0 t. D% X* [* [首先,为了便于控制是否使用FPU,定义一个宏 USE_FPU。需要使用FPU时在MDK的工程选项中定义这个宏,要在”C/C++“和”Asm“选项卡中都定义,这样无论C代码还是汇编代码中都可以使用这个宏了。需要注意的是,预定义宏__TARGET_FPU_VFP只能在C文件中使用,汇编文件中不能使用。
( |4 v6 Y6 T' H然后,在CPU初始化代码中设置FPU。在官方移植中,设置代码已经有了,但被注释掉了,只要取消注释即可,然后再设置代码前后添加条件编译:! Q8 t- V) U! ?" D. `5 b
                IF  EF: USE_FPU# q$ q3 _, k' x4 ^
                               
* x/ ]/ C. M6 _;Enable FPU
+ N1 \9 k- i2 i3 t7 `;Use reset settings: automatic lazy FPU state preservation* _, y  K7 N, M8 E6 M! p
                LDR     R0, =0xE000ED88           ; Enable CP10,CP11* f. E# R4 m0 n1 W0 e! B
                LDR     R1,[R0]7 ^2 v5 M4 q$ ~, r/ {' Q  T) x
0 N' h/ F; Q1 P, I
<span lang="EN-US" style="font-size: 9pt; font-family: Arial, sans-serif;">                ORR     R1,R1,#(0xF
赞 收藏 评论6 发布时间:2014-4-28 00:19

举报

6个回答
erabby 回答时间:2014-4-28 00:20:11

RE:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持

下一步,修改os_cpu_c.c文件中的OSTaskStkInit()函数,创建任务时在任务栈中设置浮点寄存器的初值。修改后的OSTaskStkInit()函数代码如下:2 W+ q% {: K4 `3 j9 [# \9 g! r% L2 |
CPU_STK  *OSTaskStkInit (OS_TASK_PTR    p_task,
0 I4 j# ]8 b/ g: h- }void          *p_arg,
1 g& D5 q! v( h  Q+ c% ]4 \; kCPU_STK       *p_stk_base,
/ b. S5 v, R2 `. A6 @% RCPU_STK       *p_stk_limit,, C8 }- I) ^$ T0 c, }5 ^% u
CPU_STK_SIZE   stk_size,9 }( y# J- E5 C# V& h* x
OS_OPT         opt)8 q; Q. ]' P- n  a2 t) W4 w. N
{5 B5 y/ @" ^+ s/ e# x8 t
CPU_STK  *p_stk;
/ @4 l1 j% z' \5 e( q+ x7 a- ~
1 b! \& |$ R7 D0 {3 Q(void)opt;                                              /* Prevent compiler warning                               */, Q2 s, s; ~9 I3 ^; R" X
p_stk = &p_stk_base[stk_size];                          /* Load stack pointer                                     */' s9 x  V1 c8 {# j1 f. r* j5 y
/* Align the stack to 8-bytes.                            */# u. f+ e. n5 E: `0 U0 B
p_stk = (CPU_STK *)((CPU_STK)(p_stk) & 0xFFFFFFF8);, B# |7 T$ d0 ]
/* Registers stacked as if auto-saved on exception        */# }) a5 J, m9 ~& M
#ifdef  USE_FPU
* R' H) t& q4 Z7 |$ @% N*--p_stk = (CPU_STK)0xABCD1234u;                                                /* Reserved                                               */! q  [, T% G4 w& {( S1 w! Z+ r1 O1 R
*--p_stk = (CPU_STK)0x00000000u;                                                /* FPSCR                                                  */+ ^( B/ ^' A( s" a- U
*--p_stk = (CPU_STK)0x7FC01515u;                                                /* S15                                                    */
# {- Y2 @& z# B9 R7 [*--p_stk = (CPU_STK)0x7FC01414u;                                                /* S14                                                    */
3 t" H4 X$ Y2 ]: T% A! I& M9 M*--p_stk = (CPU_STK)0x7FC01313u;                                                /* S13                                                    */
  r5 N) V  s  x  C*--p_stk = (CPU_STK)0x7FC01212u;                                                /* S12                                                    */7 x& ?& y2 i2 l( X# p+ `. `# R
*--p_stk = (CPU_STK)0x7FC01111u;                                                /* S11                                                    */* b7 `7 }- @- m5 |$ Z
*--p_stk = (CPU_STK)0x7FC01010u;                                                /* S10                                                    */
3 s4 j3 v5 ^- _9 S. P*--p_stk = (CPU_STK)0x7FC00909u;                                                /* S9                                                     */) k' D; W4 y; |  x
*--p_stk = (CPU_STK)0x7FC00808u;                                                /* S8                                                     */
( R! e1 s$ ^9 \*--p_stk = (CPU_STK)0x7FC00707u;                                                /* S7                                                     */
5 ]/ j1 O, \! O- H, ?9 s+ i*--p_stk = (CPU_STK)0x7FC00606u;                                                /* S6                                                     */
3 ]6 R7 D8 [* k*--p_stk = (CPU_STK)0x7FC00505u;                                                /* S5                                                     */8 k" K: ]8 n' y8 T
*--p_stk = (CPU_STK)0x7FC00404u;                                                /* S4                                                     */
4 s. p0 f1 F- s$ B$ D4 q. S*--p_stk = (CPU_STK)0x7FC00303u;                                                /* S3                                                     */4 F- O9 h9 H. _  B# s; y
*--p_stk = (CPU_STK)0x7FC00202u;                                                /* S2                                                     */
* @: D2 h' k% V; {6 Z*--p_stk = (CPU_STK)0x7FC00101u;                                                /* S1                                                     */6 P' Q% [& u! L+ x; X2 a( S2 F+ H+ c
*--p_stk = (CPU_STK)0x7FC00000u;                                                /* S0                                                     */
. `! H6 U  ?0 z* R/ u0 j. g4 T! h#endif  /* USE_FPU */
" u- o- ?" o3 z( M' \) L  J
*--p_stk = (CPU_STK)0x01000000u;                        /* xPSR                                                   */7 J* d/ }! x' W6 u/ }' ^/ J  N
*--p_stk = (CPU_STK)p_task;                             /* Entry Point                                            */" l! \0 ?) Z; x- _" ^/ |, B0 e
*--p_stk = (CPU_STK)OS_TaskReturn;                      /* R14 (LR)                                               */
( x# k& {* G3 r$ _/ \  k) A8 j. f*--p_stk = (CPU_STK)0x12121212u;                        /* R12                                                    */3 `+ v) z+ X$ u. c0 u" G8 W
*--p_stk = (CPU_STK)0x03030303u;                        /* R3                                                     */( v! X# v4 q1 B2 V0 ?$ I
*--p_stk = (CPU_STK)0x02020202u;                        /* R2                                                     *// ^1 ~6 u' d- s) d
*--p_stk = (CPU_STK)p_stk_limit;                        /* R1                                                     */
0 h- L1 |# A/ n4 G. |5 D*--p_stk = (CPU_STK)p_arg;                              /* R0 : argument                                          */
: I! D/ D. G0 i( X5 E5 M/* Remaining registers saved on process stack             */+ W4 f, t3 Q( [% a
#ifdef  USE_FPU1 S& b; C: p+ C+ W0 {
*--p_stk = (CPU_STK)0x7FC03131u;                                                /* S31                                                    */* E  }" W) p* N) X( b8 c
*--p_stk = (CPU_STK)0x7FC03030u;                                                /* S30                                                    */. \' U2 v3 A. ]
*--p_stk = (CPU_STK)0x7FC02929u;                                                /* S29                                                    */
( Z4 W! y) F" S( s, S% Z( X. Z*--p_stk = (CPU_STK)0x7FC02828u;                                                /* S28                                                    */" H& D/ c% q3 G
*--p_stk = (CPU_STK)0x7FC02727u;                                                /* S27                                                    */
1 Q" \4 X! h) q$ q( X*--p_stk = (CPU_STK)0x7FC02626u;                                                /* S26                                                    */
2 x6 Y! S# n: e*--p_stk = (CPU_STK)0x7FC02525u;                                                /* S25                                                    */
  T( N6 c6 U  y* o" D9 F' |! ~*--p_stk = (CPU_STK)0x7FC02424u;                                                /* S24                                                    */
  r% v( c" [) r/ ]1 g. B7 I*--p_stk = (CPU_STK)0x7FC02323u;                                                /* S23                                                    */3 ~6 V) L2 G8 U
*--p_stk = (CPU_STK)0x7FC02222u;                                                /* S22                                                    */
7 J& [, m1 y: T- ]1 o' |: f*--p_stk = (CPU_STK)0x7FC02121u;                                                /* S21                                                    */
/ [- ^% s/ ?. A) s0 C- E, r*--p_stk = (CPU_STK)0x7FC02020u;                                                /* S20                                                    */; U5 [4 j1 t) E( i9 o4 z
*--p_stk = (CPU_STK)0x7FC01919u;                                                /* S19                                                    */
% W  i6 |9 H( {. w*--p_stk = (CPU_STK)0x7FC01818u;                                                /* S18                                                    */$ t, R  n( c" y% X! r8 O* I
*--p_stk = (CPU_STK)0x7FC01717u;                                                /* S17                                                    */
- ^4 h: t3 J* S" R* j1 i, Q. U' a*--p_stk = (CPU_STK)0x7FC01616u;                                                /* S16                                                        */* z* [5 I" E$ X/ C  y- W! z
#endif  /* USE_FPU */

, k# e) f' u% L7 [5 i7 G*--p_stk = (CPU_STK)0x11111111u;                        /* R11                                                    */' Y( k$ G5 e# l
*--p_stk = (CPU_STK)0x10101010u;                        /* R10                                                    */, M5 r& Q, k% y( D  ]
*--p_stk = (CPU_STK)0x09090909u;                        /* R9                                                     */
: x' ~1 W7 h/ ^( T( Y*--p_stk = (CPU_STK)0x08080808u;                        /* R8                                                     */- M6 ?) |$ @# f1 R; U& j
*--p_stk = (CPU_STK)0x07070707u;                        /* R7                                                     */; P) B: g& o# j1 j% N& r
*--p_stk = (CPU_STK)0x06060606u;                        /* R6                                                     */4 x# v- o: I: g/ v3 n5 c1 ^
*--p_stk = (CPU_STK)0x05050505u;                        /* R5                                                     */
( N5 F  @$ Q& ~. h7 x*--p_stk = (CPU_STK)0x04040404u;                        /* R4                                                     */5 R! A2 j3 }% u. k' @
return (p_stk);. M$ u/ A( b/ N4 o5 |
}
2 J+ y/ `  y! ?9 o! O* m其中红色代码是新添加的处理浮点寄存器的代码。特别注意注释为Reserved的第2行红字,在任务栈中保存这个保留的32位字是必须的,其值没有特别要求,请参考ARMv7-M Architecture Reference Manual (DDI0403D)。
erabby 回答时间:2014-4-28 00:24:30

回复:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持

 最后,修改os_cpu_a.asm文件中的OS_CPU_PendSVHandler子程序,任务切换时保存旧任务的浮点寄存器并加载新任务的浮点寄存器值。修改后的OS_CPU_PendSVHandler子程序代码如下:  U) S2 C* g1 J6 ~8 w# r' p! w
OS_CPU_PendSVHandler
* V/ e$ Y9 V- @) W9 e    CPSID   I                                                   ; Prevent interruption during context switch
  ?2 _. m# N2 T4 ?    MRS     R0, PSP                                             ; PSP is process stack pointer7 A/ y# ~$ C% _) H: D5 W
    CBZ     R0, OS_CPU_PendSVHandler_nosave                     ; Skip register save the first time3 k; w3 z( w) N$ ^& u- q
        , E  i& E7 ^" ?& j' G5 t. }1 i
        IF  EF: USE_FPU
3 G+ \/ a+ H5 K" U       
* a: B) U; |' G. K; R$ i: ~" Z8 i7 M        VMRS    R1, FPSCR             ; Dummy read access to force FPU state preservation and FPSCR clear  }+ {& o+ `- I7 |# R- q% a* W! S% d
        SUBS    R0, R0, #0x40        ; Save remaining FP regs s16-s31 on process stack4 t2 e/ A" d7 W5 @3 ?
        VSTM      R0, {D8-D15}" I1 i% z. R+ Y+ W: ]7 Z0 H* W: I, g
       
1 w+ s1 W: b! Z/ C        ENDIF8 G/ `2 P: O- ^% E3 s6 P
 
, M, O0 q' z( ^+ |    SUBS    R0, R0, #0x20                                       ; Save remaining regs r4-11 on process stack2 w  L( c5 [7 C) T
    STM     R0, {R4-R11}
; x) d( Y; E5 z" ^5 a 
5 p* {! \% V; h" v    LDR     R1, =OSTCBCurPtr                                    ; OSTCBCurPtr->OSTCBStkPtr = SP;8 u% x2 q% u) z. f& B
    LDR     R1, [R1]* u, N$ ~) y0 L
    STR     R0, [R1]                                            ; R0 is SP of process being switched out
8 g$ Y; g! F  W" i: k. Q , {! A/ y  i3 ]8 l
     ; At this point, entire context of process has been saved8 J. V. }) y+ v7 L7 |6 {9 `( O
OS_CPU_PendSVHandler_nosave& A; ~& M$ p; F
    PUSH    {R14}                                               ; Save LR exc_return value
) J! S4 F( k% ]+ B    LDR     R0, =OSTaskSwHook                                   ; OSTaskSwHook();
6 B6 ?/ e' Y! N) x- C4 d    BLX     R0; q7 y: j% a, c/ K( n. m( U
    POP     {R14}
: f, r& z  t( ` # g4 H, w5 s4 ~! C0 K( [
    LDR     R0, =OSPrioCur                                      ; OSPrioCur   = OSPrioHighRdy;
( `$ B; M4 p: b    LDR     R1, =OSPrioHighRdy4 v+ Y3 h: L+ B6 V3 g
    LDRB    R2, [R1], H7 T' {- ^; h; D$ r4 B0 B8 p
    STRB    R2, [R0]
/ ^( I: c$ h+ R( [1 y, i3 V 2 m8 L4 _4 G6 \- p
    LDR     R0, =OSTCBCurPtr                                    ; OSTCBCurPtr = OSTCBHighRdyPtr;
* B# m' g- H$ B  E& D) `    LDR     R1, =OSTCBHighRdyPtr
' c* Z' m$ O, e8 `5 \- Z    LDR     R2, [R1]
, a$ N' b' h+ O" F- ]. z1 m    STR     R2, [R0]
2 P6 {# Z  Q! n $ @2 O, _" J' j" v. ~( E
    LDR     R0, [R2]                                            ; R0 is new process SP; SP = OSTCBHighRdyPtr->StkPtr;
2 P% P, t% |4 S+ c  k1 T    LDM     R0, {R4-R11}                                        ; Restore r4-11 from new process stack; y1 X3 J+ C* t4 u
    ADDS    R0, R0, #0x204 ~: S; ~( E$ H, x# L; V& l* t
       
% j2 i" [! X' Z4 g$ H        IF  EF: USE_FPU
. l6 I: ?( a7 ?% {" G6 O% ~  a       
) K' d$ V, m2 t- Y        VLDM      R0, {D8-D15}                        ; Restore s16-s31 from new process stack- r/ \5 ]4 p( M
        ADDS       R0, R0, #0x40
7 ?0 H, K: r" w! ~4 V6 h        " L( x" y* ?2 m: U+ H
        ENDIF- }1 S5 W4 V; \% @6 e
       
: B, k4 V/ E$ v. [$ j! Y    MSR     PSP, R0                                             ; Load PSP with new process SP
9 t1 K) c; G" v4 Y5 o8 H    ORR     LR, LR, #0x04                                       ; Ensure exception return uses process stack1 n  B, ^7 W, A- B
        ( j( J+ L/ d" k9 M2 G3 L1 j
        IF  EF: USE_FPU
( C9 \/ U. @( W- N0 U       
. {9 \( h. u8 \4 l; p9 u( g        AND         LR, LR, #0xFFFFFFEF             ; Clear LR to ensure FPU state restore
# z# z& u# S% s        LDR     R0, =0xE000EF34                         ; Clear FPCCR (LSPACT) to ensure FPU state restore9 `( D" }/ `. B/ Y
        LDR     R1, [R0]
8 T; U# g% j+ c1 V        AND     R1, R1, #0xFFFFFFFE7 `; E5 p( E, Y1 a
        STR     R1, [R0]" r  T4 q- k! h; C, T/ Y
 
( F( C; h8 \# @- |6 p3 H. A" h9 z! o        ENDIF
5 Y9 N9 F1 y8 A1 p$ T$ I& T       
2 u* e9 [" m/ V  E$ k% ~% q+ n$ w        CPSIE   I
" ]. R# X6 |7 b5 _6 bBX      LR                                                  ; Exception return will restore remaining context
1 K) q8 q; S; i" A# P% G其中红色代码是新添加的处理浮点寄存器的代码。几点说明:- s% P7 d7 g9 t9 Y5 X. `
1)根据FPCCR的设置值(就是复位值ASPEN=1, LSPEN=1),如果发生PendSV异常时CONTROL.FPCA=1,在进入PendSV异常处理函数时,硬件会自动在任务栈保留浮点寄存器占用的空间,首先通过读FPSCR寄存器让硬件自动保存浮点寄存器S0~S15和浮点状态寄存器FPSCR到任务栈,然后手动保存其余的浮点寄存器S16~S31。
' U" `5 D6 U- y, F2)在退出PendSV异常处理函数前,清除LR第4位并清除FPCCR寄存器第0位(LSPACT),目的是让硬件在退出PendSV异常处理函数时自动从任务栈恢复浮点寄存器S0~S15和浮点状态寄存器FPSCR。这样如果新任务是第一次运行,则可实现从任务栈加载浮点寄存器初值,否则是从任务栈加载以前保存的值,并且可以保证每个任务运行时都有CONTROL.FPCA=1。
: i6 {: l& B- e6 o% J9 H( w' k3)虽然使能了延迟保存浮点状态功能,但因为总是有CONTROL.FPCA=1,因此无论旧任务是否执行过浮点指令,在进入PendSV异常处理函数执行任务切换时,都会保存旧任务的浮点寄存器,加载新任务的浮点寄存器,没有利用延迟保存浮点状态功能可减小中断延迟的优势。
erabby 回答时间:2014-4-28 00:47:39

RE:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持

以上代码在STM3241G-Eval评估板上测试通过,并且已经在产品中成功应用。
yw0238 回答时间:2014-4-28 11:39:39

回复:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持

谢谢,在F407VG上通过
erabby 回答时间:2014-4-28 21:57:26

回复:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持

回复第 5 楼 于2014-04-28 11:39:39发表:; u. b* n' x3 O9 N
谢谢,在F407VG上通过5 j7 k, J$ U; a* Z
 ; ^3 a8 Y2 I3 [- g: A
只要是Cortex-M4核应该都可以7 n0 Y1 z8 U- B; l) ^5 ?# n
 
A.K. 回答时间:2014-4-30 14:25:24

RE:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持

好经验,谢谢楼主分享。

所属标签

相似技术帖

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版