diff --git a/Source/portable/RVDS/ARM_CM3/port.c b/Source/portable/RVDS/ARM_CM3/port.c
index c8d2e945a..c71647c8b 100644
--- a/Source/portable/RVDS/ARM_CM3/port.c
+++ b/Source/portable/RVDS/ARM_CM3/port.c
@@ -263,6 +263,7 @@ __asm void vPortSetInterruptMask( void )
 	mov r0, #configKERNEL_INTERRUPT_PRIORITY
 	msr basepri, r0
 	pop { r0 }
+	bx r14
 }
 
 /*-----------------------------------------------------------*/
@@ -275,4 +276,5 @@ __asm void vPortClearInterruptMask( void )
 	mov r0, #0
 	msr basepri, r0
 	pop { r0 }
+	bx r14
 }