MSP430: Calling functions should work although could be more optimized.