MSP430: Fixing issue with stack params.