Update C_SWI_Handler.c