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