Add a step to correct the offset

Author: TrongNguyenR

portable/CCRH/F1Kx/portasm.s

@@ -209,8 +209,8 @@ _vTRAP0_Handler:
     ; Context switch should be executed at the most outer of interrupt tree.
     ; In that case, set xPortScheduleStatus to flag context switch in interrupt handler.
     jarl    _xPortGET_CORE_ID, lp ; return value is contained in r10 (CCRH compiler)
+    shl     2, r10
     mov     r10, r11
-    shl     2, r11
     mov     #_uxInterruptNesting, r19
     add     r11, r19
     ld.w    0[r19], r18
@@ -309,6 +309,7 @@ _vIrq_Handler_SwitchContext:
     ; Get Core ID and pass to vTaskSwitchContext as parameter (CCRH compiler)
     ; The parameter is  unused in single core, no problem with this redudant setting
     jarl    _xPortGET_CORE_ID, lp ; return value is contained in r10 (CCRH compiler)
+    shl     2, r10                ; Multipy core ID by 4 (size of word) to get the correct offset
     mov     r10, r6
 
     ; vPortYeild may be called to current core again at the end of vTaskSwitchContext.