Embedded dev: basic OS functions not so bad.

Task switcher and interrupt code, short but painfully difficult to write correctly.