Merge pull request #19 from gogojesse/scheduler_dev

Incorrect return address in contex switch
Add yield_cpu and test code

Signed-off-by: joshych <yucheng1102@gmail.com>
Merge pull request #20 from gogojesse/yield_cpu_dev

yield_cpu() implementation
Move timer disable earier and fix lr restore issue.