SVC: SleepThread should yield to the next ready thread.
SVC: Add debug log to ArbitrateAddress.
Thread: Check that thread is actually in "wait state" when verifying wait.
Merge pull request #226 from bunnei/svc-and-thread-fixes

Svc and thread fixes