git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@14874 27425a3e-05d8-49a3-a47f-9c15f0e5edd8

2021-10-05 18:52:24 +00:00 · 2021-10-05 18:52:24 +00:00 · 10e2924d17
parent 3999f4b162
commit 10e2924d17
1 changed files with 4 additions and 1 deletions
--- a/os/common/ports/ARMv7-M-ALT/compilers/GCC/chcoreasm.S
+++ b/os/common/ports/ARMv7-M-ALT/compilers/GCC/chcoreasm.S
@ -219,7 +219,10 @@ frompriv:
                ands    r3, #255
                beq     ctxswitch
                /* Called for non-privileged mode change.*/
-
+                msr     PSP, r0             /* Discarding SVC context.      */
+                orr     r2, #1
+                msr     CONTROL, r2         /* Switching to non-privileged. */
+                bx      lr

 ctxswitch:
                /* Called for context switch.*/