Firmware for control power engines on MSP430