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

【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支持。
  Y# X9 j1 e- C  m" V4 l首先,为了便于控制是否使用FPU,定义一个宏 USE_FPU。需要使用FPU时在MDK的工程选项中定义这个宏,要在”C/C++“和”Asm“选项卡中都定义,这样无论C代码还是汇编代码中都可以使用这个宏了。需要注意的是,预定义宏__TARGET_FPU_VFP只能在C文件中使用,汇编文件中不能使用。; o, I8 r: A* m1 L9 Y
然后,在CPU初始化代码中设置FPU。在官方移植中,设置代码已经有了,但被注释掉了,只要取消注释即可,然后再设置代码前后添加条件编译:# {- n6 }. Y: }1 D) a
                IF  EF: USE_FPU
# d& k& ?, x5 U  b                                8 C. u8 a7 j$ H
;Enable FPU
+ K. A3 D+ t1 b1 L; U  l; O;Use reset settings: automatic lazy FPU state preservation
1 H. M5 ]! o, ?. h3 \                LDR     R0, =0xE000ED88           ; Enable CP10,CP11
" S; C0 H7 Q5 [                LDR     R1,[R0]
2 |5 \$ m- n0 h* J+ [! q3 T3 P  C- A& Q/ X' P/ }8 w4 J6 x# B
<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()函数代码如下:' v% s! n7 l, \, J# J2 D4 j
CPU_STK  *OSTaskStkInit (OS_TASK_PTR    p_task,# w) k3 b8 P1 M' {" r4 e9 d
void          *p_arg,
& S9 f0 \- I' S  d% H$ ]2 ]& n( iCPU_STK       *p_stk_base,: h8 m7 C3 ~/ S: A
CPU_STK       *p_stk_limit,6 g& B; R- i! [) ?+ o# x
CPU_STK_SIZE   stk_size,
+ g! f% K$ l- _9 C: VOS_OPT         opt)  d" Z- V' y5 g9 ?9 I8 p
{5 G+ W$ X- @) ^3 R. v6 W. p
CPU_STK  *p_stk;( M! {2 c$ I7 H% F4 ^4 p6 M

/ ?3 F8 O* m' g(void)opt;                                              /* Prevent compiler warning                               */; z  q" P9 _" o# U: w/ z3 z2 M
p_stk = &p_stk_base[stk_size];                          /* Load stack pointer                                     */
7 ~3 E  i5 X" q" V( r+ m0 }- B/* Align the stack to 8-bytes.                            */
# E/ A3 A- n& Q, y$ `p_stk = (CPU_STK *)((CPU_STK)(p_stk) & 0xFFFFFFF8);# J% A0 _/ V9 N/ C! z4 u
/* Registers stacked as if auto-saved on exception        */% g& f& c7 h! J6 q4 q
#ifdef  USE_FPU3 P3 J3 m- X) G. I3 Y0 v: d
*--p_stk = (CPU_STK)0xABCD1234u;                                                /* Reserved                                               */
) |8 z# }! o5 g5 k( F*--p_stk = (CPU_STK)0x00000000u;                                                /* FPSCR                                                  */8 q+ x# a' ~+ k
*--p_stk = (CPU_STK)0x7FC01515u;                                                /* S15                                                    */
5 o$ u3 h' i/ `/ h* {4 C, W) K& [+ e*--p_stk = (CPU_STK)0x7FC01414u;                                                /* S14                                                    */. \% @* e# b* `: b9 _
*--p_stk = (CPU_STK)0x7FC01313u;                                                /* S13                                                    */
9 t9 m, ], X+ s% x1 D*--p_stk = (CPU_STK)0x7FC01212u;                                                /* S12                                                    */
% k. O* N7 f, s9 J' x, l0 P. [*--p_stk = (CPU_STK)0x7FC01111u;                                                /* S11                                                    */
0 {. {1 d3 @9 L*--p_stk = (CPU_STK)0x7FC01010u;                                                /* S10                                                    */' ~' {/ a& ^0 g
*--p_stk = (CPU_STK)0x7FC00909u;                                                /* S9                                                     */
0 q+ T6 |# q, `, I* D! j& Z: _*--p_stk = (CPU_STK)0x7FC00808u;                                                /* S8                                                     */- O8 H; Y: F; W: n* b  s& ]9 V; n& v
*--p_stk = (CPU_STK)0x7FC00707u;                                                /* S7                                                     */" d  R( a( ^& v8 n
*--p_stk = (CPU_STK)0x7FC00606u;                                                /* S6                                                     */3 O( I3 M; ]! P$ q9 S7 t
*--p_stk = (CPU_STK)0x7FC00505u;                                                /* S5                                                     */* _, R% \, `3 D' b
*--p_stk = (CPU_STK)0x7FC00404u;                                                /* S4                                                     */  s- G3 c7 M' o  j" V
*--p_stk = (CPU_STK)0x7FC00303u;                                                /* S3                                                     */
; r0 l9 c  d6 I0 X  ]5 U4 \*--p_stk = (CPU_STK)0x7FC00202u;                                                /* S2                                                     */
; s# k9 z3 i+ J0 t*--p_stk = (CPU_STK)0x7FC00101u;                                                /* S1                                                     */
, Y9 v9 J( x- I; b* z*--p_stk = (CPU_STK)0x7FC00000u;                                                /* S0                                                     */2 _; d1 ]) I8 G, `4 w6 X
#endif  /* USE_FPU */
) B' a+ T# n0 b# p4 F$ l
*--p_stk = (CPU_STK)0x01000000u;                        /* xPSR                                                   */0 c6 j$ v, j5 [- t, ^
*--p_stk = (CPU_STK)p_task;                             /* Entry Point                                            */+ j; |3 U( }+ v0 Y  t. Z
*--p_stk = (CPU_STK)OS_TaskReturn;                      /* R14 (LR)                                               */1 A7 w% U6 U$ Z3 f* {1 t4 X$ ?
*--p_stk = (CPU_STK)0x12121212u;                        /* R12                                                    */
6 `" S* R3 |0 P: e/ X  e*--p_stk = (CPU_STK)0x03030303u;                        /* R3                                                     */' C! i: u" ~: K
*--p_stk = (CPU_STK)0x02020202u;                        /* R2                                                     */$ h  ]8 v# \  [& x; N; ]+ P9 m! Y/ D
*--p_stk = (CPU_STK)p_stk_limit;                        /* R1                                                     */- r; d( o3 K3 m9 [' n% g8 m
*--p_stk = (CPU_STK)p_arg;                              /* R0 : argument                                          */: w0 F! k! L4 J
/* Remaining registers saved on process stack             */
4 H" j2 }7 k! r0 t#ifdef  USE_FPU: A$ O- y$ n" R" y0 L8 f& E. e- @1 M# F
*--p_stk = (CPU_STK)0x7FC03131u;                                                /* S31                                                    */
$ E, x, {( k! A# y+ s' b*--p_stk = (CPU_STK)0x7FC03030u;                                                /* S30                                                    */
; F- f7 G8 ]3 a! s- O% o  I! C*--p_stk = (CPU_STK)0x7FC02929u;                                                /* S29                                                    */! J; s' y7 f+ C6 Y7 o' R( v6 k
*--p_stk = (CPU_STK)0x7FC02828u;                                                /* S28                                                    */
% M& J' o) `( {! C* q*--p_stk = (CPU_STK)0x7FC02727u;                                                /* S27                                                    */
* x& m! _- c; ?3 C5 b7 Z6 t7 \6 U*--p_stk = (CPU_STK)0x7FC02626u;                                                /* S26                                                    */
4 b$ @  r1 G0 l/ Q3 W$ F*--p_stk = (CPU_STK)0x7FC02525u;                                                /* S25                                                    */
; |8 H8 X3 a+ T, [+ x*--p_stk = (CPU_STK)0x7FC02424u;                                                /* S24                                                    */' F& q0 O) ~  \0 l
*--p_stk = (CPU_STK)0x7FC02323u;                                                /* S23                                                    */- ~' F4 @7 }) O
*--p_stk = (CPU_STK)0x7FC02222u;                                                /* S22                                                    */
" U/ h1 v  O2 o, e3 d6 u8 }*--p_stk = (CPU_STK)0x7FC02121u;                                                /* S21                                                    */
$ }4 m% C  E8 Y. ?" }; \* Q+ r+ s*--p_stk = (CPU_STK)0x7FC02020u;                                                /* S20                                                    *// ?' f' m9 Q2 `, c8 {4 N- H
*--p_stk = (CPU_STK)0x7FC01919u;                                                /* S19                                                    */+ ]5 c9 T3 N% k5 {4 C# B/ t2 L
*--p_stk = (CPU_STK)0x7FC01818u;                                                /* S18                                                    */, n3 E- D* X2 B( B9 ?
*--p_stk = (CPU_STK)0x7FC01717u;                                                /* S17                                                    */
- l: X% X* k6 {, s; w& E* `3 h*--p_stk = (CPU_STK)0x7FC01616u;                                                /* S16                                                        */
7 g! W$ m) n$ m# h+ t. R- e# C0 a! T#endif  /* USE_FPU */

1 f( g4 @- ]6 p*--p_stk = (CPU_STK)0x11111111u;                        /* R11                                                    */
1 i0 o& h5 q0 v7 z*--p_stk = (CPU_STK)0x10101010u;                        /* R10                                                    */3 M$ x# G3 S/ g" f5 i+ x! B
*--p_stk = (CPU_STK)0x09090909u;                        /* R9                                                     */
: l; o" u& ]& W9 m2 ]: z: V% N+ u*--p_stk = (CPU_STK)0x08080808u;                        /* R8                                                     */
6 I) Z  o& w4 M; V! g; ~, M" w*--p_stk = (CPU_STK)0x07070707u;                        /* R7                                                     */
$ p' T$ @4 ?; n! u*--p_stk = (CPU_STK)0x06060606u;                        /* R6                                                     */4 o  @/ u* S( h# c) e" d
*--p_stk = (CPU_STK)0x05050505u;                        /* R5                                                     */
; z* o. m$ q  H. E" G*--p_stk = (CPU_STK)0x04040404u;                        /* R4                                                     */1 |3 }' `  |- k5 U2 S6 z
return (p_stk);
3 u# _, T) A. R! `9 w) ?}
9 J; \" S" V  y- Z2 q其中红色代码是新添加的处理浮点寄存器的代码。特别注意注释为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子程序代码如下:
5 b1 n; S& g1 n. K3 jOS_CPU_PendSVHandler
* Q! e0 Z8 W9 x) d5 b- a  ^    CPSID   I                                                   ; Prevent interruption during context switch- f. G* n+ R7 {
    MRS     R0, PSP                                             ; PSP is process stack pointer
" D% G+ W* H/ U" |; i    CBZ     R0, OS_CPU_PendSVHandler_nosave                     ; Skip register save the first time
6 R  ~% p4 Z4 f( i# t( }        3 l3 o3 g/ l4 |; j- ~8 \
        IF  EF: USE_FPU
. s& I4 I4 o7 Z1 ^0 ~" r% V        . J; @( T; T+ U% K9 y0 T2 a- A
        VMRS    R1, FPSCR             ; Dummy read access to force FPU state preservation and FPSCR clear* G; _+ w( m, f- H, ], N% q
        SUBS    R0, R0, #0x40        ; Save remaining FP regs s16-s31 on process stack3 ~9 Q! t: r7 v, ~2 \# I7 B/ w
        VSTM      R0, {D8-D15}6 A7 }2 h% ]3 k
       
1 [( [6 A6 L5 t7 W, t# F4 a$ H        ENDIF
5 k' [$ K, i, v ( l% E- M' |3 F# W* d) L
    SUBS    R0, R0, #0x20                                       ; Save remaining regs r4-11 on process stack! l' c5 V. ~7 `/ S
    STM     R0, {R4-R11}' \6 Q( ^9 Y, ~' E
 
. Q* {2 W" E' p6 \5 n4 S/ ~    LDR     R1, =OSTCBCurPtr                                    ; OSTCBCurPtr->OSTCBStkPtr = SP;
* Z5 i2 w% @0 o3 y    LDR     R1, [R1]
+ a' y( `4 G) O( y. v    STR     R0, [R1]                                            ; R0 is SP of process being switched out. R+ |- e  L! V8 L6 [' M
 8 a# `( O& q3 X9 l& w1 `7 U
     ; At this point, entire context of process has been saved- m. K) |6 o" m5 ^: C/ J& C7 D6 j$ L
OS_CPU_PendSVHandler_nosave
+ @, x4 l* j  ^! [2 V# u    PUSH    {R14}                                               ; Save LR exc_return value
4 |& `5 I% U% H. W6 t6 ]$ W    LDR     R0, =OSTaskSwHook                                   ; OSTaskSwHook();# p" w8 {# r! E$ q% w, _6 \3 S7 U
    BLX     R0
; o. ^; B0 |" i: e" z7 |6 Q9 H) d    POP     {R14}1 j7 w) w- N7 Z7 F2 m
 
1 p4 W; L9 o) I. L! \4 j4 b+ D    LDR     R0, =OSPrioCur                                      ; OSPrioCur   = OSPrioHighRdy;
. p; l! f# W( j6 }    LDR     R1, =OSPrioHighRdy
- y! ?3 p* L( [8 U& r0 l+ [    LDRB    R2, [R1]
% p0 y' q$ u6 Y    STRB    R2, [R0]
8 U$ Y# }0 B) R0 R $ {" k2 m0 I& j. i2 h. ]3 ?9 W
    LDR     R0, =OSTCBCurPtr                                    ; OSTCBCurPtr = OSTCBHighRdyPtr;0 g# l/ R& h8 b+ R, z; Z
    LDR     R1, =OSTCBHighRdyPtr
/ ]! j7 J8 _' [* e$ J$ ^    LDR     R2, [R1]
- ~- b2 v; L' Y4 N7 `    STR     R2, [R0]
9 }2 l$ F" h0 R- X: r ' a) C9 ~# V, ~6 M: l. g
    LDR     R0, [R2]                                            ; R0 is new process SP; SP = OSTCBHighRdyPtr->StkPtr;
3 o* |) \8 ~' x$ d    LDM     R0, {R4-R11}                                        ; Restore r4-11 from new process stack/ G0 ?( b: x% p9 A4 w) F
    ADDS    R0, R0, #0x20
& T0 b. c6 k/ E0 F' m( g5 L        / D9 K7 P' x# z0 {$ g) N6 R6 ~1 |' d
        IF  EF: USE_FPU$ k$ c! ~+ @  O4 t3 g
       
5 V% T2 j" ]: a& J4 v8 c6 ?        VLDM      R0, {D8-D15}                        ; Restore s16-s31 from new process stack( d" a" l  v  Y7 l- U/ J. }7 C
        ADDS       R0, R0, #0x40
5 }, X% X2 o* ^7 s# k* A        ; S1 W6 _5 V  \$ e
        ENDIF
7 s: }6 u" e; q$ \) w( c       
. Q. I" t0 g: ^2 v5 a- b# L0 a; _" ?    MSR     PSP, R0                                             ; Load PSP with new process SP/ m7 d) `9 q. A* C7 ~6 t! e4 v
    ORR     LR, LR, #0x04                                       ; Ensure exception return uses process stack
- [" k( D! `; t( W4 @        9 B, P( y5 \( g' M) H7 t1 {" W1 H
        IF  EF: USE_FPU) ~/ m5 R+ S$ C
        5 f/ y' U% \5 `" J! U
        AND         LR, LR, #0xFFFFFFEF             ; Clear LR to ensure FPU state restore
$ \& L$ y. ?" Z6 ]: `% f) [( H        LDR     R0, =0xE000EF34                         ; Clear FPCCR (LSPACT) to ensure FPU state restore# I( x( i8 Y+ w
        LDR     R1, [R0]
2 i) G+ r( x* ~2 C6 C        AND     R1, R1, #0xFFFFFFFE$ F/ K* {' \3 F+ u. ]: A- [
        STR     R1, [R0], q. \+ C1 ]  X2 W
 
' p* D3 q0 A" r8 g1 Q# v        ENDIF
; D; w. f, \/ R5 h- a3 w- o. D       
+ z' X0 `7 N8 p6 u; i  X        CPSIE   I
' Y: P% b; j& }2 T5 FBX      LR                                                  ; Exception return will restore remaining context
' w% z# c% F& h' x5 l其中红色代码是新添加的处理浮点寄存器的代码。几点说明:
* s$ Z4 G' ^0 Q1 o' L/ p& {3 f' h1)根据FPCCR的设置值(就是复位值ASPEN=1, LSPEN=1),如果发生PendSV异常时CONTROL.FPCA=1,在进入PendSV异常处理函数时,硬件会自动在任务栈保留浮点寄存器占用的空间,首先通过读FPSCR寄存器让硬件自动保存浮点寄存器S0~S15和浮点状态寄存器FPSCR到任务栈,然后手动保存其余的浮点寄存器S16~S31。
- Z5 l1 Y7 y! Q" c9 U2)在退出PendSV异常处理函数前,清除LR第4位并清除FPCCR寄存器第0位(LSPACT),目的是让硬件在退出PendSV异常处理函数时自动从任务栈恢复浮点寄存器S0~S15和浮点状态寄存器FPSCR。这样如果新任务是第一次运行,则可实现从任务栈加载浮点寄存器初值,否则是从任务栈加载以前保存的值,并且可以保证每个任务运行时都有CONTROL.FPCA=1。/ R0 ?' w1 r: c0 B; L" Z7 D  q6 |
3)虽然使能了延迟保存浮点状态功能,但因为总是有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发表:7 k$ J& G, n- R5 ^
谢谢,在F407VG上通过
+ \! V. {& \8 n$ Q, X: b- g3 q6 d 
$ n7 Z6 N; C' s# ^3 }# b: T' `0 k只要是Cortex-M4核应该都可以
6 _& v* G: y. k" i$ b: R, C 
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 手机版