MSP430: Fix bug in setting mode on MSP430.