@@ -220,8 +220,12 @@ SVC_Handler_Veneer:
220
220
221
221
SVC_ContextSave:
222
222
TST LR , # 0x10 / * is it extended frame? * /
223
+ #ifdef __FPU_PRESENT
223
224
ITTE EQ
224
225
VSTMDBEQ R12 ! , {S16 - S31} / * yes , stack also VFP hi - regs * /
226
+ #else
227
+ ITE EQ
228
+ #endif
225
229
MOVEQ R0 , # 0x01 / * os_tsk - >stack_frame val * /
226
230
MOVNE R0 , # 0x00
227
231
STRB R0 ,[ R1 , #TCB_STACKF ] / * os_tsk.run - >stack_frame = val * /
@@ -239,10 +243,16 @@ SVC_ContextRestore:
239
243
LDMIA R12 ! , {R4 - R11 } / * Restore New Context * /
240
244
LDRB R0 ,[ R2 , #TCB_STACKF ] / * Stack Frame * /
241
245
CMP R0 , # 0 / * Basic/Extended Stack Frame * /
246
+ #ifdef __FPU_PRESENT
242
247
ITEE EQ
248
+ #else
249
+ ITE EQ
250
+ #endif
243
251
MVNEQ LR , #~ 0xFFFFFFFD / * set EXC_RETURN value * /
244
252
MVNNE LR , #~ 0xFFFFFFED
253
+ #ifdef __FPU_PRESENT
245
254
VLDMIANE R12 ! , {S16 - S31} / * restore VFP hi - registers * /
255
+ #endif
246
256
MSR PSP , R12 / * Write PSP * /
247
257
248
258
SVC_Exit:
@@ -313,8 +323,12 @@ Sys_Switch:
313
323
314
324
MRS R12 , PSP / * Read PSP * /
315
325
TST LR , # 0x10 / * is it extended frame? * /
326
+ #ifdef __FPU_PRESENT
316
327
ITTE EQ
317
328
VSTMDBEQ R12 ! , {S16 - S31} / * yes , stack also VFP hi - regs * /
329
+ #else
330
+ ITE EQ
331
+ #endif
318
332
MOVEQ R0 , # 0x01 / * os_tsk - >stack_frame val * /
319
333
MOVNE R0 , # 0x00
320
334
STRB R0 ,[ R1 , #TCB_STACKF ] / * os_tsk.run - >stack_frame = val * /
@@ -331,10 +345,16 @@ Sys_Switch:
331
345
LDMIA R12 ! , {R4 - R11 } / * Restore New Context * /
332
346
LDRB R0 ,[ R2 , #TCB_STACKF ] / * Stack Frame * /
333
347
CMP R0 , # 0 / * Basic/Extended Stack Frame * /
348
+ #ifdef __FPU_PRESENT
334
349
ITEE EQ
350
+ #else
351
+ ITE EQ
352
+ #endif
335
353
MVNEQ LR , #~ 0xFFFFFFFD / * set EXC_RETURN value * /
336
354
MVNNE LR , #~ 0xFFFFFFED
355
+ #ifdef __FPU_PRESENT
337
356
VLDMIANE R12 ! , {S16 - S31} / * restore VFP hi - registers * /
357
+ #endif
338
358
MSR PSP , R12 / * Write PSP * /
339
359
340
360
Sys_Exit:
0 commit comments