Add the function when the interrupt return that the system will find the high ready task to resume.

Signed-off-by: Shanjin Yang <sjyang@credosemi.com>