I did a Real Time OS for MSP430, I wrote the code in C langage....
For schedule the tasks I use the Timer generating a periodical interrupt, when the interrupt is generated I control the stack pointer and when return from the isr, the program counter points to the next task.
I'm writing a document, that shows tetails for how to do that, when I upload the file I send a message for you....