Code for MSP430