|
因项目需要使用STM32F417的硬件浮点单元,但当时Micrium的官方移植µC/OS-III V3.03.01 (2013/01/23)不支持FPU,因此需要修改代码添加FPU支持。 首先,为了便于控制是否使用FPU,定义一个宏 USE_FPU。需要使用FPU时在MDK的工程选项中定义这个宏,要在”C/C++“和”Asm“选项卡中都定义,这样无论C代码还是汇编代码中都可以使用这个宏了。需要注意的是,预定义宏__TARGET_FPU_VFP只能在C文件中使用,汇编文件中不能使用。 然后,在CPU初始化代码中设置FPU。在官方移植中,设置代码已经有了,但被注释掉了,只要取消注释即可,然后再设置代码前后添加条件编译:! Q8 t- V) U! ?" D. `5 b IF EF: USE_FPU# q$ q3 _, k' x4 ^;Enable FPU ;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 |
【福利三:雨露均沾·逢7狂欢】之四:用一个定时器同步另外两个定时器输出PWM
【逢7发帖赢大礼】STM32开发之WIFI实时时钟
【逢7发帖赢大礼】STM32开发之指纹识别!
【逢7发帖赢大礼】STM32开发之环境空气质量监测
【逢7发帖赢大礼】STM32开发之人体实时运动信息监测!
【逢7发帖赢大礼】STM32开发之IC门禁卡UID读取方法!
【逢7发帖赢大礼】全网最简单的Arduino_STM32开发环境搭建教程!
STM32F4中文用户手册
STM32F400、STM32F402 Cortex-M4超值单片机
SPI 高温读错最后一位?STM32F42xx 官方根治方案
微信公众号
手机版
RE:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持
CPU_STK *OSTaskStkInit (OS_TASK_PTR p_task,
void *p_arg,
CPU_STK *p_stk_base,
CPU_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;
(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
*--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 */
*--p_stk = (CPU_STK)0x7FC01414u; /* S14 */
*--p_stk = (CPU_STK)0x7FC01313u; /* S13 */
*--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 */
*--p_stk = (CPU_STK)0x7FC00909u; /* S9 */) k' D; W4 y; | x
*--p_stk = (CPU_STK)0x7FC00808u; /* S8 */
*--p_stk = (CPU_STK)0x7FC00707u; /* S7 */
*--p_stk = (CPU_STK)0x7FC00606u; /* S6 */
*--p_stk = (CPU_STK)0x7FC00505u; /* S5 */8 k" K: ]8 n' y8 T
*--p_stk = (CPU_STK)0x7FC00404u; /* S4 */
*--p_stk = (CPU_STK)0x7FC00303u; /* S3 */4 F- O9 h9 H. _ B# s; y
*--p_stk = (CPU_STK)0x7FC00202u; /* S2 */
*--p_stk = (CPU_STK)0x7FC00101u; /* S1 */6 P' Q% [& u! L+ x; X2 a( S2 F+ H+ c
*--p_stk = (CPU_STK)0x7FC00000u; /* S0 */
#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) */
*--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 */
*--p_stk = (CPU_STK)p_arg; /* R0 : argument */
/* 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 */
*--p_stk = (CPU_STK)0x7FC02828u; /* S28 */" H& D/ c% q3 G
*--p_stk = (CPU_STK)0x7FC02727u; /* S27 */
*--p_stk = (CPU_STK)0x7FC02626u; /* S26 */
*--p_stk = (CPU_STK)0x7FC02525u; /* S25 */
*--p_stk = (CPU_STK)0x7FC02424u; /* S24 */
*--p_stk = (CPU_STK)0x7FC02323u; /* S23 */3 ~6 V) L2 G8 U
*--p_stk = (CPU_STK)0x7FC02222u; /* S22 */
*--p_stk = (CPU_STK)0x7FC02121u; /* S21 */
*--p_stk = (CPU_STK)0x7FC02020u; /* S20 */; U5 [4 j1 t) E( i9 o4 z
*--p_stk = (CPU_STK)0x7FC01919u; /* S19 */
*--p_stk = (CPU_STK)0x7FC01818u; /* S18 */$ t, R n( c" y% X! r8 O* I
*--p_stk = (CPU_STK)0x7FC01717u; /* S17 */
*--p_stk = (CPU_STK)0x7FC01616u; /* S16 */* z* [5 I" E$ X/ C y- W! z
#endif /* USE_FPU */
*--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 */
*--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 */
*--p_stk = (CPU_STK)0x04040404u; /* R4 */5 R! A2 j3 }% u. k' @
return (p_stk);. M$ u/ A( b/ N4 o5 |
}
其中红色代码是新添加的处理浮点寄存器的代码。特别注意注释为Reserved的第2行红字,在任务栈中保存这个保留的32位字是必须的,其值没有特别要求,请参考ARMv7-M Architecture Reference Manual (DDI0403D)。
回复:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持
OS_CPU_PendSVHandler
CPSID I ; Prevent interruption during context switch
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
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
ENDIF8 G/ `2 P: O- ^% E3 s6 P
SUBS R0, R0, #0x20 ; Save remaining regs r4-11 on process stack2 w L( c5 [7 C) T
STM R0, {R4-R11}
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
, {! 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
LDR R0, =OSTaskSwHook ; OSTaskSwHook();
BLX R0; q7 y: j% a, c/ K( n. m( U
POP {R14}
# g4 H, w5 s4 ~! C0 K( [
LDR R0, =OSPrioCur ; OSPrioCur = OSPrioHighRdy;
LDR R1, =OSPrioHighRdy4 v+ Y3 h: L+ B6 V3 g
LDRB R2, [R1], H7 T' {- ^; h; D$ r4 B0 B8 p
STRB R2, [R0]
2 m8 L4 _4 G6 \- p
LDR R0, =OSTCBCurPtr ; OSTCBCurPtr = OSTCBHighRdyPtr;
LDR R1, =OSTCBHighRdyPtr
LDR R2, [R1]
STR R2, [R0]
$ @2 O, _" J' j" v. ~( E
LDR R0, [R2] ; R0 is new process SP; SP = OSTCBHighRdyPtr->StkPtr;
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
IF
VLDM R0, {D8-D15} ; Restore s16-s31 from new process stack- r/ \5 ]4 p( M
ADDS R0, R0, #0x40
" L( x" y* ?2 m: U+ H
ENDIF- }1 S5 W4 V; \% @6 e
MSR PSP, R0 ; Load PSP with new process SP
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
AND LR, LR, #0xFFFFFFEF ; Clear LR to ensure FPU state restore
LDR R0, =0xE000EF34 ; Clear FPCCR (LSPACT) to ensure FPU state restore9 `( D" }/ `. B/ Y
LDR R1, [R0]
AND R1, R1, #0xFFFFFFFE7 `; E5 p( E, Y1 a
STR R1, [R0]" r T4 q- k! h; C, T/ Y
ENDIF
CPSIE I
BX LR ; Exception return will restore remaining context
其中红色代码是新添加的处理浮点寄存器的代码。几点说明:- s% P7 d7 g9 t9 Y5 X. `
1)根据FPCCR的设置值(就是复位值ASPEN=1, LSPEN=1),如果发生PendSV异常时CONTROL.FPCA=1,在进入PendSV异常处理函数时,硬件会自动在任务栈保留浮点寄存器占用的空间,首先通过读FPSCR寄存器让硬件自动保存浮点寄存器S0~S15和浮点状态寄存器FPSCR到任务栈,然后手动保存其余的浮点寄存器S16~S31。
2)在退出PendSV异常处理函数前,清除LR第4位并清除FPCCR寄存器第0位(LSPACT),目的是让硬件在退出PendSV异常处理函数时自动从任务栈恢复浮点寄存器S0~S15和浮点状态寄存器FPSCR。这样如果新任务是第一次运行,则可实现从任务栈加载浮点寄存器初值,否则是从任务栈加载以前保存的值,并且可以保证每个任务运行时都有CONTROL.FPCA=1。
3)虽然使能了延迟保存浮点状态功能,但因为总是有CONTROL.FPCA=1,因此无论旧任务是否执行过浮点指令,在进入PendSV异常处理函数执行任务切换时,都会保存旧任务的浮点寄存器,加载新任务的浮点寄存器,没有利用延迟保存浮点状态功能可减小中断延迟的优势。
RE:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持
回复:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持
回复:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持
谢谢,在F407VG上通过5 j7 k, J$ U; a* Z
; ^3 a8 Y2 I3 [- g: A
RE:【MCU实战经验】向μC/OS-III在STM32F4xx上的移植中添加FPU支持