Multitask scheduler for MSP430F5529 launchpad